基于障碍物斥力场的汽车主动避撞系统 ……………………… 方俊 (
方俊101400) (北京京北职业技术学院,北京
【摘要】为提高汽车行驶安全性,设计了基于障碍物斥力场模型的汽车主动避撞系统,建立了道路算盘模型和驾驶员预瞄跟随模型,利用算盘模型可求解出避撞路径,使用驾驶员预瞄跟随模型可求解出汽车转向盘最优转角。通过动静态障碍物环境下的仿真试验表明,利用算盘模型规划出的路径平滑、安全、可跟踪;驾驶员预瞄跟随模型的路径跟随精度高,实现了汽车主动避撞。
1 前言
随着汽车保有量的快速增长与相对缓慢的道路建设之间的矛盾日益突出,交通事故成为人类非正常死亡的第一杀手[1],研究汽车主动避撞系统对保护人身财产安全具有重要意义。
汽车主动避撞过程是指当探测到障碍物的存在时能够规划出一条避撞路径且能够跟随此路径[2- 3]。目前常用的路径规划方法包括人工势场法、遗传算法、快速搜索随机树、神经网络算法[4- 6]等,但这些方法不仅存在算法自身缺陷,而且求解效率低、耗时长。
为了避免路径规划中的迭代过程,提高规划实时性,本文建立了道路算盘模型和驾驶员预瞄跟随模型。经仿真验证,算盘模型规划出的路径平滑、安全、可跟踪;驾驶员预瞄跟随模型的路径跟随精度高,实现了汽车主动避撞。
2 主动避撞系统设计
设计的汽车主动避撞系统分为 4 个模块,分别为环境感知模块、信息处理模块、局部路径规划模块和路径跟踪模块,如图 1 所示。
环境感知模块用于测量车道线、车道数、路长、路宽、障碍物大小、位置、速度、自车当前位置、车速、制动踏板信息、转向盘转向角信息;信息处理模块进行数据预处理和信息融合;局部路径规划模块根据当前汽车的测量信
主题词:汽车主动避撞系统 障碍物斥力场 算盘模型 驾驶员预瞄跟随模型U461 U491 A 10.19620/j.cnki.1000-3703.20172248中图分类号: 、 文献标识码: DOI:
息规划出一条能够避开障碍物且符合汽车性能指标的最优路径;路径跟踪模块对规划出的避撞路径进行跟随。
3 局部路径规划
3.1 道路算盘模型
2
如图 所示,算盘与典型的平直双车道道路非常相似,借鉴算盘的构造可建立避撞道路的算盘模型。 设置平直或者近似平直的双车道宽度为B,在车辆
n- 1
的探测距离L内等间距地插入 根细杆,在每根细杆中穿入一个算珠,算珠在外力作用下只能沿着细杆上下运动。在算珠间使用等刚度的弹簧进行连接,第一根弹簧的起点、第一个算珠的位置、汽车的质心位置三者重合,最后一根弹簧末端固定在目标点上。在汽车行驶过程中,算珠不仅受到弹簧的拉力作用,还受到道路边界和障碍物的斥力,算珠在这些力的综合作用下达到稳定状态,稳定后的位置即为汽车的无碰撞路径。道路算盘
3
模型如图 所示。 为便于描述,分别建立了汽车坐标系和道路坐标4
系,如图 所示。汽车坐标系C*( c0, x, cc )以汽车质心为y坐标原点,汽车的前进方向为X轴,与前进方向垂直为Y轴;道路坐标系 E*( e0, x, 1 ee ) 以第 个算珠所在位置为y
原点,道路横向为X轴,纵向为Y轴。
3.2 算盘模型的数学描述
建立边界线斥力模型、障碍物斥力模型和弹簧力模 型,进而得到算珠的受力平衡模型。
3.2.1
边界线斥力建模将道路边界线视为障碍物,道路的左右边界线对内部的算珠具有斥力作用,且越靠近边界斥力越大。以图
5
所示情况为例,第i根细杆与道路边界的交点对此细杆上的算珠有排斥作用,参考万有引力公式,道路边界线的斥力计算方法为: 式中, F 、F 为道路两个边界的斥力; k 、k 为两个边
i, i, l r l r
界的斥力系数; e 为Y轴的单位矢量; 3 r 、r 、r 为个
i, i, y l r i位置矢量。
为使汽车在无障碍物的情况下可沿着道路中心行驶,对边界的斥力系数进行了界定,即,若使汽车沿右侧道路中心行驶,要求 kk =9 ;若要使汽车沿左侧道路
l r
中心行驶,则要求kk =9。
r l
3.2.2
障碍物斥力建模前文将自车的运动看作一个质心运动,而实际情况下必须考虑汽车尺寸才不会发生碰撞,因此将障碍物车辆用一个直径为两倍车宽的安全圆包围,在安全圆边界上建立斥力场,对穿过安全圆的细杆上的算珠产生斥力作用,且算珠越接近斥力场则排斥力越大,但对于未穿
0, 6过障碍物的算珠斥力为 障碍物斥力场如图 所示。同样参考万有引力公式,障碍物对算珠的斥力为: 式中, F 为障碍物对算珠的斥力; 为斥力系数;
i,
Oj
r 为位置矢量。
i,Oj
3.2.3
弹簧弹力建模当自车前方出现障碍物时,算珠在边界斥力、障碍物斥力、弹簧弹力的综合作用下达到稳定状态,此时将算珠的轨迹进行平滑性拟合即可得到最优轨迹。算珠i 7受到的弹力由与之相连的两根弹簧施加,如图 所示。
式中, F 为弹簧对算珠的拉力; k 为弹簧系数;为向||
i, -1
i s
量的模; l0为弹簧的原始长度。
i+ 1 3)
第 根弹簧对算珠的拉力参考式( 给出。
3.2.4
受力平衡模型由以上分析可知,每个算珠受到边界斥力、障碍物3
斥力、弹簧弹力等 种力的作用。当自车前方有m个障碍物时,算珠受到的力平衡模型为: 式(4) 是一个非线性方程组,可以使用牛顿迭代法[7]
求解。因算珠之间的距离已知,则算珠的横坐标可确4)
定,因此对式( 的求解实质是求道路坐标系纵坐标,使用平滑曲线将纵坐标连接就得到了避障轨迹。
4 路径跟随系统
4.1 驾驶员预瞄跟随模型建立驾驶员预瞄跟随模型根据控制对象的不同可以分为
-
方向控制、速度控制、方向 速度联合控制三类[8],由于对路径的跟随只与方向有关,因此本文使用方向控制的驾驶员预瞄跟随模型。驾驶员预瞄跟随模型描述为:驾驶员以前方一定距离的某点为目标点(也叫预瞄点),根据汽车当前的行驶状态预测汽车到达该目标点的实际轨迹,根据预测轨迹与目标轨迹的偏差调整转向盘转角,使汽车能够跟随预先规划的路径,直至到达预瞄点[9,10]。
8 8驾驶员预瞄跟随模型如图 所示。图 中,为目标f路径; fe为驾驶员根据汽车当前状态预测的汽车位置信息; ε为位置误差;为转向盘转角; δ y为汽车实际位置信息, yp为汽车位置反馈信息, F(s)为跟随器传递函数。求解轨迹跟随模型的本质是给出模型中的δ。
4.2 最优转向盘转角求解
在不考虑汽车动态响应的情况下,车辆的转动服从Acklman几何关系,即
式中, R为汽车的转弯半径;为汽车的轴距。
式中, y(t)为汽车侧向位移; ẏ ( t)为汽车侧向速度; ÿ
( t)为侧向加速度。
6),
结合式( 最优转向盘转动角度为:
5 仿真验证
5.1 试验1
1 9 90 km/h
试验 情景如图 所示,汽车以 的速度在双
7 m, 250 m,同向车道的平直公路上行驶,路宽为 路长为
40 m汽车右侧行驶,在自车车道前方 处存在一个静态障
150 m碍物,同时在左侧车道距自车 处存在另一静态障
1.6 s碍物,若自车继续按当前状态行驶,则 后汽车与自车车道障碍物相撞。
f(t),目标路径函数记为 汽车在时刻t的状态记为y(t)。假设驾驶员的前视距离为d,则相应的前视时间为T=d/ t+ v(v为车速),汽车在时刻 T的侧向位移为:
根据误差最小原则,驾驶员希望实际路径与目标路径误差最小,则由式( 7) 得:
针对试验 1 情景,利用牛顿迭代函数求解道路的算盘模型得到避障路径,利用驾驶员预瞄跟随模型对路径
10
进行跟随,结果如图 所示。
10a
由图 可看出,使用算盘模型规划出的路径能够安10b
全避开障碍物,且路径平滑;由图 可看出,驾驶员预瞄跟随模型能够很好地跟踪规划路径,两条路径吻合程度10c 0s
较高;由图 可看出,为跟踪避撞路径,在 时汽车转1.5 s 1
弯角度较大,即转向盘转角大,至 时汽车位于第 个障碍物左侧,然后汽车转向盘回转,使汽车回到右侧车2 6s
道。由于第 个障碍物不在右侧车道,所以在 左右时10d 10e
转向盘转角很小;由图 和图 可看出,汽车避撞过 0.4程中最大侧向加速度小于 g,最大横摆角速度小于
12°/s,
且整个过程中侧向加速度和横摆角速度没有突变的情况,说明路径合理,汽车能够安全稳定地跟踪规划路径。
5.2 试验2
2 11 1
试验 情景如图 所示,车速及路况与试验 相
40 m
同。汽车右侧行驶,在自车车道前方 处某车以
54 km/h
的速度向前行驶,若自车继续按当前状态行
4s
驶,则 后发生追尾事故。
2
针对试验 情景,利用牛顿迭代函数求解道路的算盘模型得到避障路径,利用驾驶员预瞄跟随模型对路径12
进行跟随,结果如图 所示。
12a
由图 可看出,使用算盘模型规划出的路径能够12b
安全避开动态障碍物,且路径平滑;由图 可看出,驾驶员预瞄跟随模型能够很好地跟踪规划路径,两条路径12c
吻合程度很高;由图 可看出,跟随路径过程中,转向12d 12e
盘转角曲率平滑,符合实际情况;由图 和图 可看0.3出,汽车避撞过程中,最大侧向加速度为 g,最大横9 °/s,
摆角速度为 且整个过程中侧向加速度和横摆角速度没有突变的情况,说明路径合理,汽车能够安全稳定地跟踪规划路径。
6 结束语
本文以车辆遇到障碍物时避撞为目的,设计了汽车主动避撞系统,建立了道路算盘模型和驾驶员预瞄跟随模型,利用算盘模型求解出了避撞路径,使用驾驶员预瞄跟随模型求解出了汽车转向盘最优转角。经仿真验证,算盘模型求解出的路径平滑、安全、可跟踪,驾驶员预瞄模型对规划路径具有很高的跟踪精度。
参考文献
[1] . [D].孙轶轩 基于数据挖掘的道路交通事故分析研究 北
, 2014.
京:北京交通大学
[2] , , , .
孟琳 朱西产 孙晓宇等 真实交通危险工况下驾驶员转
[J]. , 2016(6):59-62.向避撞相关因素分析 汽车技术
[3] . dSPACE
李素华 采用 的电动汽车纵向主动避撞系统研究
[J]. , 2017(7):111-114.
机械设计与制造
[4] Zelek J S, Levine M D.Local- Global Concurrent Path Planning and Execution. IEEE Transaction on System, Man and Cybernetics, 2000, 30(6):865-870.
[5] Xiao J, Michalewicz Z, Zhang L X, Trojanowski K. Adaptive Evolutional Planner/navigation for Mobile Robots. IEEE Transactions on Evolutionary Computation, 1997, 1(1):1828.
[6] , , . [J].
章毅 郭泉 王建勇 大数据分析的神经网络方法 工程
, 2017, 49(1):9-18.
科学与技术
[7] Benner P, Ezzatti P. A Factored Variant of the Newton Iteration for the Solution of Algebraic Riccati Equations Via the Matrix Sign Function[J]. Numerical Algorithms, 2014, 66 (2):363-377.
[8] , .
白艳 贾鑫 最优预瞄加速度驾驶员模型参数试验辨识方
[J]. , 2015,37(7):788-793.
法研究 汽车工程
[9] , , , .
陈名扬 朱西产 马志雄等 不同驾驶员响应特性下的前
[J]. , 2016(11):51-55.碰撞预警安全收益分析 汽车技术
[10] . [D].黄满洪 考虑驾驶员预瞄特性的车辆稳定控制策略
, 2016.南京:南京航空航天大学
(责任编辑 文楫) 2017 11 29修改稿收到日期为 年 月 日。