基于视觉的智能车转向控制策略
则应适当降低车速并将基准位置适当降低。如图9所示,最短路径也为最快速度,两者是统一的。真实过程中很难做到让车走CD路线,但是如果能使舵机保持在一个小角度左右调节的过程中则可逼近CD路线。实践证明,高速通过S道时避免剧烈的角度变化给定为最优策略。
综合以上分析,可以得到以下两点结论:
(1) 基准位置距小车的距离与速度呈正比关系。想要不减速入弯,必须改变基准位置,使之可以满足公式(9)。
(2) 速度与转弯半径呈正比关系。保持高速入弯,同时不冲出赛道,提前入弯策略可以有效解决这个问题。
4 策略的实现
由以上分析可知,场景中的基准位置可以近似看成入弯点,并且不同的速度会导致不同的入弯点,也会导致不同的过弯路径。因此,需完成的控制任务是:高速过弯,在入弯前不减速,为了防止冲出赛道还需要提前入弯。可见,需要在与速度适应的入弯点的基础上进一步提前基准位置,即基准位置离小车的前端距离为:
L=V×TD+V×τ (10)
式中,L为基准位置离小车的距离,V为此刻小车的速度,V×TD为抵消延迟时间带来的附加行驶距离,V×τ为提前入弯点的距离。
可以看出,基准位置与小车的距离是一个与小车速度相关的变量,不同的速度需要不同的取值。对于不同的速度将基准位置按照公式(10)设置,这样即可以实现高速入弯。为了得到较佳的入弯点,本策略对图像平面(64×106)做了进一步的处理,针对已经得到的图像平面(64×106),将图像平面平分为10个区域,每个区域求取引导线的平均位置,对于没有引导线的区域使用一个不可能出现的值代替,这样便将引导线信息简化为10行信息表示,记为:average[i],i=1,2,…,10。其中,average[i]记录每行信息中引导线的平均位置的列坐标值,i标表示行值。图10为最终的图像平面。
图10中, row_sure(出界点)用来选择10个点中哪几个点为可用点。average[1]为离车最近的点,随着序号增大,离车越远。在图10的图像平面中,计算偏差改为:
err=average[i]-mid (11)
式中, i< P>
当小车车速很高时,选择较远处的点求取偏差,等效于时间上提前入弯。这样由以上策略分析可知,只要入弯点合适,基本不用减速就可以直接入弯,还可以得到不错的安全系数。当速度处于一个较低水平时可使用最近处的点,即average[1],这样就保证车只有走到弯道处才会转向,不会提前入弯,避免提前入弯带来的冲出内道。
5 实验数据
根据比赛要求,赛道中最小弧度半径不小于0.5 m,在参考历届赛道的基础上,笔者设计了如图11的测试赛道,全长约38 m。实验室测试成绩为18 s跑完全程,平均速度达到2 m/s。
图12为90°弯道过弯图,粗实线为引导线,虚线为赛车实际行驶路线。可以看出,小车实现了提前入弯,这是比较好的路径,有效地节省了时间。
过弯速度的测量,由无线模块每40 ms发回编码器测得的速度脉冲,先由直道加速后入弯得到如表1所示的数据。
由表1可以明显看出速度的变化,其中62为入弯速度,折合成标准速度为2.4 m/s;弯道速度为40,折合成标准速度为1.5 m/s,这个速度很接近平均速度。
图13为360°弯道过弯图,粗实线为引导线,虚线为小车实际的行驶路线。可以看出实现了提前入弯,后半程受舵机最大偏转角的限制,无法继续加大偏转,造成有一些跑外道。
图14为S过弯图,粗实线为引导线,虚线为小车实际的行驶路线。可以看出,小车行驶路线已经很逼近直道了,由无线模块每40 ms发回编码器测得的速度脉冲,先由直道加速后入弯得到如表2所示的数据。
可以看出,S道的速度变化很小,同时弯道速度平均在1.5 m/s以上,很好地逼近了预期的路线。
本文根据转向模型,通过分析过弯路径与过弯速度之间的关系,得到了不同速度对应不同入弯路径和入弯点的结论。利用这个结论,改变控制器偏差计算,达到动态地设置入弯点,快速入弯,尽量做到不减速或少减速,缩短弯道行驶时间,从而提高小车行驶速度的目的。该方法在其他智能车跟随引导线的系统中同样适用,由于其良好的超前预测性能,对于短暂的引导线丢失也可以很好地跟随。
- 无人驾驶车辆终端控制的研究与探索(01-17)
- TMS320F2812在车辆四轮转向控制系统中的应用(05-08)
- 基于16位单片机MC9S12DG128的智能车控制系统设计与实现(11-11)
- 基于9S12DG128的智能车控制系统设计与实现(08-27)
- 数字CMOS摄像头在智能车中的应用(08-29)
- 基于电磁场检测的寻线智能车设计(09-22)