智能汽车设计实践光电管型设计

单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,*,单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,单击此处编辑母版标题样式,第,6,章 智能汽车设计实践,光电管型设计,6.1,机械设计,1,6.2,硬件设计,2,6.3,软件设计,3,第,6,章 智能汽车设计实践,光电管型设计,6.1,机械设计,6.1.1,光电管传感器的布局,6.1.2,舵机的安装,6.1.3,测速传感器的安装,6.1.1,光电管传感器的布局,1,传感器的布局间隔,2,传感器的径向探出距离,传感器的布局间隔,各个传感器的布局间隔对智能车的运行，是有一定影响的。传感器的间隔是否合适，对过弯的精确性以及防止飞车有很大的影响。,设定传感器间隔的原则是：既要满足一定的密度以保证走弯道时轨迹相对精确，又要尽可能拥有大的横向控制范围来防止飞车。若传感器间隔设置合适，当赛道有一点微小的变化时，小车的控制单元就能进行相应的反应（改变前轮转角），从而使得过弯道的轨迹与弯道大体重合，精确性好。,传感器的径向探出距离,（,1,）“一”字形布局,:“,一”字形布局是传感器最常用的布局形式，即各个传感器在一条直线上，从而保证纵向的一致性，使其控制策略主要集中在横向上，其排布如图,6.1,所示。,图,6.1 “,一”字形布局,传感器的径向探出距离,（,2,）“八”字形布局,:“,八”字形布局从横向来看与“一”字形布局类似，但它增加了纵向的特性，从而具有了一定的前瞻性，其排布如图,6.2,所示。,图,6.2 “,八”字形布局,传感器的径向探出距离,（,3,）“,W”,字形布局,:,为了能够提早地预测到弯道的出现，我们还可以将左右两端的传感器进行适当前置，从而形成“,W”,形布局，此外，还可利用“,W”,形布局来检测赛道的弯曲程度。其光电管排布如图,6.3,所示。,图,6.3 “W”,字形布局,6.1.2,舵机的安装,在智能车上，舵机的输出转角通过连杆传动控制前轮转向。舵机是系统中一个具有较大时间常数的惯性环节。其时间延迟正比于转过的角度，反比于舵机的响应速度。对于快速性要求极高的智能小车来说，舵机的响应速度是影响其过弯最高速度的一个重要因素，特别是对于前瞻不够远的智能小车更是如此。,6.1.2,舵机的安装,提高舵机控制前轮转向速度的一种方法是采用杠杆原理，在舵机的输出舵盘上安装一个较长的输出臂，其安装图如图,6.4,所示。,图,6.4,舵机的安装图,6.1.3,测速传感器的安装,为了减轻智能车的质量，测速时应尽量选用质量轻精度高的传感器，为了不影响加速性能，编码器的传动齿轮较小，基本上和电机的齿轮相同。其安装图如图,6.5,所示。,图,6.5,测速传感器的安装,6.2,硬件设计,6.2.1 HCS12,控制核心,6.2.2,电源管理单元,6.2.3,路径识别单元,6.2.4,车速检测模块,6.2.5,舵机控制单元,6.2.6,直流驱动电机控制单元,6.2,硬件设计,硬件电路设计是智能车控制系统设计的基础。智能车控制系统硬件结构主要由,HCS12,控制核心、电源管理单元、路径识别电路、车速检测模块、转向伺服电机控制电路和直流驱动电机控制电路组成，其系统硬件结构如图,6.6,所示。,图,6.6,系统硬件结构图,6.2.1 HCS12,控制核心,HCS12,控制核心单元既可以直接采用组委会提供的,MC9S12EVKX,电路板，,也可以自行购买,MC9S12DG128,单片机，然后量身制作适合自己需要的最小开发系统,。,6.2.1 HCS12,控制核心,MC9S12DG12B,单片机引脚图如图,6.7,所示。,图,6.7 MC9S12DG12B,单片机引脚图,6.2.1 HCS12,控制核心,在光电管方案中，其,I/O,口具体分配如下：,PH,口与,PA,口用于小车光电发光管发光控制；,PT0,用于车速检测的输入口；,PB,口用于显示小车的各种性能参数；,PWM0,（,PP0,引脚）与,PWM1,（,PP1,引脚）合并用于伺服舵机的,PWM,控制信号输出；,PWM2,（,PP2,引脚）与,PWM3,（,PP3,引脚）合并用于驱动电机的,PWM,控制信号输出（电机正转）；,PWM4,（,PP4,引脚）与,PWM5,（,PP5,引脚）合并用于驱动电机的,PWM,控制信号输出（电机反转）。,在连续路径识别算法中，,PAD,口用于传感区光电接收管电压信号的输入口。,6.2.2,电源管理单元,电源管理单元是智能车硬件设计中的一个重要组成部分，它的作用是对组委会提供的,7.2 V 1800 mA Ni-cd,蓄电池进行电压调节。按照系统各部分正常工作的需要，各模块电压值分为,5 V,6.5 V,和,7.2 V,三个挡。,6.2.2,电源管理单元,电源管理单元主要用于以下三个方面：,（,1,）采用稳压管芯片,L7805CV,将电源电压稳压到,5 V,后，给单片机系统电路、路径识别的光电传感器电路、车速检测的转角编码器电路和驱动芯片,MC33886,电路供电；,（,2,）经过一个二极管降至,6.5 V,左右后供给转向伺服电机；,（,3,）直接供给直流驱动电机。,6.2.2,电源管理单元,同时考虑到稳压芯片,L7805CV,的额定输出电流较小，故采用两片,L7805CV,分别对单片机电路、车速检测电路、驱动芯片电路和光电传感器电路供电，以保证系统正常运行。其稳压电路如图,6.8,所示。,图,6.8,稳压电源单元,6.2.3,路径识别单元,在光电管方案中，通过红外发光管发射红外光照射跑道，由于跑道表面与中心线具有不同的反射强度，因此利用红外接收管可以检测到这些信息。通过合理安排红外发射,/,接收管的空间位置可以检测到智能车相对于前方道路的位置。红外发射接收管一般安放在模型车前端，可以安装成一排，也可以前后安装两排，传感器的总数量受到比赛规则的限制。,6.2.3,路径识别单元,红外接收管接收道路反射的红外光后产生电压的变化，它可以反映出赛道中心线的位置。这个电压信号可以通过外部的电压比较器变成高、低电平由单片机的,I/O,端口读取，也可以通过单片机,A/D,端口直接读取。从,I/O,端口读取的参考电路如图,6.9,所示，从,A/D,端口直接读取的参考电路如图,6.10,所示。,图,6.9 I/O,端口读取电路,图,6.10 A/D,端口读取电路,6.2.3,路径识别单元,两个光电管方案中常见的问题,1,相邻光电管之间的干扰,2,光电管发射功率的影响,相邻光电管之间的干扰,由于红外发射管是基于漫反射原理的，其发射的红外光可能影响到安装在附近的红外接收管。消除这种干扰可以采取以下几种措施：,（,1,）选择发射与接收方向性好的红外传感器。,（,2,）选择发射与接收一体化的红外传感器，它的外壳可以抑制相邻干扰。,（,3,）在红外接收管上安装黑色套管，使其只接收前方一定角度内的红外光线，这种减小互扰动的措施效果较好。,（,4,）使相邻的红外发射,/,接收管交替工作（即“点火”）。这种方法不仅减小了相邻红外传感器之间的干扰，同时也降低了整体传感器的功耗。,光电管发射功率的影响,为了增加前瞻距离，需要加大光电管红外发射功率，使得返回的红外线的强度提高，这样不仅使得电池电能的消耗量增加，同时也会缩短红外发射管的寿命。为解决这个问题，可以利用红外接收管响应速度快的特点，采用光电管脉冲发射,/,接收的方法加以处理。红外发射管工作在周期脉冲方式下，可以大大降低平均工作电流，从而降低了整个发射电路的电量消耗。,6.2.4,车速检测模块,为了使得模型车能够平稳地沿着赛道运行，除了控制前轮转向舵机以外，还需要控制车速。通过对速度的检测，可以对车模速度进行闭环反馈控制。此外，若采用基于路径记忆的控制策略，为了获取道路信息，需要得到智能车的行驶距离，也必须通过车速检测模块来间接实现。,6.2.4,车速检测模块,车速检测一般是通过检测驱动电机转速来实现的。比赛中所使用的常见测速方法列举如下：,1,转角编码盘,2,反射式光电检测,3,霍尔传感器检测,转角编码盘,转角编码盘分为绝对位置输出和增量式位置输出两种。一般可使用增量式编码盘。它输出脉冲的个数正比于电机转动的角度，从而使编码盘输出脉冲的频率正比于转速。可以通过测量单位周期内脉冲个数或者脉冲周期得到脉冲的频率。,反射式光电检测,许多队伍在后轮齿轮传动盘上粘贴一个黑白相间的码盘，通过安装在码盘侧面的反射式红外传感器，来读取光码盘的转动脉冲。其原理和转角编码盘的测速机理是类似的。,霍尔传感器检测,在后轮轮毂上粘贴,1,个或者,2,个小型的永磁体，附近固定一个霍尔传感器。霍尔元件有,3,个引脚，其中,2,个分别是电源引脚和接地引脚，另一个是输出信号引脚，只要通过一个上拉电阻接至,5 V,电压，就可以形成开关脉冲信号。后轮电机每转,1,周，则可以产生,1,个或者,2,个脉冲信号。这种方式简易、廉价，但测速精度不如前面的方法，因为永磁体本身的体积决定了不可能在后轮轮毂上安装过多磁片，对测速精度要求不高的队伍可以考虑此方法。,6.2.5,舵机控制单元,舵机本身是一个位置随动系统。它是由舵盘、减速齿轮组、位置反馈电位计、直流电机和控制电路组成的。通过内部的位置反馈，使它的舵盘输出转角正比于给定的控制信号，因此对于它的控制可以使用开环控制方式。在负载力矩小于其最大输出力矩的情况下，它的输出转角正比于给定的脉冲宽度。但实际上，由于舵机反应的延迟性，智能车的舵机转角通常不能在一个控制周期内到达指定的设定角度，因此，可以在舵机外部再安装一个位置反馈装置，构成双闭环系统，以实时检测和控制舵机的转动角度。,6.2.5,舵机控制单元,舵机控制单元采用组委会提供的,Futaba,公司,S3010,型舵机作为智能车方向控制部件。,图,6.14,转向伺服电机实物图,6.2.6,直流驱动电机控制单元,直流驱动电机控制电路主要用来控制直流电动机的转动方向和转动速度。改变直流电动机两端的电压可以控制电动机的转动方向；而控制直流电动机的转速，则有不同的方案，较常规的方法是采用,PWM,控制。驱动电路既可以直接采用,MC33886,电机驱动芯片，也可以采用大功率,MOS,管来自行设计电机驱动电路。,MC33886,全桥驱动电路,采用,MC33886,的全桥驱动时，为了提供更大的驱动电流，可以将多片,MC33886,并联使用，其采用,3,片,MC33886,并联方式驱动电机硬件电路如图,6.15,所示。,图,6.15,电机驱动硬件电路图,大功率,MOS,管电机驱动电路,采用大功率,MOS,管组成电机驱动电路时，在保证大电流驱动电机的同时，可以有效地避免多片,MC33886,并联时由于芯片分散性导致的驱动芯片某些片发热某些不发热的现象。但由分离元件组成的驱动电路的稳定性低于集成芯片。,图,6.16 MOS,管组成电机驱动电路,6.3,软件设计,6.3.1,初始化算法,6.3.2,路径离散识别算法,6.3.3,路径连续识别算法,6.3.4,控制策略及控制算法,6.3,软件设计,在智能车控制系统光电管方案的软件设计中，程序的主流程是：先完成单片机初始化（包括,I/O,模块、,PWM,模块、计时器模块、定时中断模块初始化）之后，通过无限循环语句不断地重复执行路径检测程序、数据处理程序、控制算法程序、舵机输出及驱动电机输出程序。其中，定时中断用于检测小车当前速度，作为小车速度闭环控制的反馈信号。,6.3,软件设计,光电管方案主程序流程图如图,6.17,所示。,图,6.17,光电管方案主程序流程图,6.3.1,初始化算法,1,锁相环初始化,2,A/D,初始化,3,PWM,初始化,4,定时器初始化,6.3.2,路径离散识别算法,路径离散识别算法是通过普通,I/O,端口将光电管接收端的电压值读入单片机，根据端口输入的高、低电平逻辑来判断该传感器是否处于黑色引导线上方，再筛选出所有处于引导线上方的传感器，便可以大致判