第 44 卷第 1 期 中南大学学报(自然科学版) Vo l . 44 No.1
2013 年 1 月 Journal of Central South University (Science and Technology) Jan. 2013
基于 Matlab 的多约束自动平行泊车轨迹规划
李红
1
,郭孔辉
1, 2
,宋晓琳
1
,李飞龙
1
(1. 湖南大学 汽车车身先进设计制造国家重点实验室,湖南 长沙,410082;
2. 吉林大学 动态模拟国家重点实验室,吉林 长春,130022)
摘要:分析泊车轨迹曲线特点,在已有轨迹函数基础上提出新的轨迹函数,通过对实际泊车轨迹的拟合证明该函
数的可用性。分析泊车环境中存在的可能碰撞点,建立相应的避撞约束函数。以泊车环境障碍约束、车辆自身参
数约束、泊车初始点方位约束、泊车终点位置约束为轨迹函数的约束函数,以泊车终点车辆与车位夹角最小为目
标函数建立单目标多约束轨迹方程。分别对一般泊车环境和狭小空间泊车环境进行泊车轨迹规划,利用 Matlab
软件非线性约束优化函数求得轨迹函数参数。仿真结果表明:对于一般泊车环境,该方法能满足泊车轨迹曲率连
续性,使车辆无碰撞进入车位,并使车辆与车位平行;对于狭小空间泊车环境,虽未能使车辆与车位平行,但实
现了车辆无碰撞地泊车入位并保证轨迹曲率的连续性。由此可知该方法可实现车辆无碰撞地泊车入位,并满足轨
迹曲率连续性要求,有效地解决了泊车过程中停车转向问题。
关键词:轨迹规划;自动泊车;避撞;多约束;优化
中图分类号:TP273 文献标志码:A 文章编号:1672−7207(2013)01−0101−07
Trajectory planning of automatic parallel parking with
multi-constraints based on Matlab
LI Hong
1
, GUO Konghui
1, 2
, SONG Xiaolin
1
, LI Feilong
1
(1. State Key Laboratory of Advanced Design and Manufacturing for Vehicle Body, Hunan University,
Changsha 410082, China;
2. State Key Laboratory of Automobile Dynamic Simulation, Jilin University, Changchun 130022, China)
Abstract: Parking trajectory characteristics were analyzed, and a new trajectory function was proposed based on the
known trajectory functions. It was proved that the new function was feasible for trajectory planning by parking trajectory
fitting comparison. Potential collision points were analyzed and constraint equations were established accordingly. The
orientation constraints at the start point, the location constraint at the parking point and the restriction of vehicle were
considered, and the constraint equations were established respectively. Parking trajectory optimization function was
presented to minimize the vehicle orientation angle at the parking point with restrictions mentioned above. The approach
was used by trajectory planning for general parking space and tight parking space, and the trajectory function was solved
using Matlab software. The simulation results show that the car can reverse into parking set safely in general parking
space, with the continuously trajectory curvature and the car paralleled with the parking set at the parking point. This
approach fails to make the car paralleled with the parking set in tight parking space, but the car can move into parking set
safely with the continuous trajectory curvature. It is proved that the approach proposed can find a collision-free path in
different parking spaces and meet the demand of continuous trajectory curvature, so the problem of shutting down to steer
the wheel in parking process is solved.
Key words: trajectory planning; automatic parking; collision-free; multi-constraints; optimization
收稿日期:2011−11−28;修回日期:2012−03−15
基金项目:国家自然科学基金资助项目(51175159);湖南省科技计划项目(2012GK3161)
通信作者:李红(1984−),女,山东定陶人,博士研究生,从事汽车动态模拟与仿真研究;电话:15604465313;E-mail: lihong3729@163.com