低成本8位单片机控制的光电寻迹智能车

牛俊英

（顺德职业技术学院广东佛山528333）

智能车竞速比赛以及多种智能车的应用场合中，需要智能车沿着某条轨迹快速前进，使用普通红外传感器、激光传感器、摄像头识别均可有效提取路面轨道信息而解决这一问题，现在常见使用16位单片机作为控制核心。普通红外传感器因为易受干扰、前瞻距离短等缺点已经较少使用，摄像头有丰富的数据信息，但是低成本8位单片机不能很好的处理这些信息。激光传感器成本适中，处理的信号便于8位单片机处理，能够有效的节省硬件成本。针对寻迹智能车进行了软硬件设计，采用8位freescale单片机MC9S08AC16作为控制核心，使用激光传感器提取赛道信息，采用低成本的红外测速方案，算法使用以PID为基础的枚举查表法，做到了处理快速高效。整个设计既满足了竞速小车的响应迅速的要求，又是一种较低成本的设计方案。

1 车模安装

智能车的控制采用的是前轮转向，B型车模采用的是国内厂商生产的1：16的电动越野遥控车的底盘部分，突出特点为四轮驱动，四轮独立悬挂。反射式光电传感器在小车前方一字形简单排布，14个发射，7个接收，一个发射带两个接收，传感器的前瞻可以达到40 cm以上，两个激光发射头间距1.8 cm。传感器单元安装图如图1所示。

图1 改装后智能车Fig.1Smart car adjusted

系统选用红外传感器作为测速传感器[3]，把红外传感器安装在后轮上，在后轮的内壁贴上黑白等距的胶带，这样子安装就充分利用了空间，且完成了测速的要求。红外传感器测速安装图如图2所示。车轮转动时，红外传感器将会输出脉冲电平，检测脉冲频率将得到小车速度。这种测速方法无法达到光电解码器的精度，但是对于小车的速度处理并没有太大影响，而光电解码器价格昂贵，安装在齿轮上，同等电源和PWM的输出时，小车速度会变慢。

图2 红外传感器测速的安装Fig.2Infrared sensor for measuring rate

2 硬件设计

电源管理模块采用7.2 V 2 000 mAh Ni－Cd蓄电池作为系统能源，并且通过降压稳压电路分出6 V，5 V分别给舵机和单片机等供电；使用H桥及其相关器件做了直流电机驱动模块；转向伺服舵机控制智能车转向；用红外传感器测量模块实时测量智能车车速；采用激光传感器作为赛道的检测；系统充分使用了M9S8AC16CG单片机的外围模块，具体使用到的模块包括：定时器模块、PWM脉冲宽度调制模块、中断模块、I/O端口和实时时钟模块等。

2.1 最小系统及主板

系统采用的常规使用的最小系统板[1]，以MC9S08AC16为核心的单片机系统的最小系统主要包括以下几个部分：时钟电路（外接的8 MHz的石英晶振）、电源电路（提供5 V直流电源）、复位电路、BDM接口（通过BDM头向单片机下载和调试程序）。

主板上有组成本系统的主要电路，具体包括：

电源稳压电路7.2 V的电池电源将会通过3个集成稳压电路处理成两个5 V、一个约5～7.2 V的可调直流输出，其中一个5 V直流电源供单片机和相关外设工作，另外一个5 V直流单独供激光传感器工作，可调直流输出供舵机工作，采用这种电源设计方式，可以提供所需不同大小的电源，同时在舵机、激光传感器工作时不会影响单片机的工作电源。

接口电路包括舵机接口、电机驱动接口、电源接口、调试用人机界面电路接口、单片机最小系统插座。

电机驱动板作为一个独立的单元制作的直流电机“H”型双极性驱动电路[2]。

2.2 传感器模块

采用14个发射，7个接收，两个发射一个接收为一组一字排开。每次选中不相邻两个发射管发射，由两个接收管分别接受。AC16单片机的IO端口进行控制，由74LD164驱动选择要发射的传感器，由一个555芯片发出100 kHz的频率震荡波，激光管发光。接受部分有一个相匹配的100 kHz的接收管接收返回的光，7路接收管的接收信号直接进单片机。传感器原理如图3所示。

图3 激光传感器原理图Fig.3Schematic diagram of laser sensor

3 软件设计

3.1 软件设计概要

系统的主函数将执行图4所示流程图对应的程序。

图4 软件设计流程图Fig.4Flow chart of software

调试程序可以完成的功能有：检验传感器故障、调试速度控制参数、舵机中点设置、舵机转角参数控制等。传感器数据的读取特指激光传感器的读取，在定时器程序中，每5 ms开始新的一轮激光扫描，每125 μs更换1组激光发射管，每组发射两个不相邻的激光信号，所有激光发射5遍之后，3次以上检测到赛道轨迹信号才确认有效，此时才会设置传感器数据读取完成标志，所以系统每5 ms进入后续程序执行。小车舵机转向控制、速度控制稍后详细论述。对于小车马达速度控制则为闭环控制，采用bang-bang控制与P算法控制相结合[5]，小车的速度读取采用了输入捕捉功能完成，车子运动时，车轮转动，每转过1/5圈，红外传感器就会输出一个完整的脉冲周期，通过读取红外传感器的输出脉冲频率确定小车的速度。

3.2 小车行驶状态确定

该系统采用的赛道为宽为50 cm，中心线为25 mm的赛道，传感器在黑色上读取为1，在白色上读取为0，赛道外地板使用传感器有可能读1，也有可能读0。激光传感器终采用“一”字型排布方式，相邻的两个传感器的距离为20 mm。赛道如图5所示。

图5 赛道示意Fig.5Track map

传感器在赛道上可能的状态可分为[4，6－7]：在普通的赛道处、在十字交叉线处，还有跑出赛道。系统定义了变量Car_State来代表小车当前的状态，可能会出现的情况如下：

1）当小车在赛道上时，将会有1到2个传感器输出高电平，如果有两个传感器同时打到黑点，而两个传感器并不是相邻的则认为是干扰信号，不作特别处理，其他按照如图6的传感器排布方法计算坐标从左向右依次为－13到13，此时Car_State计为传感器打到的坐标；

2）打到10个以上黑点计为交叉线，Car_State计为20；

3）没有打到黑点则认为小车即将跑出赛道，Car_State计为30；

4）另外还有一种情况传感器已经打到了赛道之外，而打到赛道外的传感器可能输出高电平，也有可能输出低电平，此时有可能读出的情况可能会判定为第一种，如图5示意，此时小车本应继续左拐，但是判读位第一种情况，就可能右拐，这种情况的判定就不能仅仅依靠读传感器来判定，还应考虑小车前面行进的趋势加以判别。因为此种情况一般只出现在小车转大弯时，由于转角不够当小车的传感器会打到相反方向的赛道外，所以左转或者右转的角度超过某一特定值时（如60°），应当屏蔽另一侧的传感器，只读转向该侧的传感器，如图5小车现转左侧大弯，右侧传感器检测到错误黑点，此时只要将右侧的7个传感器屏蔽，只读左侧传感器数值即可，此种情况Car_State计为40。

图6 传感器排布Fig.6Sensors assignment

3.3 舵机控制

小车在赛道上：Car_State为－13到13间的整数，由于光电管数量少，造成传感器返回值离散度过大，不适合进行回控，故应加快采样速率，进行过采样，再进行一阶迭代滤波：

PVal=（（Car_State×1 000）+（Pval×10））/11;

小车行使5 ms后位置的偏差进行迭代滤波：

Err=（（PVal－PVal1）+（Err×10））/11;//两次位置偏差

P_Offset=Err/P_err;//负值左偏正值右偏

if（P_Offset＜－5）P_Offset=－5;//左偏最大偏离为－5个单位

if（P_Offset＞5）P_Offset=5;//右偏最大偏离为5个单位

将Err进行采样划分得到P_Offset变量，P_Offset取值为－5到5的整数，负数表示向左偏，正数表示向右偏，绝对值越大代表偏转角度越大；采样分辨率为可调参数P_err，P_err偏大时，小车反应会较为迟钝，P_err偏小时，小车反应会较为灵敏，容易出现很小偏差就会引起小车较大的转向。

按照小车当前的位置以及P_Offset组织数据表Angle_Table[]，该表共有27行11列，第n行m列元素j，表示小车位置Car_State为n－13偏差P_Offset为m－5时，j的值在－10到10之间，负值代表向左转，正值代表向右转，小车舵机应打的角度为j×Angle_C，可调参数Angle_C可以根据赛道状况舵机反应灵敏度等调节，其调节在调试程序中完成，其值愈大，同等情况下转角越大。

舵机的控制就是通过查数据表Angle_Table来实现，而不是通过公式求解，这种方法比较适用于8位单片机，通过检索表可以达到运算所达不到的系统速度。

小车在交叉线时Car_State=20不更改舵机的控制；当小车的传感器打不到黑点，即将跑出赛道活着已经打到赛道外时Car_State=30或40，此时按照小车转的方向，将舵机设置为最大转角，以达到尽快找到赛道黑线的目的。

舵机的输出PWM采用5 ms周期，与小车传感器采样的频率一致。

4 试验结果及总结

通过上述方法，小车取得了比较好的试验结果，在最小曲率半径不小于50 cm的赛道上，小车可以取得每秒2 m以上的速度。其速度比采用16位单片机的系统没有很大差异。要特别注意的是，运算时采用不同数据类型的变量将会带来不同的效果，经实验证明，如果可以使用字节存储类型的变量作双字节变量存储，将会严重影响小车的运行情况，这是由单片机编译环境进行数学运算引起的，应当尽量避免不恰当的变量定义及算数运算。

相较于当前流行的16位单片机控制的双舵机智能车，该系统在硬件上成本较低，而软件也根据8位单片机的特点，避开了较为复杂的运算，采用了查表的方式，只在小车位置及偏差运算以及速度P算法中涉及了少量的数学运算，以此达到系统的快速响应。

[1]蔡泽凡，郭荃弟.单片机技术初步实践[M].北京：高等教育业出版社，2009.

[2]卓晴，黄开胜，邵贝贝.学做智能车——挑战“飞思卡尔”杯[M].北京：京航空航天大学出版社，2007.

[3]韩毅，秦绪鑫，赵轩.基于反射式黑白码盘的模型车测速装置[J].计算机工程与设计，2009，30（24）:5793-5795 HAN Yi，QIN Xu-xin，ZHAO Xuan.Speed device of model car based on black and white stripe[J].Computer Engineering and Design，2009，30（24）:5793-5795.

[4]粱业宗，李波，赵磊.基于路径识别算法的智能车控制系统的设计[J].自动化技术与应用，2009，28（1）:121-123.LIANG Ye-zong，LI Bo，ZHAO Lei.Intelligent vehicle control based on path recognition[J].Techniques of Automation and Applications，2009，28（1）:121-123.

[5]胡文华，周新志.智能巡线小车的多模式速度控制系统[J].微计算机信息，2008，24（19）:4-5.HU Wen-hua，ZHOU Xin-zhi.Multi mode speed control system of small intelligent patrol line vehicle[J].Microcomputer Information，2008，24（19）:4-5.

[6]雷钧.光电自动寻迹智能车控制系统的开发[J].苏州大学学报工科版，2009，29（6）:44-48.LEI Jun.Development of autotracking smart car control system based on photoelectric sensor[J].Journal of Suzhou University Engineering Science edition，2009，29（6）:44-48.

[7]刘燕，刘志.基于单片机控制的自主寻迹电动小车的设计[J].自动化与仪器仪表，2007（3）:9-11.LIU Yan，LIU Zhi.Design of auto-searching track for electromotion car based on single-chip microcomputer[J].Automation&Instrumentation，2007（3）:9-11.