五次多项式优化的平行泊车路径规划

doi:10.3778/j.issn.1002-8331.2012-0117

摘要/Abstract

摘要： 针对目前自动泊车路径规划普遍存在的曲率突变问题，提出了一种五次多项式优化的平行泊车路径规划方法。五次多项式曲线由约束条件建立的方程组求解得出，并对路径的曲率突变处进行过渡优化。为简化计算，引入“虚圆半径”的概念，以“虚圆半径”作为最小转弯半径，并按照“圆弧-直线-圆弧”平行泊车路径规划的方法进行求解，由此得出优化的平行泊车路径。仿真结果表明，五次多项式优化的平行泊车路径规划方法能够规划出曲率连续、满足避障约束和车辆运动学约束的优化路径，提高了路径跟踪的效果，保证车辆安全完成泊车。

关键词: 平行泊车, 路径规划, 五次多项式, 路径跟踪

Abstract: In order to solve the common problem of curvature mutation in automatic parking path planning, an optimized path planning method of parallel parking based on quintic polynomial is proposed. The quintic polynomial curve, obtained by solving equations set which is established according to the constraint conditions, can be used to optimize the path of curvature mutation. In order to simplify the calculation, the concept of “virtual circle radius” is introduced as the minimum turning radius, and by the arc-straight-arc parallel parking path planning method, the optimized parallel parking path can be obtained. The simulation results show that this path planning method can plan an optimal path with continuous curvature, satisfying obstacle avoidance constraint and vehicle kinematics constraint, enhances the tracking effect, and ensures the safety of the vehicle parking.

Key words: parallel parking, path planning, quintic polynomial, path following

胡勤明, 王金刚, 张小俊. 五次多项式优化的平行泊车路径规划[J]. 计算机工程与应用, 2022, 58(14): 291-298.

HU Qinming, WANG Jingang, ZHANG Xiaojun. Optimized Parallel Parking Path Planning Based on Quintic Polynomial[J]. Computer Engineering and Applications, 2022, 58(14): 291-298.

参考文献

[1] SUNGWOO C，BOUSSARD C，ANDRéA-NOVEL B.Easy path planning and robust control for automatic parallel parking[J].IFAC Proceedings Volumes，2011，44（1）：656-661.
[2] 张持，张永林.基于两段圆弧的倒推式平行泊车路径规划方法[J].计算机与数字工程，2019，47（12）：3035-3040.
ZHANG C，ZHANG Y L.Inverted parallel parking path planning method based on the two-arc[J].Computer and Digital Engineering，2019，47（12）：3035-3040.
[3] ZHDANOV A A，KLIMOV D M，KOROLEV V V，et al.Modeling parallel parking a car[J].Journal of Computer & Systems Sciences International，2008，47（6）：907-917.
[4] QIN Y W，LIU F Q，WANG P.A feasible parking algorithm in form of path planning and following[C]//Proceedings of the 2019 International Conference on Robotics，Intelligent Control and Artificial Intelligence，New York，USA，2019：6-11.
[5] VOROBIEVA H，GLASER S，MINOIU-ENACHE N，et al.Automatic parallel parking in tiny spots：path planning and control[J].IEEE Transactions on Intelligent Transportation Systems，2015，16（1）：396-410.
[6] 张家旭，赵健，施正堂，等.基于回旋曲线的平行泊车路径规划和跟踪控制[J].吉林大学学报（工学版），2020，50（6）：2247-2257.
ZHANG J X，ZHAO J，SHI Z T，et al.Path planning and tracking control for parallel parking based on clothoid curve[J].Journal of Jilin University（Engineering and Technology Edition），2020，50（6）：2247-2257.
[7] 张家旭，王晨，赵健，等.面向狭小平行泊车位的路径规划与跟踪控制[J].吉林大学学报（工学版），2021，51（5）：1879-1886.
ZHANG J X，WANG C，ZHAO J，et al.Path planning and tracking control for narrow parallel parking space[J].Journal of Jilin University（Engineering and Technology Edition），2021，51（5）：1879-1886.
[8] 李红，王文军，李克强.基于B样条理论的平行泊车路径规划[J].中国公路学报，2016，29（9）：143-151.
LI H，WANG W J，LI K Q.Path planning for parallel parking based on B spline theory[J].China Journal of Highway and Transport，2016，29（9）：143-151.
[9] 吴中伟.乘用车自动泊车系统路径规划与仿真分析[D].广州：华南理工大学，2018.
WU Z W.Path planning and simulation analysis of automatic parking system for passenger car[D].Guangzhou： South China University of Technology，2018.
[10] 胡文，谭运生，康龙云，等.基于驾驶员经验的自动泊车规划算法研究[J].汽车工程，2019，41（12）：1394-1400.
HU W，TAN Y S，KANG L Y，et al.Study on automatic parking planning algorithm based on driver’s experience[J].Automotive Engineering，2019，41（12）：1394-1400.
[11] ZHANG S，SIMKANI M，ZADEH M H.Automatic vehicle parallel parking design using fifth degree polynomial path planning[C]//Proceedings of the 74th IEEE Vehicular Technology Conference，San Francisco，CA，USA，2011.
[12] 黄江，魏德奎，秦良艳，等.自动泊车系统路径规划与跟踪控制方法研究[J].汽车技术，2019（8）：39-45.
HUANG J，WEI D K，QIN L Y，et al.Research on path planning and path tracking control method of automatic parking system[J].Automobile Technology，2019（8）：39-45.
[13] TAKAHASHI A，HONGO T，NINOMIYA Y，et al.Local path planning and motion control for agv in positioning[C]//IEEE/RSJ International Workshop on Intelligent Robots & Systems，2002.
[14] 郭夜啼.多段式曲线拟合的平行泊车路径规划研究[J].工业控制计算机，2019，32（5）：116-117.
GUO Y T.Research on parallel parking path planning with multi-segment curve fitting[J].Industrial Control Computer，2019，32（5）：116-117.
[15] 中华人民共和国住房和城乡建设部.城市道路工程设计规范：CJJ 37-2012[S].北京：中国建筑工业出版社，2012.
Ministry of Housing and Urban-Rural Development of the People’s Republic of China.Code for design of urban road engineering：CJJ 37-2012[S].Beijing：China Architecture & Building Press，2012.
[16] 石贞洪，江洪，于文浩，等.适用于路径跟踪控制的自适应MPC算法研究[J].计算机工程与应用，2020，56（21）：266-271.
SHI Z H，JIANG H，YU W H，et al.Research on adaptive MPC algorithm for path tracking control[J].Computer Engineering and Applications，2020，56（21）：266-271.
[17] 杨述斌，刘寒，蒋宗霖.基于MPC的自动泊车控制方法[J].自动化与仪表，2019（8）：20-23.
YANG S B，LIU H，JIANG Z L.Automatic parking control method based on MPC[J].Automation & Instrumentation，2019（8）：20-23.
[18] 王艺，蔡英凤，陈龙，等.基于模型预测控制的智能车辆路径跟踪控制器设计[J].汽车技术，2017（10）：44-48.
WANG Y，CAI Y F，CHEN L，et al.Design of intelligent vehicle path tracking controller based on model predictive control[J].Automobile Technology，2017（10）：44-48.