车模论文.docx

1、车模论文 第一届“飞思卡尔”杯全国大学生智能汽车邀请赛技 术 报 告附录B 基于PID控制实现路径自动识别的赛车注 学 校：杭州电子科技大学队伍名称：疾风 参赛队员：刘伟 张思恩 马必略带队教师：高明煜 关于技术报告和研究论文使用授权的说明 本人完全了解第一届“飞思卡尔”杯全国大学生智能汽车邀请赛关保留、使用技术报告和研究论文的规定，即：参赛作品著作权归参赛者本人，比赛组委会和飞思卡尔半导体公司可以在相关主页上收录并公开参赛作品的设计方案、技术报告以及参赛模型车的视频、图像资料，并将相关内容编纂收录在组委会出版论文集中。参赛队员签名： 带队教师签名： 日 期： 摘要本系统设计以MC68S912

2、DG128微控制器为核心，通过多个红外光电传感器检测模型车的运动位置和运动方向，霍尔传感器检测模型车的速度，运用PWM技术调节驱动电机的转速和舵机的方向，同时用PID控制算法，完成对模型车运动速度和运动方向的闭环控制。实验结果表明，系统设计方案可行。关键词：单片机 红外光电传感器 霍尔传感器 PWM PIDAbstractThe system is based on the micro-controller unit MC68S912DG128.The micro-controller adjusts the model cars moving position and direction b

3、y some infrared photoelectricity sensors.And use the Hall sensor measure the cars moving speed. And it uses PWM technique adjusting the rotate speed of driving electromotor and direction of steering electromotor.In the same time it uses PID controlling arithmetic accomplisling closed loop control of

4、 model cars the moving speed and dircction .The result of experiment indicate that the design scheme of system is doable.Keywords: micro-controller infrared photoelectricity sensor Hall sensor PWM PID目录摘要 IAbstract II第一章 引言 1第二章 方案的选择与论证 32.1电动机驱动调速模块 32.2路径识别模块 32.3车轮检速模 32.4 车速控制方法 42.5小结 4第三章 系统的

5、具体设计与实现 53.1 系统硬件设计 53.1.1 MCU模块 53.1.2 路径识别模块设计 73.1.3 电机驱动模块设计 93.1.4 测速模块设计 113.1.5 电源模块设计 123.2 系统的软件设计 133.2.1 主程序 133.2.2 路径计算 143.2.3 舵机控制 163.2.4 速度控制 163.2.5 突发情况判断 21第四章 调试与测试结果 224.1调试软件 224.2红外传感器测试 224.3霍尔传感器测试 224.4舵机测试 224.5车速测试 234.6刹车测试 234.7实际跑道测试 234.6模型车的主要技术参数说明 24第五章 结 论 25参考文献

6、 26附 录 A I附 录 B XVIII 第一章 引言本次车模竞赛要求赛制作一辆以MC68S912DG128微控制器为核心，能够自主识别路线的模型车，在专门设计的跑道上自动识别道路行驶，以最短的时间跑完全程。系统的设计需要尽可能做到电路简洁、对路径地识别达到一定的准确度，对舵机和驱动电机的控制足够精确。具体研究内容主要有： 1.路径识别路径识别模块是模型车系统的关键模块之一，路径识别方案的好坏，直接关系到最终性能的优劣。现在常用的方案有采用CCD摄像头寻迹方案和光电传感器寻迹方案。用CCD摄像头寻迹虽然可以更远更早地感知赛道的变化，但是信号处理比较复杂，占用的资源比较多，处理的速度也比较慢。

7、相对而言光电传感器寻迹的方案更常用，所谓光电传感器寻迹方案，即路径识别电路由一系列发光二极管、接收二极管组成，由于赛道中存在轨迹指示黑线，落在黑线区域内的光电二极管接收到的反射光线强度与白色的赛道不同，由此判断行车的方向。该方案中，光电传感器的排列方法、个数、彼此之间的间隔都与控制方法密切相关，在不受到外部因素影响的前提下，能够感知前方的距离越远，行驶效率越高，由于光电传感器电路板不可能伸出车体太远，因此可以调整了光电传感器电路板与地面的夹角，使光电传感器可以感知更远一点的赛道情况。2. 电机控制系统1234电机是模型车的核心部件，分为舵机和驱动电机，所以对电机的控制非常重要，要做到足够精确，

8、其中驱动电机的速度控制最为重要。在八十年代以前，电机的调速系统主要是以线性电路为核心的模拟调节控制系统，用的是分立元件。进入八十年代中期，随着技术的发展，模拟调节器向紧凑型方向发展，调速装置力求标准化，系列化。进入八十年代后期，随着计算机技术尤其是单片机技术的发展，直流调速装置出现了以微处理器微核心的数字调速器产品，到九十年代在国外发达国家已取代模拟调节装置成为主流产品。用单片机来调节电机的速度有个非常好的优点是灵活性，由软件来实现控制方案不同的控制方案只要改变软件，而无需改变硬件就能实现。至于控制算法，数字PID控制算法 是工业控制中最常用的，对大多数控制对象，均可以达到满意的控制效果。利用

9、数字PID控制算法来控制直流伺服驱动电机的速度是一个可行的方法。它能使模型车在行驶过程中更稳和更快。模型车的整个制作和安装过程遵循尽可能地减轻车子重量和合理安装各个模块这两个宗旨。整个系统主要由路径识别模块、MCU模块、直流伺服电机驱动模块和车速检测模块这四部分组成，所以硬件电路板也分成这四块来制作和安装。在电路板的设计上，我们利用Protel DXP进行PCB设计，并且采用热转印的方式制作腐蚀电路板，大大减少了模型车的制作和调试周期，此外，腐蚀的电路板也便于固定安装，使车体结构紧凑又牢固而且外形美观。本文内容的安排如下所示：第一章 引言 本章主要介绍了模型车系统主要技术的发展状况，概述了车子

10、的制作情况。第二章 方案的选择与论证 本章对系统硬件模块方案和软件控制方法进行了选择与论证。第三章 系统设计与实现 本章对选定的系统方案从硬件和软件这两个方面对各个模块作了详细的介绍。第四章 调试与测试结果 本章主要介绍了模型车在实际场地上的调试、测试和结果。第二章 方案的选择与论证根据竞赛要求，该模型车系统由电源模块、车速检测模块、直流电机驱动模块、路径识别模块、单片机模块等组成。对其中几个模块的实现，分别有以下一些不同的设计方案：2.1电动机驱动调速模块方案一：采用继电器对电动机的开或关进行控制，通过开关的切换对小车的速度进行调整。这个方案的优点是电路较为简单，缺点是继电器的响应时间慢、机

11、械结构易损坏、寿命较短、可靠性不高。 方案二：采用PWM。这样可以直接利用单片机来输出PWM波，使用方便，还保证了可以简单地实现转速和方向的控制，可靠性高是一种广泛采用的直流电机调速技术。基于上述理论分析，拟选择方案二。2.2路径识别模块探测路面黑线的大致原理是：光线照射到路面并反射，由于黑线和白纸的反射系数不同，可根据接收到的反射光强弱判断是否偏离黑线。方案：采用CCD摄像头寻迹。该方案的优点是可以更远更早地感知赛道的变化，信号数据量较大，大量占用CPU资源，还需要占用很大的存储空间，处理速度慢是摄像头方案的难点之一。方案二：固定脉冲调制的反射式红外发射接收器。考虑到环境光干扰主要是直流分量

12、，如果采用带有固定交流分量的调制信号，则可大幅度减少外界干扰；另外，红外发射管的最大工作电流取决于平均电流，如果使用占空比小的调制信号，在平均电流不变的情况下，瞬时电流可以很大(50100mA)，这样也大大提高了信噪比。基于上述考虑，拟采用方案二。2.3车轮检速模方案：采用霍尔集成传感器。该器件内部由三片霍尔金属相组成，当磁钢正对金属板时，由于霍尔效应，金属板发生横向导通，因此可以在车轮上安装磁钢、而将霍尔集成片安装在固定轴上，通过对脉冲的计数进行车速测量。方案二：根据滚轮鼠标的工作原理，采用断续式光电开关。由于该开关是沟槽结构，可以将其置于固定轴上，再在车轮上均匀地固定多个遮光条。让其恰好通

13、过沟槽，产生一个个脉冲。通过脉冲的计数，对速度进行测量。以上两种都是比较可行的转速测量方案。尤其是霍尔元件，在工业上得到广泛采用，电路简单，能够稳定的输出方波信号，可通过单机中断I/O口直接进行测量，因此拟采用方案一。2.4 车速控制方法方案一：采用开环控制方法。控制装置与受控对象（电机）之间只有顺向作用而无反向联系，每次给一个速度期望值，对应有一个实际速度输出，方法简单，容易实现。系统的控制精度完全取决于电机的特性，。开环控制的缺点是抗扰动能力差，当有扰动作用时都将使被控量偏离给定值，直接影响系统的控制精度。方案二：采用闭环控制方法。把系统的输出量（实际车速）反馈到输入端与输入量（速度的期望

14、值）相减得到偏差，再由偏差产生一个控制量去消除偏差，如PID算法。这种控制方法使输出量也参与了控制，相对复杂。但是它能有效地抑制内部和外部各种形式的干扰，对干扰不甚敏感。因此可以对元件的精密度的要求有所降低。基于以上分析，拟采用方案二。2.5小结经过上述方案比较，最终决定了方案如下：电动机驱动与调速模块：采用PWM电机驱动。车轮检速模块：采用霍尔集成片。路径识别模块：采用固定频率调制的红外反射式发射接收器。车速控制方法：闭环控制方法（PID）。第三章 系统的具体设计与实现系统总体设计方案的硬件实现框图如图3.1所示。硬件电路设计采用模块化设计，由简单的接口互相连接，便于安装和调试。图3.1 系

15、统总体结构框图MCU通过检测模型车头部八对传感器的输出信号，来计算黑线所处的位置、偏移速度和偏移量，测速模块向MCU发送测速中断，根据中断时间测出车轮转速，MCU再根据当前的黑线位置及车速对电机进行控制。电池提供电源模块和电机驱动模块电力。3.1 系统硬件设计3.1.1 MCU模块为了减轻车模整体重量，降低重心，并且便于电路板的固定安装，单片机部分电路板形状根据车体实际情况进行了重新设计，但电路完全按照组委会提供的核心S12的电路板基本电路进行设计，在其中放置了舵机控制、红外探头、霍尔测速、电机控速、串口等接口，另外安装了8只红色LED指示灯，方便调试。舵机直接由单片机产生的PWM信号控制，无

16、需外加驱动电路。整个模块的电路如图3.2所示：图3.2 MCU模块电路图I/O资源分配如图3.3：图3.3 I/O资源分配图3.1.2 路径识别模块设计经过不断的调试改进，最终确定了较为合适的红外探头尺寸和探头对数，即消除了盲区又增加了探测宽度。如图3.4图3.4 红外传感器布局图图 3.5 红外信号发射电路 红外信号发射电路如图 3.5，采用普通的红外发射管，调制信号由单片机的PWM发生器提供10K调制信号，驱动所有发射管总电流约100毫安，为了减轻三极管负荷，通过两只PNP三极管分别驱动两组红外发射管，每组四只，电路工作时三极管处于开关状态，8550放大倍数约为100，为了使其工作在饱和状

17、态，VT1和VT2基极电阻选取5.1K。由于每只发射管的参数都有一定差异，且发射管的发射功率、照射范围等都有所不同，所以每只发射管都采用一只1K的精调电位器进行发射功率的细微调节，以确保接收电路送回的模拟电压信号能尽量保持一致，从而简化算法，加快计算速度，确保稳定。图3.6 红外信号检测放大电路红外信号的检测放大电路如图3.6，由红外接收管检测红外信号，由运放LM258放大。根据数据手册提供的频响参数 如图3.7 ，LM258对10K的信号最大增益约为35(dB)。由于红外信号比较微弱，为了得到较大的增益，选R5=1K,R6=100K 故： Av=(R5+R6)/R5=101 (1)放大倍数约

18、为101倍。为了尽量简化电路，减轻车体重量，加强电路的可靠性，电路中都使用无源滤波器。红外接收管接收到的信号由CI2和RI2高通滤波后输入运放的同相输入端，然后经过运放放大，再由R20和C2低通滤波滤除10KH z的调制信号，输出直流电压，最后由单片机的内置AD对其进行采样，从而得到所接收到的红外信号强度。PWM驱动和接收放大波形如图3.8。由于要求传感器能以较高的速度探测轨道变化，所以低通滤波器不能选取太大的电容，接收到的信号比较微弱(图中幅度非实际比例)，放大之后经过一阶无源低通，得到一个带锯齿波交流分量的直流电压，这个交流分量可以从软件上进行滤波，只要幅度不大于轨道黑线的变化，就不会对判

19、断造成影响。图3.7 LM258频率相应曲线图3.8 红外信号分析波形图3.1.3 电机驱动模块设计为了提高赛车在赛道行驶时的稳定性，防止赛车速度过块冲出赛道，必须增加赛车的快速刹车功能。由于竞赛规则不允许改造轮轴，因此采用电机反向制动的方式进行刹车，从而要求电路具有极性转换功能，为此采用H桥电路结构，并用IRF9540(PMOS)和IRFZ44N(NMOS)作为桥臂开关，在输出端加LC滤波器，平滑电机驱动波形，驱动电路如图3.9所示：图3.9 H桥电机驱动电路电机的速度由单片机产生的PWM占空比决定。PWM控制信号和电机驱动电流示意图如3.10，红色箭头(t0-t1)为电机正转电流方向，绿色

20、箭头(t2-t3)为电机反转电流方向。图3.10 H桥驱动示意图 3.1.4 测速模块设计按照霍尔期间的功能可以分为：霍尔线性器件和霍尔开关器件。本电路采用霍尔开关器件A44E对车速进行测量。根据车模的轮轴结构，设计了如图3.11的测速方式。在轮轴的齿轮盘上均等的安装了四颗磁钢，传感器信号引脚接单片机外部中断口PJ7。霍尔传感器在无磁场靠近时信号引脚保持高电平，当磁钢接近它时，传感器输出低电平，触发单片机中断进行计数。因此车轮每转动一圈就可以进行四次车速测量，速度更新快，便于PID准确的进行计算，达到稳定控制速度的目的。 图3.11 测速模块机械结构图3.1.5 电源模块设计标准车模使用7.2

21、V 2000mAh Ni-cd蓄电池，但整个系统其中，单片机系统、路径识别的光电传感器和接收器电路、车速传感器电路需要5V电压，舵机伺服电机工作电压6V，所以单独设计了供电模块如图3.12，提供各个模块所需要的正常工作电压。图3.12 系统供电结构图由于系统采用7.2V电池供电，线性稳压器一般要求3V以上的压差才能正常的输出稳定的电压，所以我们最终选取了只需少量外围元件的集成开关电源LM2576。开关电源的特点具有电源效率高，电压调整能力强，调整迅速的特点，而且无需使用散热片，减轻了车体重量。LM2576 adj 经电位器调整输出稳定的6V电压，再经过一只肖特基二极管IN5819(40V/1A

22、)和一只整流二极管IN4001(100V/1A)降压，输出5V电压。设计电路如图3.13。图3.13 系统供电原理图LM2576-adj 由上图RP5和R8组成的反馈网络调整输出电压，当R8=2K且RP5=9.7K时，输出电压为6V，调整通过RP5(10K)精调电位器实现。3.2 系统的软件设计系统的软件采用模块化设计，具有较强的可读性，可移植性。程序使用C语言进行编写，极大的提高了编程效率，调试方便快捷。3.2.1 主程序图3.14 主程序流程图整个程序的总体结构如图3.14，主程序的主要功能是对开机参数进行初始化，更新各个中断输出的数据，计算并转换成其他程序模块需要的数据格式，同时调度各个

23、控制子程序对车模进行实时控制。3.2.2 路径计算对车模的路径计算采用定时中断的方式，每隔1毫秒就对传感器进行一次采样，以确保车模在高速运行状态下能在足够短的时间内判断出轨道的变化，并及时刹车，防止车速过快冲出跑道。经过实际的测试，车模在运行时并不需要很高的精度，为了简化算法，加快计算速度，我们最终确定使用8对红外传感器对路径黑线进行探测，如图3.15,黑线位置用0-9表示，其中1-8表示各个探头的编号，0和9分别表示右边出轨。传感器部分输出模拟电压(0-3.5V)，通过MC68S912DG128片内的8路10位AD对其进行采样。白色反射面反射大部分的红外线，而黑色的反射面则吸收大部分红外线，

24、根据实际测试，将传感器放置在白反射面上测得的电压约为1.7V,黑色反射面上为0.5V,AD测得的数据为100和350。当数据低于150时认为是黑线，高于300则认为是白色面。对于采样的数据主要有两个判断,如图3.16。因为竞赛规则允许出现交叉跑道，而且在起跑线有两条起跑黑线标记，探头将会探测到两个或两个以上符合黑线要求的数据，所以程序首先判断是否出现两条惑两条以上黑线，如果是则输出上次计算的黑线位置数据，车模将保持原有运行状态，顺利通过起跑线或交叉跑道而不受影响；其次是判断是否没有黑线，如果是则读取上次的黑线位置数据来确定出轨方向，数据为第八探头是右边出轨，数据为第一探头则是左边出轨。图3.1

25、5 路径计算示意图图3.16 路径计算流程图3.2.3 舵机控制车模自带的舵机通过PWM来控制角度如图3.17，经过实际调试经验，我们将舵机设置为09十个档位。根据路径计算程序送出的数据，可以判断赛车当前所处的位置状态，根据这个状态给予相应的舵机控制量，使其转动到并保持相应角度。图3.17 舵机控制流程图3.2.4 速度控制直流伺服电机控制系统的控制算法有很多，但工业控制中运用最广的是PID。PID控制是最早发展起来的控制策略之一，其算法简单、鲁棒性好、可靠性高，此外PID控制方案并不需要建立精确的受控对象的数学模型，而且采取PID控制策略的控制效果一般是比较令人满意的和成功的，所以PID一直

26、以来被广泛用于工业控制。 所谓PID控制就是比例、积分和微分控制。对于实际的物理系统，其被控对象通常都有储能元件存在，这就造成系统对输入作用的响应有一定的惯性。另外，在能量和信息传输等因素会引入一些时间上的滞后，往往导致系统的响应变差，甚至不稳定。因此，为了改善系统的调节品质，通常在系统中引入偏差的比例调节、积分调节和微分调节，以保证系统的快速性、提高控制精度和消除系统惯性的影响。这就形成了按偏差PID调节的系统，其控制结构如图 所示。其控制规律为： (2)图3.18 PID控制系统框图式中： 控制量； 系统的控制偏差； 比例增益； 积分时间； 微分时间； 系统给定的希望达到的速度值； 电机的

27、转速。 在单片机控制系统中，使用的是数字式PID控制器，数字式PID控制器通常又分为增量式和位置PID控制算法，系统采用增量式PID。由于单片机控制的是一种采样控制，它只能根据采样时刻的偏差值计算控制量，因此式（21）中的积分和微分项需要进行离散化处理。离散化后： (3)增量式PID运算的输出增量为相邻两次采样时刻所计算的位置值之差，即 (4)由式（3-3）可知： (5)所以 (6)式中：k时刻的速度给定量与速度反馈量的偏差 k时刻的输出控制量图3.19是根据公式 6的基于PID算法的速度控制器的子程序流程图 图3.19 基于PID算法的速度控制器的子程序流程图但是，上述这种PID是一种理想的

28、PID控制器，其实际控制效果并不理想。尤其是在直流伺服电机的启动、停止或大幅度改变给定值R（s）时，由于在短时间内产生很大的偏差，往往会产生严重的积分饱和现象，以致造成很大的超调和长时间的振荡。这是不能容忍的。为了克服这个缺点，本系统采用积分分离方法（PD-PID）控制,即在被控制量开始跟踪时，取消积分作用；而当被控制量接近给定值时，才利用积分作用，以消除静差。首先，选择一个合适的作为PD-PID算法的分界常数。一般来说此分界常数要比输出所允许的误差大510倍。然后在每次采样电机速度时计算偏差值en(k),根据偏差值与的大小比较来决定哪一种控制方式。所以对图 作了一定的改进。PD-PID控制程

29、序框图如图3.19所示： 图3.20 PD-PID控制程序框图在系统初始化程序中，应当设置好误差初始值en(k)=en(k-1)=en(k-2)=0,且控制初始值un(k-1)=0.在图3.20的PID速度控制器的子程序中，关于Kp、Ki=KpT/Ti、Kd=KpTd/T等参数的整定可以采用解析法与经验法相结合的方法。先给三个参数一个初值，在具体调试时，可根据经验凑试法在上述理论值的基础上作微调，即先整定比例部分，再整定积分部分，然后再整定微分部分。3.2.5 突发情况判断对于突发情况的判断，探头的偏移量和偏移速度计算对于车体行驶状态是非常重要的，该部分软件采取定时中断方式进行，如图3.21，

30、定期的对测得的路径情况进行处理和判断，根据这个情况来对车体的运行速度进行限制。图3.21 突发情况判断流程图 第四章 调试与测试结果4.1调试软件软件调试使用 CodeWarrior 3.1，编程器使用BDM。4.2红外传感器测试将红外传感器正对白反射面，通过改变距离来观察传感器反馈的电压值，结果如表4.1。测试设备：数字万用表(CDM-8045) 直尺(精度1mm)表4.1 红外传感器测试参数白反射面距离(cm)1.55.06.57.58.09.09.613.018.030.0反馈电压(v)2.01.91.81.71.61.51.41.00.80.24.3霍尔传感器测试在主伺服电机(空载)加

31、恒定电压对霍尔传感器输出的信号进行观察，测试结果如表4.2。测试设备：稳压电源(MPS-3003L-3) 数字万用表(CDM-8045) 低频示波器(CA4094)表4.2 霍尔传感器测试电机电压(V)2.02.53.03.54.04.55.05.56.0输出频率(HZ)56.79.111.112.514.316.718.521.74.4舵机测试舵机左右偏转角度分为10，20，30，45。 图4.1 舵机旋转角度示意图4.5车速测试将车模放置于平直KT板面，测试距离10m,编写测试程序由单片机控制电机驱动电路输出最高电压来驱动主伺服电机，测试车模的最高行驶速度，测试结果如表4.3。测试设备：秒表(精度0.01s)。表4.3 最高车速测量测试次数