大学一队技术报告.pdf

《大学一队技术报告.pdf》由会员分享，可在线阅读，更多相关《大学一队技术报告.pdf（57页珍藏版）》请在得力文库 - 分享文档赚钱的网站上搜索。

1、第 三 届“飞 思 卡 尔”杯 全大 学 生智 能 汽 车 技 术 报 告学 校：XX 大学队伍名称:参赛队员:带队教师:摘 要智能汽车是未来汽车发展的趋势，它体现了自动控制、人工智能、传感技术、机械、计算机等多个学科领域理论技术的交叉和综合。本文是在长安大学参加第三届飞思卡尔杯全国大学生智能汽车竞赛背景下创作的。具体介绍了一种基于光电传感器的智能寻迹小车的设计和实现。智能小车系统以Freescalel6位单片机MC9s12DG128作为系统控制处理器，采用基于光电传感器的信号采样模块获取赛道黑线信息，通过PID控制策略和PWM控制技术对智能小车的转向和速度进行控制。使小车能够自主识别黑色引导

2、线并根据黑色引导线实现快速稳定的寻线行驶。论文分析了智能小车系统的设计方案，详细介绍了小车控制系统的软硬件设计，包括传感器模块、驱动电机模块、转向舵机模块、测速模块等，并详细介绍了软件设计，最后，介绍了智能小车的整体调试、测试。结果表明，智能小车系统工作稳定，能较好的满足控制要求。关键词：智能小车系统，MC9S12DG128,光电传感器，速度检测，IABSTRACTIntelligent vehicle represents the development direction of automobiletechnology.It embodies the automatic control,a

3、rtificial intelligence,sensortechnology,machinery,computers and many other areas of the intersection oftechnology and integrated.This paper is bom under the background of the thirdFreescale Cup National Undergraduates Intelligent Car Contest in changanUniversity.The intelligent car system,with the F

4、reescale 16-bitsingle-chipMC9S12DG128 as its control microprocessor,uses signal acquisition module toobtain lane image information,and adopts signal PID control strategy together withPWM technology to have a control on the steering angle and speed of the system.Themain function that the intelligent

5、car may achieve is that the car should track theblack-guide-line automatically and move forward following the line as fast and stableas possible.This paper gives an overall design blueprint of the intelligent car system,introduce the hardware design including signal acquisition module,power supplymo

6、dule,motor drive module,servo motor module,velocity collection module andetc.And the intelligent car of the mechnical structure and adjustment metod.Finally,onthe smart cars overall debugging and testing.The results show that the smart carhardware system stability,better able to meet the requirement

7、s of control.KEY WORD：Intelligent Vehicle System,MC9S12DG128,Photoelectric sensor,Speed detection,Mechanical structureII目录第 一 章 引 言.11.1 总体方案介绍.11.2 相关文献综述.11.3 本文的主要内容.2第二章赛车系统整体设计.42.1 智能车系统分析.42.2 系统硬件结构设计.42.3 系统软件结构设计.5第三章赛车机械结构调整.63.1 智能小车的整体结构.63.2 智能车运动学状态方程.73.3 前轮定位参数的选择.93.3.1 主销后倾角.93.3.

8、2 主销内倾角.103.3.3 前轮外倾角.113.3.4 前轮前束.113.4 差速器的调整.123.5 齿轮传动机构调整.123.6 其他机械模块调整.13第四章路径识别模块.144.1传感器的选择与安装.144.L 1传感器的选择.144.1.2传感器的安装.154.2 电路模块.174.3 路径识别算法.194.3.1 二值化路径识别算法.194.3.2 归一化连续路径识别算法.21第五章赛车转向模块.245.1 舵机的安装.245.2 舵机的控制.25III5.3转向控制算法.255.3.1 转弯半径的计算.265 3 2 转向系统的标定.265 3 3 转向控制算法的数学模型.31

9、第 6 章 赛车驱动模块.346.1 硬件电路设计.346.2 车速控制算法.366.2.1 速度给定值Se ed speed的确定.376.2.2 当前速度的获取.39第 7 章 智能小车系统调试.427.1 开发调试工具.427.2 智能小车硬件的调试.427.3 智能小车整体调试.447.3.1 实验赛道环境及参数.447.3.2 智能小车整体调试与结果.44第 8 章 结 论.468.1 总结回顾.468.2 未来寄语.47参考文献.50IV第 一 章 引 言1.1 总体方案介绍仔细研究比赛规则和竞赛要求，我们对智能小车系统设计的基本策略作出以下分析：第一，智能小车竞赛是基于同一开发平

10、台上设计的小车竞速比赛，因而智能小车的速度和稳定性是决定比赛成绩的关键。在保证智能小车稳定行驶的前提下，车速越高，比赛成绩就越好。因此，在智能小车的设计中应该遵循稳中求快的基本原则。第二，智能小车需要实现自主寻迹，因而需要选择合适的寻线传感器。目前普遍采用的寻线方案主要有光电管寻迹和CCD摄像头寻迹。光电管通过红外收发管检测接收到的反射光强弱，以此判断赛道黑线，具有反应速度快，电路简单，检测信息速度快，成本低的优点；CCD摄像头则是通过图像采集，动态拾取路径信息来进行寻线判断。采用CCD摄像头寻迹则能大幅度提升小车的前瞻距离，有利于小车提高车速。但是它是以实现小车视觉为目的的，电路设计复杂，检

11、测信息更新速度慢，数据处理量比较大，算法较为复杂。基于上述考虑，我们选择红外光电管作为寻线传感器。第三，转向控制系统中最重要的部分是舵机。智能小车采用的是Futaba牌舵机，型号为HS-3010,该舵机扭力大，稳定性好，控制角度精确，但是响应灵敏度较差，存在严重的机械滞后，而舵机的响应速度直接影响模型车通过弯道时的最高速度，提高舵机的响应速度是提高模型车平均速度的一个关键。为了提高舵机的响应速度，我们安装了双舵机，分别对左前轮和右前轮进行控制，从而大大提高了舵机的灵敏性。第四，由于速度是比赛的关键，那么在智能小车的设计中设计一个好的电机驱动电路至关重要。试验中发现，MC33886电机驱动芯片存

12、在发热严重的问题，所以智能车的电机驱动没有采用MC33886芯片，而是采用了基于H桥驱动电路的PWM控制技术，方便地实现电机的正转和制动。1.2 相关文献综述智能车比赛以快速平稳地完成赛程为目标，要求赛车能够快速准确地检测黑色引导线，及时作出合理的控制并迅速执行。在设计和制作过程中必须保证1第三届全国大学生智能汽车邀请赛技术报告硬件和软件两方面都能达到快速，稳定的目标。硬件是智能小车运行的基础，对小车机械系统的调整重点参考了黄开胜、陈宋的 汽车理论与智能模型车机械结构调整方法，该文详细介绍了汽车系统动力学的基本理论，为小车的机械改装提供了有力的理论支持O 智能小车的设计制作方案主要参考的是卓晴

13、等老师编撰的 学做智能车一书。该书将第一届全国大学生智能车竞赛各参赛队的技术方案进行了详细的介绍和总结，对智能车的设计提出了许多很有价值的建议。与硬件设计一样，软件的设计中主要考虑了赛道状况的判断，根据赛道状况进行加速减速的实现，以及小车所走路经的最优选择等。通过软件的功能保证小车以稳定为前提下，用最短的时间完成比赛。主要参考周斌、李立国、黄开胜的 智能车光电传感器布局对路径识别的影响研究。邵贝贝13】文中详细介绍了如何在S12系列单片机上进行程序代码编译和CodeworriorlDE编译器使用方法。对程序调试和软件开发提供了很好的参考和学习内容。同时，对于S12芯片的寄存器设置和操作，参考了

14、Freescale的S12相关资料 。1.3 本文的主要内容本技术报告正文部分总共分为8 个章节，其中第1 章是引言部分，介绍智能车比赛的相关背景；第 2 章介绍赛车系统整体设计，分析智能车的系统方案；第 3章对赛车机械结构进行调整，并讨论了小车的运动学状态方程，为后面研究路径规划和控制方式打下基础。第 4 章介绍路径识别模块的硬件结构和软件识别算法，为后面的转向控制提供控制信息。第 5 章介绍了赛车的转向模块，包括舵机的安装和转向控制算法。第 6 章介绍赛车的电机模块，首先介绍了电机的驱动电路，然后对车速控制算法进行介绍。第 7 章介绍了智能车的软件开发和调试环境，先进行软件调试与仿真，再在

15、赛道上进行试车调试，最后进行智能车的整体调试。第 8 章对设计中遇到的问题进行总结，并对今后的改进方向做出展望。2第二章赛车系统整体设计2.1 智能车系统分析在满足大赛要求的前提下，设计的智能小车应具有良好的自主道路识别能力和稳定性，并能以较快的速度行驶。因此，智能小车系统的设计主要包括以下两部分：1、完成智能小车控制器的硬件电路设计，根据大赛要求，调整和改进智能车模的机械结构，最大限度的发挥小车的性能。2、结合软件算法，使小车转向准确、稳定，能够安全通过各种弯道和十字交叉路口。在保证智能车可靠运行的前提下，电路设计尽量简洁紧凑，以减轻系统负载，提高智能车的灵活性，同时应充分发挥创新原则，以简

16、洁但功能完美为出发点，并以稳定性为首要前提，实现智能车快速运行。作为能够自动识别道路运行的智能汽车，信息处理与控制算法至关重要，主要由运行在单片机中的控制软件完成。因此，控制软件的设计是智能车的核心环节。2.2 系统硬件结构设计经过分析整个智能车系统，可知系统完成的功能如图2.1所示。电源管理模块-忸_ _ _ _电机小（动模块路径识别模块-,/、MC9S12DG128直流电机速度检测模块=|转 向 舵 机 控 制图2系统硬件结构框图4其 中 MC9S12DG128是系统的核心部分。它负责接收赛道信息、小车速度等反馈信息，并对这些信息进行恰当的处理，形成合适的控制量来对舵机与驱动电机进行控制。

17、电源管理模块主要为单片机及路径识别电路、转向舵机、后轮驱动电路三大部分提供稳定的直流电源。路径识别模块由S12的 A D 模块、传感器和外围电路组成。其功能是获取前方赛道的信息，以供S12作进一步分析处理。速度检测模块由S12的增强型捕捉计数模块、传感器和外围电路组成，通过检测赛车的实时车速为赛车的车速控制提供控制量。舵机模块和电机驱动分别用于实现小车转向和驱动。2.3系统软件结构设计如果说系统硬件对于智能车来说是它的骨架和躯体，那么软件算法就是它的思想。软件算法的优劣直接体现了智能车辆的“智能”高低。所以软件系统对于智能车来说至关重要。首先，赛车系统通过路径识别模块获取前方黑色引导线的信息，

18、同时通过速度检测模块实时获取赛车的速度。利用连续路径识别算法求得赛车与黑线位置的偏差，接着采用P 方法对舵机进行控制，根据检测到的实时车速，结合模糊控制策略对赛车速度进行恰当的控制调整，使赛车在符合比赛规则情况下沿赛道快速前进。赛车系统的软件流程如图所示。图 2.2 系统控制流程图5第三章赛车机械结构调整智能小车的机械性能对于其行驶表现具有非常重要的影响，任何控制算法和软件程序都需要通过智能小车的机械结构来执行和实现。为使模型车在比赛中发挥出最佳性能，使其直线行驶稳定，入弯转向灵活，结合汽车理论相关知识对智能小车的运动特性进行分析，并据此对智能小车的底盘结构进行相应的调整和参数优化。3.1智能

19、小车的整体结构本次比赛采用了大赛组委会提供的仿真车模，其主要尺寸参数如表3.1。表3.1 车模主要尺寸参数基本参数尺寸车长3 1 6 m m车宽1 7 2 m m轴距2 0 4 m m前轮距1 4 2 m m后轮距1 3 8 m m /1 4 8 m m车轮直径5 5 m m传动比1 8/7 6模型车的底盘结构图如图3.1。6第三章赛车机械结构调整图3.1 模型车的底盘结构3.2智能车运动学状态方程在只考虑车辆的平面运动情况下，当转向时，车辆只做平面运动及平面旋转运动，如图3.2、3.3所示。图3.2小车转向示意图7第三届全国大学生智能汽车邀请赛技术报告图3.3转向平面图21 V.W=-=-由

20、角速度的定义可 T R公 式1tana公 式2可 以 将 车 辆 的 角 速 度 表 示 如 下：co=vr t,an a力公式3其 中，匕为 车 辆 后 轮 轴 中 心 线 速 度，L为 车 辆 轴 距，。为前 轮 转 角。则小车方位偏 差 为：vree=0八 上土上殳 =L tan 九尸公 式4其 中 自。为 跟 踪 路 径 曲 率 变 化 对 侧 向 偏 差 的 影 响，当 跟 踪 路 径 为 直 线 时 其 值 为零。不 考 虑 车 辆 侧 滑 时，车 辆 前 轮 轴 中 心 处 速 度 矢 量”/为：vf=vr-a)xL公 式5则 侧 向 偏 差)le=vf cos axe0-vf

21、sina&公 式68第三章赛车机械结构调整其中多表示路径曲率变化对侧向偏差变化率的影响。由公式4、公式6即构成状态变量为/，及方向偏差。的赛车运动学状态方程：=+1 vf.t a n a e。0 0 _L _3.3前轮定位参数的选择为保证智能小车直线行驶稳定，转向轻便灵活并尽可能的减少轮胎磨损，需要对小车的前轮定位参数进行调整。小车的前轮定位参数主要包括：主销后倾角、主销内倾角、前轮外倾角和前轮前束。这四个参数反映了前轮、主销和前轴三者之间在车架上的位置关系。3.3.1主销后倾角主销后倾角是指主销轴线与地面垂直线在汽车纵向平面内的夹角如图3.4。主销后倾的作用是在车轮偏转后会产生一回正力矩，矫

22、正车轮的偏转。后倾角7越大，车速越高，车轮偏转后自动回正能力越强。但回正力过大，将会引起前轮回正过猛，加速前轮摆振，并导致转向沉重。通常后倾角值应设定在l -3 o模型车通过增减黄色垫片的数量来改变主销后倾角：每侧有4片垫片，前2后2,对应的后倾角为0 ；前1后3,后倾角为2 -3 ；前0后4,后倾角为4 -6 o模型车转向灵活，可根据试验调试的结果，设定垫片按前1后3安装，将后倾角度设为3 比较合适。9第三届全国大学生智能汽车邀请赛技术报告图3.4 主销后倾角调整图3.3.2主销内倾角主销内倾角是指主销在汽车的横向平面内向倾斜一个，即主销轴线与地面垂直线在汽车横向断面内的夹角，如图3.5。主

23、销内倾角也有使车轮自动回正的作用。当转向轮在外力作用下发生偏转时，由于主销内倾的原因，车轮连同整个汽车的前部将被抬起一定高度；当外力消失后，车轮就会在重力作用下恢复到原来的中间位置。另外，主销内倾还会使主销轴线延长线与路面的交点到车轮中心平面的距离减小，同时转向时路面作用在转向轮上的阻力力矩也会减小，从而可使转向操纵轻便，同时也减小了由于路面不平而从转向轮输出的力反馈。但其值不宜过小，即主销内倾角不宜过大，否则在转向时车轮主销偏转的过程中，轮胎与路面将产生较大的滑动，从而增加轮胎与路面间的摩擦阻力，不仅会使转向变得沉重，还将加速轮胎的磨损。通常汽车主销内倾角不大于8。10第三章赛车机械结构调整

24、图3.5主销内倾角、前轮外倾角示意图3.3.3 前轮外倾角通过车轮中心的汽车横向平面与车轮平面的交线与地面垂线之间的夹角a,称为“前轮外倾角”，如图3.5所示。轮胎呈现“八”字形张开时称为“负外倾”，而呈现“V”字形张开时称为“正外倾”。前轮外倾角一方面可以在汽车重载时减小或消除主销与衬套，轮毂与轴承等处的装配间隙，使车轮接近垂直路面滚动而滑动，同时减小转向阻力，使汽车转向轻便；另一方面还可以防止由于路面对车轮垂直反作用力的轴向分力压向轮毂外端的轴承，减小轴承及其锁紧螺母的载荷，从而增加这些零件的使用寿命，提高汽车的安全性。一般前轮外倾角为1左右。模型车提供了序号为EXT9的配件来调节前轮外倾

25、角：当所采用的配件上无数字4时前轮外倾角为0 ,当所采用的配件上有数字4时前轮外倾角约为1。由于本模型车主要用于竞速，在设计中必然要尽可能减轻重量，所以其底盘承重不大，且前轮外倾角只两档可调，故设定为0即可，关键是前轮前束要与之相匹配。3.3.4 前轮前束当车轮有了外倾角后，在滚动时就类似于圆锥滚动，从而导致两侧车轮向外滚开。由于转向横拉杆和车桥的约束使车轮不可能向外滚开，车轮将在地面上出现边滚边向内滑移的现象，从而增加了轮胎的磨损。在安装车轮时，为消除车轮外倾带来的这种不良后果，可以使汽车两前轮的中心面不平行，并使两轮前边缘距离R小于后边缘距离A,A-R之差称为“前轮前束”，如图3.6如示,

26、一般前束值为l-12m m o像内八字样前端小后端大的称为“前束”，而像外八字一样后端小前端大的称为“后束”或“负前束”。第三届全国大学生智能汽车邀请赛技术报告图 3.6 前轮前束示意图模型车是由舵机带动左右横拉杆实现转向的。主销在垂直方向的位置确定后，改变左右横拉杆的长度即可改变前轮前束的大小。左杆短，可调范围为1 0.8-1 8.l m m；右杆长，可调范围为2 9.2-3 7.6 m m,由上述原理可知，前轮前束须与前轮外倾角相匹配，如前轮外倾角设定为0，则前轮前束须为0 m m或只有很小的前轮前束值。3.4 差速器的调整当车辆在正常的过弯行进中（假设：无转向不足亦无转向过度），此时4个

27、轮子的转速（轮速）皆不相同，依序为：外侧前轮外侧后轮内侧前轮内侧后轮。此次所使用车模配备的是后轮差速机构。差速器的特性是：阻力越大的-侧，驱动齿轮的转速越低；而阻力越小的侧，驱动齿轮的转速越高。以此次使用的后轮差速器为例，在过弯时，因外侧前轮轮胎所遇的阻力较小，轮速便较高；而内侧前轮轮胎所遇的阻力较大，轮速便较低。差速器的作用就是保证小车在转弯时内外驱动轮能以不同的转速作纯滚动运动，避免发生车轮拖滑。差速器的性能对于小车过弯时的表现有着非常重要的影响，因此，对于差速器的调整是小车机械调整的重要环节。因此，为保证良好的差速效果，对差速器进行调整的关键是要调节好压盘和滚珠之间的压紧力。具体的调整方

28、法是：调节后轴螺母，使压盘和滚珠之间松紧适中，捏住减速齿轮使其固定同时转动一侧车轮，检查车轮的转动是否迟滞艰涩；此外，还要观察该侧车轮向前转动的角度是否与另一侧车轮向后转动的角度基本相同；然后将小车满载放置于赛道上，同样捏住大齿轮然后拉动小车转弯，观察后轮相对地面滑动的情况，调节后轴螺母，使得后轮与地面基本不发生拖滑为宜。这样小车在入弯时既能灵活转向，又能避免车轮侧滑。3.5 齿轮传动机构调整智能小车后轮采用R S-3 8 0 s H-4 0 4 5电机驱动，由竞赛主办方提供。电机轴与后轮轴之间的传动比为9：3 8 （电机轴齿轮齿数为1 8,后轮轴传动轮齿数为7 6）0齿轮传动机构对车模的驱动

29、能力有很大的影响。齿轮传动部分安装位置的不恰当，会大大增加电机驱动后轮的负载，从而影响小车的动力性能。对齿轮传动机构进行调整的原则是：保持电机齿轮和减速齿轮之间啮合具有合适的间隙。齿轮啮合过松，会影响动力传递，并且容易打坏齿轮，啮合过紧，又会增加传动阻力，浪费动力。在调整齿轮啮合间隙的时侯可以先慢慢转动后轮，看看在啮合时有没有打齿的现象。然后用电机带动后轮空转，听听两齿轮啮合12第三章赛车机械结构调整时的声音，如果声音很大很刺耳，说明齿轮间的间隙过大，啮合效果不理想，如果声音发闷或有明显的 嗒、嗒 声，则说明齿轮间的配合间隙过小，或者两齿轮轴不平行，电机负载较大。据此，可以通过调节电机安装螺钉

30、的位置对两齿轮啮合间隙进行调整。调整好的齿轮，应无打齿现象，传动噪音也很小。另外,为使齿轮啮合顺畅、平稳，减少传动阻力，还应该经常对齿轮进行涧滑和保养。3.6其他机械模块调整在调试过程中，除去对以上部分的调整以外，其他机械部分也要酌情调整。悬挂臂、转向联杆的动作要灵活自如，准确无误；主悬架要松紧适度；驱动电机的螺丝一定要上紧，并要经常检查，一旦在行驶中松动就会造成零件的损坏。调试中还发现主悬架的第二个螺丝容易松动，测试时要检查是否上紧。13第四章路径识别模块检测赛道相对车模的偏移量、方向、曲率等信息是实现赛车自主沿着赛道运行的信息基础，获取更多、更远、更精确的赛道信息是提高赛车运行速度的关键。

31、道路识别方式有很多种，总体上可以分为两大类：方案一：传感器采用CCD/CMOS摄像头检测方式，简称摄像头方式。摄像头方式的优点是探测距离远，探测精度高，但摄像头方式电路设计复杂，需要视频信号同步分离、工 作 12伏电源电路等辅助电路，软件计算量大，检测信息更新速率慢。方案二：使用红外检测方式，它包括一个可以发射红外光的固态发光二极管和一个用作接收器的固态光敏二极管（或光敏三极管）。由于赛道由黑白两种颜色组成，白色为底色，黑色是路径，通过判断红外接收管端电压可以检测黑线与小车中位的偏差。通过合理安排红外发射/接收管的空间位置可以检测到模型车前方道路相对车模的位置。该方案的优点是电路简单、信号处理

32、速度快。综合考虑上述两个方案的优缺点，最后选择第一种方案：红外检测方式。4.1 传感器的选择与安装4.1.1 传感器的选择为了使智能小车的前瞻距离变大，在选择光电传感器时，可选择发射功率大、探测距离远、接收灵敏度高的传感器。可以选择独立的红外发射与接收管,也可以选择一体化的选择发射/接收管。为了选择合适的光电传感器型号，设计了传感器选择电路，如图4.1所示。14第四章路径识别模块4.1.2传感器的安装OUT图 4.1 传感器选择电路1、光电传感器的布局与安装间距光电传感器的布局可以采用直线排列、折线排列和圆弧排列等形式，也可以采用一排安装或多排安装的形式，由于直线排列的控制策略较为简单，故本系

33、统采用一字型直线排列的布局方案，如图4.2所示。图 4.2 光电传感器字形排布根据赛道规则，中间黑色导引线的宽度为2 5 m m,要求传感器个数最多为15第三届全国大学生智能汽车邀请赛技术报告16o除掉一个转速传感器，可用于探测路径的传感器为15个。传感器的安装一般要满足传感器下面的道路中心线可以引起一个或者相邻两个传感器响应为准，而传感器允许的布置宽度为25cm。因此，设定传感器间隔时既要满足一定的密度以保证过弯道时轨迹相对精确，又要尽可能的防止舵机盲目打舵降低小车的速度，通过反复测试，最后选择安装13对相互独立的光电传感器，间距设为 17.5mm。2、光电传感器径向探出距离径向探出距离是指

34、光电传感器距离车头的径向距离。它主要影响智能小车的前瞻性。由于舵机、电机和车都是高阶惯性延迟环节，从输入到输出需要一定的时间，越早知道前方赛道的信息，就越能减小从输入到输出的滞后。检测车前方一定距离的赛道叫做前瞻，在一定的前瞻范围内，前瞻越大的传感器布局方式，其极限速度就会越高。在过弯过程中，由于能探测到赛车前方较远位置的赛道信息，有大前瞻的赛车就会出现不完全沿线走，而是在拐弯内侧前进的现象，这样就缩短了赛车实际走过的路线长度，有利于提高成绩。因此，在不违反比赛规则的前提下，探出距离是越大越好，但是距离过大，智能小车可能会发生重心偏移，造成行驶不稳、振动等一系列问题，为了能既增加径向距离，又不

35、引起重心偏移，可以采用带倾角的传感器安装方式，如图4.3所示。光电传感器光电传感器Y .、I投射目标点！投射目标点不带倾角安装 带倾角安装图 4.3 传感器带倾角安装示意图3、光电传感器的固定光电传感器固定在车身的前方，属于小车整体的探出部分，而小车的重心主要集中在车体中心偏后的位置，因此光电传感器的固定应具有轻便、稳固、防震力强的特点，防止光电传感器在小车运行中，上下左右的摆动，影响小车的整体性能。采用两根接近3/4的圆弧形细铁棒作为光电传感器的固定力臂，如图4.4所示。16第四章路径识别模块图 4.4 光电传感器的固定根据前面测试的光电管的性能参数，再结合光电传感器的固定方式，经过反复地试

36、验调试，确定光电传感器的固定参数为（如图4.4）：探出车身距离：8cm离地面的距离：11cm与地面的夹角：45采用倾斜安装后，外界环境光线对光电传感器的影响增大，可以在独立的红外接收管上安装黑色套管，使其只接收前方一定角度内的红外光线。实践证明，在接收管安装适当长度的黑色套管可以完全避免外界光线和相邻的发光管的影响。4.2电路模块1、供电模块该模块利用DC-DC直流变换原理，通过直接通过宽电压输入，高效低噪声输出的DC-DC变换得到L6V的电压来给发光管供电,可以连续输出3A的电流,并且输入电压范围较大，输出效率较高，电压稳定。其电路如图4.5所示。17第三届全国大学生智能汽车邀请赛技术报告由

37、于对13个光电管的连续供电消耗的功率很大，造成赛车在第二圈中供电不足，不利于整个系统的正常运行，因此光电传感器可采用触发式供电，当AD采样时光电发射管工作，AD不采样时光电发射管停止工作，大大提高了电池电源的使用效率。此处的触发电路，采用三极管和场效应管来实现将控制信号转化为功率信号，如图4.6所示。由于所采用的是低内部电容的场效应管IRF3205,系统响应很快，完全满足设计要求。当AD采样时，令TR为高电平，三极管和场效应管导通，光电发射管向外发射红外线；当AD不采样时，令 TR为低电平，三极管和场效应管截止，光电发射管停止工作。图 4.6触发电路18第四章路径识别模块4.3路径识别算法4.

38、3.1 二值化路径识别算法二值化路径识别算法的原理是：设置一个阈值black_value,当某个数小于阈值时，将该数记为0,否则记为1。由于赛道是白底黑线的，传感器检测到黑色和白色时的输出电压值有较大差别，因此可以应用二值化方法检测路径。阈值 black_value可以用如下方法确定：首先将小车放置在跑道中间，保证最中间的编号为6 的红外光电管正好在黑线正上方，在小车启动前先对其进行一次A/D转换，得到一个电压值，考虑到各个传感器的差异以及转换的误差，将该电压值加上一个偏差值，就得到了 black_value的值。具体软件设计如下所示：word ADGet Value;main()取阈值whi

39、le(!ATDOSTAT1 _CCF6);等待通道 6 转换结束AD GetValue=ATD0DR6;读通道6 的转换结果blackvalue=(byte)AD_wValue+0 x42;二值化处理for(i=0;iblack_value)AD_wDatai=l;else AD_wDatai=0;将 红 外 接 收 管 的 电 压 值 进 行 A/D 转 换 后，保存到一个一维数组AD_wData13中，然后对数据进行二值化处理，处理后的一维数组AD_wData13的元素只有1 和 0 o 由于红外光电管的间距为18mm,而黑色引导线的宽度为25m m,这样就会有三种情况出现。第一种情况：只

40、有一个光电管检测到黑线。由于传感器一共有13个，所以就有13种状态，分别是第0 个检测到，第 1个检测到第二种情况：同时有两个光电管检测到黑线。由于赛道上只有一条黑色引导线，同时检测到黑线的只可能是相邻的两个光电管，如 1和 2,如果出现1和19第三届全国大学生智能汽车邀请赛技术报告3都检测到黑线，而2检测到白色的情况，说明数据出错，有可能是1和3中的其中一个光电管坏了，也有可能是软件的问题，此时应检查硬件，在确定硬件没有损坏的情况下，修改算法。因此，第二种情况有12种状态，分别是0和1检测到，1和2检测到第三种情况：没有一个光电管检测到黑线。此时判断小车冲出赛道。因此AD_wData13一共

41、有2 6种状态，分别反映了小车与黑色引导线的相对位置情况，通过判断AD_wData13数组的状态，就可以得到黑线的信息，从而对小车的舵机转角和电机速度进行控制。小车行驶到弯道时，尤其是小车速度较快时，舵机需要快速反应。但是传感器的编号从0到1 2,优先级高的光电管所对应的状态，舵机反应快，反之优先级低的光电管，舵机反应慢。试验中发现，中间的光电管处于黑线上方的几率相对两边的传感器来说比较大，因此可以设置中间的光电管优先级最高，位置越偏优先级越低。在对AD_wData13进行状态判断时，先判断优先级高的状态，一旦检测到，就停止判断下一个状态，否则继续判断下一优先级的状态。二值化路径识别算法的流程

42、图如图4.7所示：图4.7二值化路径识别算法的流程图采用二值化路径识别算法具有容易理解、编程简单的优点，但是阈值的确定需要先将小车放置在跑道中间，保证最中间的编号为6的红外光电管正好在黑线正上方，由于人眼的观看角度不同，容易产生较大误差。另一方面，初始20第四章路径识别模块的电压值需要加上一个偏差值，该偏差值的确定完全凭借凑数法来实现，对这个偏差值取多少是最合适的没有一个规定的标准，因此误差比较大。为了解决以上问题，我们提出了一种将有限间距排布传感器采集的数据连续化方法，来实现连续路径识别。4.3.2归一化连续路径识别算法由于红外光电管的特性曲线呈抛物线型，其电压大小与传感器距离黑线路径识别线

43、的水平距离有定量关系：离黑线越近，则电压越低，离黑线越远，则电压越高，如图4.8所 示（具体对应关系与光电管型号以及离地高度有关）。黑线位置图 4.8 传感器电压与偏移距离关系由于最多只有两个光电管检测到黑线，可以取两个最小电压值m iny和miny2,对应的光电管编号为minx和 minx2,首先判断同时检测到黑线的是否是相邻的光电管，其次判断两个电压值的关系。如果miny=miny2,如图4.5 的a所示，则说明黑线处于m inx和 minx2之间；如 果 m iny不等于m iny2,且miny2-miny的差小于阈值K,如图4.5的b 所示，则miny越小，黑线就越靠近minx；如果m

44、iny2-miny的差大于阈值K,如图4.9的 c 所示，则判断黑线处于minx位置。21第三届全国大学生智能汽车邀请赛技术报告图4.9 miny和miny2的关系具体的计算方法如下：(l)a情况:dif _ do able=min x+min x22(2)b情况,min x+min x2 min y2-min y minx-minx2dtf double=-1-x-2K 2(0 min y2-min y K)didouble=minx;else difdouble=(minx+minx2)/2.+(miny2-miny)*(minx-minx2)/(2*K);由示意图可知，连续算法的关键是K

45、 值的确定，由于K 值是只有一个光电管检测到黑线时，经过归一化后该光电管的电压值与相邻电压值的差，所以可以通过在线调试来确定K 值。将编号为1 的光电管放在黑线的正上方，观察编号为0 和 2 的光电管归一化后的电压值AD_wDataO和 AD_wData2,比较两个值，取最小数减去AD_wDa皿1 ,得到的差即为K,重复测量多次，取平均值。试验证明，采用连续算法后，小车检测到的黑线位置更加精确，控制性能明显好于采用离散算法，因此最后确定本系统采用归一化连续路径识别算法来进行道路检测。22第五章赛车转向模块对智能车进行方向控制，就是利用红外光电传感阵列提取出黑线位置信息,然后通过一定的控制策略，

46、使智能车能够实时跟踪黑线走向，自动控制舵机带动前轮转向，完成自动寻迹行驶。智能小车在行驶的过程中是一个参数不定的系统。一辆具有智能化的小车必须能够根据赛道的特征将参数调整到最佳，以实现最优控制。5.1舵机的安装智能小车采用的是Futaba牌舵机，型号为HS-3010,接口采用了三线连接方法，黑线为电源地线，红线为电源线，外 接5V电源，另外一根连线（白色）为控制信号线。该舵机扭力大，稳定性好，控制角度精确，但是响应灵敏度较差，存在严重的机械滞后。为了最大限度地提高舵机的响应灵敏度，安装了两个舵机分别用于左前轮和右前轮的控制。由舵机的参数和实际测试可知：在允许范围内提高舵机的供电电压能有效的提高

47、舵机的扭矩和响应速度。经过测试，舵机可以直接由7.2 V电源供电。但是舵机的工作电流变化很大，是个很大的干扰源，因此将舵机的供电电路与其他供电电路分开，采用单独供电方式，并且在电源正极和舵机之间串联一个二极管，防止舵机影响电源电压。这样，虽然增加了系统功耗，但却有效地减小了舵机的机械滞后，为小车的稳定快速行驶奠定了基础。图 5.1舵机安装24第五章赛车转向模块5.2 舵机的控制舵机是一个位置随动系统，从结构上看，它由舵盘、减速齿轮组、位置反馈电位计、直流电机和控制电路组成。通过内部的位置反馈，转向舵机可以使其舵盘输出转角正比于给定的控制信号，因此对于舵机的控制可以使用开环控制方式。通过实践证明

48、，当左舵机和右舵机的控制信号相同时，小车也能很好地进行方向控制，因此，考虑到软件的简单性，在本系统中，两个舵机的控制信号是相同的。舵机的转向是由PWM(Pulse Width Modulation脉冲宽度调制)技术来进行实时控制的。其工作原理是：单片机首先对光电接收管采集回来的信号进行处理，然后根据得到的不同检测信号发出不同占空比的PWM控制信号给舵机，舵机在控制信号的作用下转动一定角度。脉冲宽度和舵机转角成线性关系，其计算公式为：a=(L-l.5)*90其中a为舵机转角，单位是度：L是脉冲宽度，单位是ms。舵机转角和脉冲宽度的关系如图5.2所示：图5.2舵机转角和脉冲宽度示意图舵机的控制使用

49、MC9s12DG128的PWM 0与PWM1 口级联成一个16位PWM输出。在单片机总线频率为24MHz的时候，设置级联的PWM周期常数为60000,对应PWM周期为20ms,PWM占空比常数为4500对应输出为1.5ms。改变占空比常数可以改变输出脉冲的宽度。5.3 转向控制算法要想实现智能车方向的自适应控制，首先要将路径识别出来，也就是说要能够判断出赛道的形状特征，计算出赛道的曲率半径，然后再设法将赛道的曲25第三届全国大学生智能汽车邀请赛技术报告率半径与控制小车转向的PWM信号建立起相应的数学关系。这样一来，在小车进入弯道时，就能够通过判断弯道的大小迅速计算出所需的PWM信号来控制舵机转

50、向。下面将对具体的实现方法进行说明。5.3.1转弯半径的计算图5.3小车转弯半径的计算曲率半径R 的推导过程如下：由三角函数关系E _YIE2+H2y/E2+H2 2R 公式 7R=巨 史得2E公式8由此，我们得到了转弯半径的计算公式。在上式中，E 为采集到的黑线位置与小车中心线之间的水平偏移量；H 为红外光电管的前瞻距离，约为0.24m,R为弯道的曲率半径。在这个关系式中，H 为已知量，弯道曲率半径R 的大小只取决于黑线位置与小车中心线的水平偏差Eo5 3 2 转向系统的标定在上述过程中，我们推导出了小车的转弯半径，这为小车的方向控制算法奠定了数学基础。接下来，将要进行的是小车转向系统的标定