智能车软件设计培训.pptVIP

飞思卡尔智能汽车设计----软件设计基础;主要内容 一、硬件系统结构（光电组） 二、智能车的主要软件功能模块 三、智能车控制软件总体结构 四、主要控制算法及其实现;一、硬件系统结构（光电组）;二、智能车的主要软件功能模块 系统初始化 车模运行状态检测 车模速度测量 车模倾斜角度测量 赛道检测（引导线、坡道、障碍） PWM输出控制 车模启动、刹车、停止控制 直立控制 方向控制 参数设置、状态与参数显示等 ;三、智能车控制软件总体结构;2、时间片轮转任务调度程序结构框架;四、主要控制算法及其实现; 在三个任务中，保持车模直立是关键。由于车模同时受到三种控制的影响，从车模直立控制的角度，其它两个控制就成为它的干扰。因此在速度、方向控制的时候，应该尽量平滑，以减少对于直立控制的干扰。 ;2.车模直立控制; 控制倒立摆底部车轮，使得它作加速运动。这样站在小车上（非惯性系）看倒立摆，它就会受到额外的力(惯性力)，该力与车轮的加速度方向相反，大小成正比。假设控制车轮加速度与偏角 成比例，且比例系数为K1，则有：; 显然，如果满足K1g，那么回复力的方向便于位移方向相反 ，从而使倒立摆恢复到平衡位置。 为了使得倒立摆能够尽快地在垂直位置稳定下来，还需要增加阻尼力，设阻尼力与偏角的速度成正比，方向相反，则有： ; 陀螺仪输出的是车模的角速度，不会受到车体运动的影响，因此该信号中噪声很小。车模的角度又是通过对角速度积分而得，这可进一步平滑信号，从而使得角度信号更加稳定。因此车模控制所需要的角度和角速度可以使用陀螺仪所得到的信号。 ; 由于从陀螺仪角速度获得角度信息，需要经过积分运算。如果角速度信号存在微小的偏差和漂移，经过积分运算之后，变化形成积累误差。这个误差会随着时间延长逐步增加，最终导致电路饱和，无法形成正确的角度信号 ：; 一种简单的方法就是通过上面的加速度传感器获得的角度信息对此进行校正。通过对比积分所得到的角度与重力加速度所得到的角度，使用它们之间的偏差改变陀螺仪的输出，从而积分的角度逐步跟踪到加速度传感器所得到的角度。 ; 根据车模角度控制和角度测量方法，可以得到如下车模角度控制方案框图 。;3.车模速度控制;（2）速度控制原理 给定车模直立控制角度设定值，在直立控制调节下，车模将会自动维持在一个角度，角度的积分即是车辆的速度值。;（3）速度控制方框图;（3）改进后的速度控制方框图;4.车模转向控制;光电组;;(2)电机差速转向控制;(3)转向控制方框图;5、软件算法框图; THE END 谢谢各位同学！