2011
07-08
一种智能车控制算法的设计和实现
分类: | 查看: 83 |
智能汽车与一般所说的自动驾驶有所不同，它指的是利用多种传感器和智能公路技术实现的汽车自动驾驶。智能汽车首先有一套导航信息资料库，存有全国高速公路、普通公路、城市道路以及各种服务设施（餐饮、旅馆、加油站、景点、停车场）的信息资料；其次是GPS定位系统，利用这个系统精确定位车辆所在的位置，与道路资料库中的数据相比较，确定以后的行驶方向；道路状况信息系统，由交通管理中心提供实时的前方道路状况信息，如堵车、事故等，必要时及时改变行驶路线；车辆防碰系统，包括探测雷达、信息处理系统、驾驶控制系统 ,控制与其他车辆的距离，在探测到障碍物时及时减速或刹车，并把信息传给指挥中心和其他车辆；紧急报警系统，如果出了事故，自动报告指挥中心进行救援；无线通信系统，用于汽车与指挥中心的联络；自动驾驶系统，用于控制汽车的点火、改变速度和转向等。
1 巡线控制算法
1.1 运动模型
智能车的运动控制是通过控制驱动马达和伺服舵机实现的。在理想情况下，可以认为4个轮胎绕着同一个圆心做纯滚动，其离散运动模型公式为：
其中V是线速度，W为角速度， x（t）、y（t）为小车的坐标，angle（t）为智能车的方向角（以小车前进方向为起始线，逆时针为正），Δt为采样周期。模型如图1所示。
由于模型车的运动速度较高，在行驶过程中轮胎与赛道会发生一定侧滑，因此还需要引进侧滑修正。
1.2 舵机控制
方向控制是控制策略的难点。传统的PID算法[1,2]不需要对控制对象做细致分析，只需根据控制效果对参数进行调整[3].但由于控制器的输入量均对输出量产生影响，且高度耦合，很难根据控制效果准确地对参数进行修正，因此参数的整定工作十分繁重。此外，当车的状态不同时（如低速和高速时），最佳参数也有很大不同，这给进一步调试带来了困难。
本文采用"最优曲率法".控制思想是：模型车在一个控制周期内的运动轨迹可以近似为一段圆弧，整个运动轨迹可以看做由小段圆弧连接成的曲线。在假设线速度恒定的前提下，给定路径上的一个点就能确定出智能车到达该点所应具有的舵机角度[4].在每个控制周期内选择路径上的一点（或若干点），根据预先建立的圆弧运动模型计算出模型车在接下来的一个（或若干个）运动周期内要到达选定点所需的理想状态，此时该控制周期的输出量就是在未来几个控制周期内使模型车的实际状态尽可能逼近理想状态的控制量。
以车的后桥中点为原点建立坐标系，车的中轴为y轴，其正向为车的前方。设（c_x,c_y）为路径上的点在该坐标系中的坐标。则控制量的计算公式为[5]:
这种方法在车速较低时可以取得很好的效果，当车速较高时，有很多因素对控制效果的影响会显著增大，需要作出适当的补偿。其中主要因素是控制量的实际输出时刻与理想输出时刻的延时，这个延时是由图像处理和控制量的计算都需要一定时间造成的。对此，本文采取的方法是根据车的当前状态估算出控制量的输出时刻的路径信息，用这个路径信息计算控制量。
另一个重要因素是侧滑。智能车在行驶过程中存在侧滑，可以通过侧滑角作补偿。设车轮的角度为θ，加入侧滑后的等效车轮角度为θ′，本文假设二者符合如下关系：
还有一个重要因素是，当车速较高时，舵机的响应速度相对较慢。要克服这个问题，应使舵机提前做出反应。因此需要在控制器的输出量中引入路径的趋势。本文用前瞻点处的斜率k表示路径的趋势，在原控制量θ的基础上增加一个与路径趋势相关的分量θ″=para×v×k,其中para通过实验结果自动调整，如果需要，可以将para设为和其他变量相关的函数。
经过上述改进之后，最优曲率法在车速较高的时候依然能够取得很好的控制效果。此部分程序流程图如图3所示。
该算法的优点是参变量较少，且相互间的耦合很小，对控制效果的影响较为独立，可以根据实验结果快速确定调整量。只要对参数进行适当调整，就能取得较好的控制效果。
1.3 速度控制
在速度决策方面，首先尝试了基于有效前瞻
