原创 基于摄像头的智能车预测控制策略

　　预测控制的基本思想是：在每一控制周期内，通过摄像头获取车前方一定区域内黑线的位置信息——与PID控制方式不同的是，预测控制多了摄像头标定这一步，即将黑线在图像坐标系下的位置转换成世界坐标系下的位置——然后规划出一条较优化的走线，成为期望走线。然后根据小车的运动学模型和转向模型可以确定(一种最优化问题求解的过程)，在往下若干个控制周期内，转角控制量依次取多少时，小车走线才能最“接近”规划出的期望走线。仅仅选取求解出的当前控制周期的转角控制量作为实际的转角控制量。在下一周期，将重新进行一次上述的规划、最优化求解过程，如此反复循环执行下去。具体介绍如下文所示。

　　摄像头标定

　　因为要进行走线规划，就得获取黑线的实际位置信息。通过摄像头所获得的只是黑线在图像坐标系下的位置。因此，首先得求出图像坐标系到世界坐标系的变换关系，这个变换关系是一个仿射变换关系，可以事先写出这个变换关系的形式，然后再取一些标定样点，通过计算标定出这个变换关系形式中的各个参数。摄像头标定因为不作为本文重点，受篇幅所限，具体细节不在此赘述。

　　走线规划

　　在赛车比赛中，走线选取的好坏可以作为评价车手水平高低的一个标准。在智能小车比赛中，走线选取的好坏同样显得很重要。针对不同类型的赛道甚至赛道组合，走线的选取，既要考虑到走线路程的长短，还要考虑到相应的速度限制，因此，如何走线是一个值得研究的问题。在各种走线规划的策略中，一种最朴素而且效果也较明显的想法就是“抄近道”。所谓抄近道就是在小车不冲出赛道的前提下，使小车在赛道上沿尽可能短的路线前进。最典型的两种抄近道的表现方式如图1所示，即蛇形道(a)和单向弯(b)上的抄近道。

　　图1 智能车抄近道的两种方式

　　运动学模型和转向模型

　　运动学模型是描述智能小车位置、航向角、前轮转角之间动态变化关系的模型。转向模型是描述前轮转角自身变化时的动态关系的模型。运动学模型和转向模型可以描述成如下状态方程的形式：

　　其中，x、y表示智能小车的位置，ψ表示航向角，δ表示前轮转角，c=v/L(L为轴间距wheelbase)，a=-1/T0(T0为转向舵机的响应时间常数)。

　　最优转角控制量求解

　　为描述方便，假设当前控制周期为kT周期，并假设kT、(k+1)T、……、(k+m)T周期的转角控制控制量依次为u(k)、u(k+ 1)、……、u(k+m)，并假设(k+m)T周期以后的转角控制量为零(即车前轮正对着前方)。根据运动学模型和转向模型，可以推得智能小车在任一时刻的位置。设推算出的kT、(k+1)T、……、(k+P)T周期(通常取P>m)(即在未来(P+1)周期内)的智能小车的位置，依次为(x (k),y(k))、(x(k+1),y(k+1))、……、(x(k+P),y(k+P))。前面在走线规划时已经确定出了期望线路的位置，这样就可以求出未来(P+1)周期内每一周期智能小车与期望线路的位置偏差，记为d(k)、d(k+1)、……、d(k+P)。取一个正定的性能指标：

　　J反应的是智能小车实际走线(根据模型预测的)和期望走线间的相近程度。J越小，则实际走线与期望走线也越接近。可以看出，每一组u(k)、u(k +1)、……、u(k+m)的取值将对应一个特定的J的取值。通过一些数值的最优化求取方法，可以确定出一组u(k)、u(k+1)、……、u(k+m) 的取值u0(k)、u0(k+1)、……、u0(k+m)，使性能指标J取得最小值。那么，以u0(k)作为kT周期的实际转交控制量，而u0(k+ 1)、……、u0(k+m)将摒弃。在(k+1)T周期，将重复走线规划和上述最优量求取得过程，然后仅仅以所求得的(k+1)T周期的转角控制量作为该周期的实际转角控制量。反复循环执行前述过程。

　　结语

　　采用预测控制的策略，能更有效地利用摄像头所获取的丰富的赛道信息，能够较准确地控制小车的走线，使小车在一些特征路段能按较优的线路前进，节省用时，提高比赛成绩。限于单片机的计算能力有限，在具体实施预测控制策略时，可以作一些简化处理，如将未来(m+1)个周期内的转角控制量假设成相同的取值，即u(k)=u(k+1)=……=u(k+m)，这样能大大降低计算量，却依然能有不错的表现效果。

　　相关型号资料：QDSP-399G　RS610　G6K-2F-Y DC3　MAX205E　CY15C471J
　　http://www.avrw.com/BBS/Show.asp?id=96238&BoardID=6&TB=1