自动控制综合设计无人驾驶汽车计算机控制系统文档格式.docx

1、1系统总体结构 整个系统主要由车模、模型车控制系统及辅助开发系统构成。 智能车系统的功能模块主要包括： 控制核心模块、 电源管理模块、 路径识别模块、后轮电机驱动模块、转向舵机控制模块、速度检测模块、电池监控模块、 小车故障诊断模块、LCD数据显示模块及调试辅助模块。每个模块都包括硬件和 软件两部分。硬件为系统工作提供硬件实体，软件为系统提供各种算法。智能车主要通过自制小车来模拟执行机构，自制小车长为 34.6cm,宽为24.5cm,重为1.2kg，采样周期为3ms检测精度为4mm控制机构中，主控制核心采用 freescale16 位单片机MC9S12DG128B系统 在CodeWarrior

2、软件平台基础上设计完成，米用C语言和汇编语言混合编程，提 供强大的辅助模块，包括电池检测模块、小车故障诊断模块、 LCD数据显示模块 以及调试辅助模块。在路径识别模块，系统利用了 freescaleS12 系列单片机提 供的模糊推理机。因为系统电机控制模块控制小车的运动状态， 其在不同阶段特性参数变化很 大，故采用数字PID控制器，该控制器技术成熟，结构简单，参数容易调整，不 一定需要系统的确切数字模型。控制核心模块：使用freescale16 位单片机 MC9S12DG128B主要功能是完 成采集信号的处理和控制信号的输出。电源管理模块：对电池进行电压调节，为各模块正常工作提供可靠的电压。路

3、径识别模块：完成跑道信息的采集、预处理以及数据识别。后轮电机驱动模块：为电机提供可靠的驱动电路和控制算法。转向舵机控制模块：为舵机提供可靠的控制电路和控制算法。 速度检测模块：为电机控制提供准确的速度反馈。 电池监控模块：对电池电量进行实时监控，以便科学的利用，保护电池。 小车故障诊断模块：对小车故障进行快速、准确的诊断。LCD数据显示模块：显示系统当前状态的重要参数。调试辅助模块：使得小车调试更加方便。系统软件开发平台采用 CodeWarrior for S12 ， CodeWarrior 是 Metrowerks 公司的，专门面向Freescale所有的MCI与DSP嵌入式应用开发的软件工

4、具， CodeWarrior for S12 是面向以HC12或S12为CPU的单片机嵌入式应用开发的 软件包。包括集成开发环境IDE、处理器专家库、全芯片仿真、可视化参数显示 工具、项目工程管理器、C交叉编译器、汇编器、链接器以及调试器。（1） 系统中引用了模糊推理机模糊推理机是 freescaleS12 单片机一个重要的内部资源，利用模糊推理的 三个步骤模糊化、模糊逻辑推理、反模糊化，可以从路径传感信号，推理出 精确的控制量。（2） 系统中采用了数字滤波技术数字滤波技术可靠性高、 稳定性好、 具有很强的灵活性、 可以根据不同的干 扰情况，随时修改滤波程序和滤波方法。1 系统的硬件设计系统硬

5、件系统框图如下：-电源狰理模块 -:电源监寸牢模块:3 := =舵机控模块 速度丰:?测模块;电机驱动模块沢 K 微处理器路径识别模块 =调试駙渤模块法1故障诊断模块:LCD显示模块；以下按各模块来分别设计本硬件电路：（1）电源管理模块电源管理模块的功能对电池进行电压调节，为各个模块正常工作提供可靠的 工作电压。电源管理模块采用7.2V、2000mAh镍镉电池以及LM2576（5V）,LM317（6V稳压芯片构成。（2）微处理器微处理器是freescale 公司推 出的S12系列增强 型的16位单片机 MC9S12DG128亥系列单片机在汽车电子领域有着广泛的应用。（3）路径识别模块路径识别模

6、块是智能车系统的关键模块之一， 其设计的好坏直接影响到智能 车控制系统的性能。目前能够用于智能车辆路径识别的传感器主要有光电传感器 和CCD/CMO传感器。本设计红外发射管和红外接收管以及达林顿管 ULN2803A作为路径识别的传感器。采用双排传感器的策略，第一排传感器专门用于识别路 径以及记忆路径的各种特征点， 第二排传感器专门用于识别起始位置与十字交叉 路口，由于不同传感器的功能不一样， 因此它们的布置与安装位置也是不同。 传 感器的设计主要包括传感器布局， 传感器间隔距离， 径向探出距离， 信号的采集 几部分构成。（4） 后轮驱动和速度检测模块 智能车前进的动力是通过直流电机来驱动的，

7、本设计的驱动直流电机的型号 为RS-380SH输出功率为0.9W 40W在实际生活中，我们可能遇到弯道，为 了能使模型车在过弯道的时候能快速地把速度减下来， 电机驱动部分采用了两块 MC33886组成的全桥式驱动电路，可以控制电机的反转以达到制动的目的。在闭环控制系统中， 速度指令值通过微控制器变换到驱动器， 驱动器再为电 机提供能量。 速度传感器再把测量的小车的速度量的实际值回馈给微控制器。 以 便微控制器进行控制。 因此要对控制系统实行闭环控制， 必须要有感应速度量的 速度传感器。常用的有轴编码器，它主要用来测量旋转轴的位置和转速。（5） 转向舵机模块 凡是需要操作性动作时都可以用舵机来实

8、现。本设计采用的舵机型号为 HS925（SANW）尺寸为 39.4*37.8*27.8，重量 56kg,工作速度 0.11sec/60（4.8V）， 0.07sec/60 （6.0V），堵转力矩6.1kg。一般来讲，舵机主要由以下基本分组成： 舵盘、减速齿轮组、位置反馈电位计、直流电机、控制电路板等。其中，直流马 达提供了原始动力， 带动减速齿轮组， 产生高扭力的输出， 齿轮组的变速比愈大， 输出扭力也愈大，越能承受更大的重量，但转动的速度也愈低。在设计中，为了 提高舵机的响应速度和工作力矩，采用 6.0V 工作电压。（6） 电源电压检测模块智能车采用镍镉电池供电， 由于镍镉电池具有记忆效应，

9、 对电池的不完全放 电会认为降低电池的电容量， 同时深度放电又会导致电池内部结构变化， 造成对 电池的永久损害， 因此，在智能车控制系统中加入电源监控模块， 当电池电压低 于6V时及时自动报警，并切断电路，用来保护电池。本模块用到的主要器件为 光电耦合芯片TLP521-2以及运算放大器LM324（ 7） 液晶显示模块为了完善智能车控制系统的功能， 使其更加人性化， 同时为了方便测试， 在 设计中，加入液晶显示模块，把智能车系统当前状态的一些重要参数显示出来。本模块用到的器件为LCD控制器HD44780（8） 辅助调试模块（红外遥控）在智能车调试阶段， 小车经常出现启停的情况， 例如高速行驶的小

10、车有时因 为异常情况冲出跑道， 以这样的速度碰到周围的障碍物上， 势必损坏小车的部件， 这个时候就需要小车立刻停下来。 为此，在智能车系统上添加红外遥控模块， 当 想启动小车或者想让小车停止时， 只需要按下遥控器上的按键， 就可以很方便实 现小车的启停。本模块主要用红外接收器 HS0038A和红外遥控器来进行遥控控 制。（9） 故障诊断模块小车的故障诊断模块原理很简单，就是利用单片机的SCI0 口，通过RS-232 接口与上位机连接起来， 通过软件编程， 小车不断的向上位机发送代码， 通过故 障代码就可以马上诊断出故障源。2 系统的软件设计 在智能车系统中，软件系统主要有以下几个部分：路径识别

11、算法、后轮驱动 电机控制算法、 转向舵机控制算法、 速度检测等。 单片机系统需要接收路径识别 电路的信号、 车速传感器的信号， 采用某种路径搜索算法进行巡线判断， 进而控 制转向伺服电机和直流驱动电机。 控制策略的选择对于小车的行驶性能是非常重 要的，控制小车的最终目的就是要使小车在平稳行驶的前提下， 尽可能地以最快 速度和最短的路线行驶。下面简要介绍各模块的软件算法。（1）后轮驱动电机控制算法 电机控制算法的作用是接受指令速度值， 通过运算向电机提供适当的驱动电 压，尽快尽量平稳地使电机转速达到速度值，并维持这个速度值。换言之，一旦 电机转速达到了指令速度值， 即使遇到各种不利因素的干扰下，

12、 也应保持速度值 不变。因此我们采用数字控制器的连续化设计技术 PID 控制算法来控制本部分电 路。1数学模型的设定我们设定系统中汽车车轮的转动惯量可以忽略不计， 并且认为汽车受到的摩擦阻力大小与汽车的运动速度成正比，摩擦阻力的方向与汽车运动方向相反。这 样，我们就可以用以下模型来仿真之。根据牛顿运动定律，该系统的动态数学模型可表示为：；ma bv =uy = u我们对系统的参数进行设定，设汽车质量 m=1000kg比例系数b=50N*s/m, 汽车驱动力u=500N根据系统的设计要求，系统中汽车驱动力为 500N时，汽车将在5秒内达到 10m/s的最大速度。同时我们可以将系统的最大超调量设计

13、为 10%静态误差设 计为2%2系统的开环阶跃函数表示为了得到系统的传递函数，我们进行拉普拉斯变换。假定系统的初始条件为 零，则：msV） bV（s）=U（s）Y（s）*（s）所以系统的传递函数为：Y（s） _ 1U （s） ms b运用MATLABS程实现该传递函数模型:m=1000b=50u=500num=1den=m bsys=tf（ nu m,de n）step（u*sys）从图上我们看出，系统不符合5秒的上升时间要求，故需要加上合适的控制3PID控制器的设计PID控制器的传递函数为:我们运用凑试法来确定PID的各参数。首先我们确定采样周期。采样周期的选择既不能过大也不能过小， 过小会

14、使采样频率较高，一方面会加重单片机的负担，另一方面两次采样值的偏差变化太 小，数字控制器的输出值变化不大。同时采样周期也不能太大，太大会降低 PID控制器的准确性，从而不能正常发挥PID控制器的功能。综上所述，我们首先选 择T=0.2s来进行实验，如果效果不好，我们在对其进行微调。然后我们进行比例控制器的设计。比例控制器一般将加快系统的响应，在有 静差的情况下有利于减小静差。我们首先设定 Kp=100,则程序与仿真图为：n c=100;dc=1;dd=tf（ nc,dc）dz=c2d（dd,0.1,tust in）np=1;dp=1000 50g=tf（ np,dp）gd=c2d（g,0.1,

15、sysold=dz*gd;syscld=feedback（sysold,1）step（500*syscld）;title（ 比例控制器作用下的阶跃响应（驱动力为500N）Figure 1日怕 EditViewInsertTools Desktop Window 旦引卩1霁越要口目 E从图中可以看出，系统静态值太高，而且上升时间也远远不能满足设计要求。 我们改变汽车驱动力为10N,再次进行仿真，仿真结果如下（程序中只需改动 step 语句为 step （ 10* syscld ）即可）：OGGFileEdit View insert Tools Desktop Window 旦El卩* H S

16、A 題 Q旳 逻 0 E65比例整制器作用卞的阶跃响应【驱动力为1DN、4 32我们看到系统静态值虽然产生了较大幅度的下降，但仍然不能满足要求。我 们再将Kp从100逐步增加，直至改为1500进行测试（程序改动为nc=1500）, 我们发现此时仿真静态值与静态误差以及上升时间已基本满足系统需求， 从而我们完全可以通过继续增加比例系数来调节系统特性，进而理论上可以省去积分环 节。但是随着比例系数的增加动态过程将让人不满意， 其动态变化将过快，从而给驾驶人员带来身体上的不适（图二为比例系数增至 5000时的仿真波形，我们发现在0.1s的时间内，汽车速度将从2m/s骤增至5m/s），所以我们从人性化

17、角 度考虑，增加积分环节：Fioure 1 c c 积分环节的加入可以调节系统的静态误差。我们设定 Kp=1000, Ki=10,此时程序和仿真图形如下：n c=1000 10dc=1 0dd=tf（ nc,dc）;tusti n）;syscld=feedback（sysold,1）;step（10*syscld , 10）; 比例积分控制器作用下的阶跃响应q-l Illi 1 td PT R i壬.祕1 A 1kivm a rtri i iw i nr cm i h iO G 0File Edit ViewinsertTools Desktop Window 旦el卩 H S逻困目匚我们可以

18、看到，此时静态误差过大，我们调节积分系数为 50 （改变程序为nc=1000 50），再次仿真：G O 0Edit ViewInsert Tools Desktop Window HelpD 口h題氨霁遲口目B我们看到系统已基本实现设计要求， 实际设计中可以不加入微分环节。 鉴于此次设计为课程设计，为保证设计完整性，我们在加入微分环节来观察一下微分 环节对系统性能的影响。设Kd=10,则程序为：n c=10 1000 50step（10*syscld,10）; 比例积分微分控制器作用下的阶跃响应-oar ! -True （sec）我们发现此图与上图区别不明显，即微分作用不明显，我们将微分系数更

19、改为 500 （程序更改为 nc=500 1000 50）：H Figure 1n o oFile Edit View insert Tools Desktop Window 旦El卩 H S A 獸 逻 （3 b 0我们清楚的发现，系统初始值明显变大，即微分作用可以加快系统的动态响 应速度，减小调整时间，从而改善系统的动态性能。当采样周期改为T=1s时，系统程序与仿真波形为：n c=500 1000 50dz=c2d（dd,1,gd=c2d（g,1, 比例积分微分控制器作用下的阶跃响应 T=1sM Figure 1 c c Cinsert Tools DesktopWindow Help0话

20、届寻| （L1 | H 比例积分锻分誉制器作用下的阶跃响应T-1 sL I I I I J I10 -我们可以看到效果远远不如 T=0.1s时的情况。所以综上所述，我们设计的PID控制器的传递函数为：U （s） 1000 s 50D（ s） ，采样周期为T=0.1s oE（s） s然后，我们利用数字控制器的离散化设计步骤来设计本系统。通过前面的分析,我们知道被控对象的连续传递函数为： 丫廻二 o其中，m=1000 b=50U （s） ms + b11 1 11=（1 z）Z * *（1 z）*20* Z 1000 s（s+ 1 ） 1000 s s+ 1S（S 20） s 201 （1-e 页

21、）zJ 1 0.0488 zJ 1 * 150 厶 50 1 -0.9512z1 -e 20 z对单位脉冲输入信号的十倍， R（z） 10.，选择 （zzJ。仿真程序如1 -z下：G=tf（0,0.0488,0,50,47.56,0,1,variable,zA-1H=tf（0,1,0,1,1,R=tf（10,0,0,1,-1,0,1,Y=R*Hfigure（1） impulse（Y） He=1-HE=He*RD=H/（G*（1-H） U=E*D figure（2） impulse（U）Figure 2 C O C从图中可以看出，在十倍的单位阶跃信号，采样周期为 1s 时，只需一拍输 出就能跟踪

22、输入，误差为零，非常好的达到了系统的设计要求。然后，我们再看一下增量型 PID 控制器的效果： 当比例积分微分系数不变时，程序如下： kp=1000ki=50kd=500G=tf（1,0,1000,50）Gd=c2d（G,0.1,znum,den=tfdata（Gd,vu_1=0u_2=0y_1=0y_2=0e_1=0e_2=0q0=kp+ki*0.1+kd/0.1A q1=-kp-2*kd/0.1 q2=kd/0.1for k=1:1:1000t（k）=k*0.1r（k）=10 y（k）=1-den（2）*y_1+num（2）*u_1 e（k）=r（k）-y（k）u（k）=q0*e（k）+q

23、1*e_1+q2*e_2 u（k）=u_1+u（k） u_2=u_1u_1=u（k）y_仁 y（k） e_2=e_1 e_1=e（k） endPlot（t,y）程序运行结果为:我们可以清楚地看到，除超调量超过系统要求外，其余要求均符合系统初始条件，我们可以通过增加微分系数来减小超调，直至使其满足系统要求。（2）路径识别模块的软件设计路径识别模块的工作框图见下页。智能车路径识别算法是智能车软件设计中最关键的一部分，智能车设计的大 部分工作都是围绕它来展开的。路径识别算法概括起来有两种：一种是静态识别， 所谓静态识别就是只根据小车的当前时刻的输入量来识别小车的位置； 另一种是动态识别，所谓动态识别

24、就是根据小车的当前时刻以及前面的 N个时刻的信号输入量来识别小车的运动趋势。路径识别主要运用MC9S12DG128B部的模糊推理机运用模糊逻辑的基本知 识来实现。本模块也可以用数字PID控制算法来实现，鉴于后轮驱动电机控制算法已详 细的运用了 PID来讲述之，此处不再赘述。此处运用PID的思想即通过与数字地 图比较偏差，从而不断调整小车路线，达到路径识别的功能。（3）数字滤波技术在电动机数字闭环控制系统中，测量值 yk是通过系统的输出量进行采样而 得到的。它与给定值r（ t）之差形成偏差信号ek，所以，测量值yk是决定偏差 大小的重要数据。测量值如果不能真实地反映系统的输出， 那么这个控制系统

25、就 会失去它的作用。在实际中，对电动机输出的测量值常混有干扰噪声， 用混有干 扰的测量值作为控制信号，将引起误动作，在有微分控制环节的系统中还会引起 系统震荡，危害极大。在本系统设计中，采用了移动平均滤波法。移动平均滤波法没计算一次测量 值，只需采样一次，所以大大加快了数据处理速度，非常适合于实时控制。移动平均滤波法是将采样后的数据按采样时刻的先后顺序存放在 RAM中,在每次计算前先顺序移动数据，将队列前的最先采样的数据移出，然后将最新采样 的数据补充到队列的尾部， 以保证数据缓冲区里总有 n 个数据，并且数据仍按采 样的先后顺序排列。 这时计算队列中各数据的算术平均值， 这个算术平均值就是 测量值 yk