小车位环境下的自动泊车路径规划与跟踪控制

doi:10.3778/j.issn.1002-8331.2111-0508

摘要/Abstract

摘要： 针对小车位泊车路径设计不连续导致位姿调整不平滑的问题，提出一种回旋曲线、圆弧、直线组合的路径规划方法，并基于非时间参考量的跟踪偏差，设计滑模控制器。根据泊车要求和限制条件，规划出泊入路径与调整路径：泊入路径引导车辆以极限位姿进入车位；调整路径通过平滑的路径组合实现车位内的位姿调整。选用指数趋近率设计滑模控制器，利用连续函数代替趋近率中的符号函数，降低抖振影响。仿真结果表明，车辆能够连续、无突变地完成泊车操作，跟踪误差较小，抖振抑制效果较好。

关键词: 自动泊车, 二次路径规划, 滑模控制, 路径组合

Abstract: For the problem of intermittent posture adjustment is caused by design of the discontinuous parking path in the small parking space, a path planning method of combination of cycloid, arc and straight line is proposed, and the tracking deviation of the non-time reference variable is used to design sliding mode controller. First of all, requirement and restrictions during the parking process are considered to devise entry paths and adjustment paths. The vehicle with extreme posture is guided into the parking space by the entry path. Posture adjustment is implemented by a smooth combination of paths of adjustment paths in the parking space. Then, the sliding mode controller is designed with an exponential approach rate;continuous function is used to substitute symbolic function in the approach rate, the effects of jitter is reduced. The simulation results show that parking is finished continuously, small tracking error and outsanding jitter suppression is presented.

Key words: automatic parking, secondary path planning, sliding mode control, curvilinear combination

冯欣阳, 李春书, 唐风敏. 小车位环境下的自动泊车路径规划与跟踪控制[J]. 计算机工程与应用, 2022, 58(13): 288-294.

FENG Xinyang, LI Chunshu, TANG Fengmin. Parking Path Planning and Path Tracking in Small Parking Spaces[J]. Computer Engineering and Applications, 2022, 58(13): 288-294.

参考文献

[1] 姜武华，辛鑫，陈无畏，等.基于信息融合的自动泊车系统多工况车位识别和决策规划[J].机械工程学报，2021，57（6）：131-141.
JIANG W H，XIN X，CUI W W.Multi-condition parking space recognition based on information fusion and decision planning of automatic parking system[J].Journal of Mecha-nical Engineering，2021，57（6）：131-141.
[2] LI J Z，LONG Q.An automatic parking model based on deep reinforcement learning[C]//Proceedings of the 2nd International Conference on Computer Information and Big Data Application，2021.
[3] 李红.自动泊车系统路径规划与跟踪控制研究[D].长沙：湖南大学，2014.
LI H.A student on path planning and tracking control method for automatic parking system[D].Changsha：Hunan University，2014.
[4] PANOMRUTTANARUG B，TUNGPORNTAWEE S，THONGSUK P，et al.An emulation of autonomous parallel parking system using fuzzy logic control[C]//Proceedings of 2009 IEEE ICCAS-SICE，2009.
[5] YU W，ZHU X.A robust design of hybrid fuzzy controller with fuzzy decision tree for autonomous intelligent parking system[C]//Proceedings of 2014 American Control Conference，2014.
[6] 任坤，许艺，丁福文，等.基于机器视觉和模糊控制的自动泊车[J].华中科技大学学报（自然科学版），2015，43（S1）：88-92.
REN K，XU Y，DING F W，et al.Auto-parking based on machine vision and fuzzy control[J].Journal of Huazhong University of Science and Technology（Nature Science Edition），2015，43（S1）：88-92.
[7] SOKRI M N，MAHAMAD A K，SAON S，et al.Autonomous car parking system using fuzzy logic[C]//Proceedings of 2021 IEEE International Conference on Consumer Electronics（ICCE），2021.
[8] 涂亚庆，陈浩，杨辉跃.一种自动泊车的仿人智能控制方法[J].控制工程，2014，21（2）：161-167.
TU Y Q，CHEN H，YANG H Y.Autonomous parking method based on human-simulated intelligent control[J].Control Engineering of China，2014，21（2）：161-167.
[9] 张继仁，陈慧，宋绍禹，等.基于强化学习的自动泊车运动规划[J].同济大学学报（自然科学版），2019，47（S1）：186-190.
ZHANG J R，CHEN H，CHEN S Y，et al.Automatic parking motion planning based on reinforcement learning[J].Journal of Tongji University（Natural Science），2019，47（S1）：186-190.
[10] UPADHYAY S，RATNOO A.A point-to-ray framework for generating smooth parallel parking maneuvers[J].IEEE Robotics & Automation Letters，2018，3（2）：1268-1275.
[11] CHOI S.Easy path planning and robust control for automatic parallel parking[J].IFAC Proceedings Volumes，2011，44（1）：656-661.
[12] 陈佳佳，梅涛，祝辉.基于路径规划和双闭环控制的泊车系统研究[J].电子测量技术，2011，34（3）：20-24.
CHEN J J，MEI T，ZHU H.Study of autonomous vehicleparking system based on path planning and the double-closed loop method[J].Electronic Measurement Technology，2011，34（3）：20-24.
[13] 胡勤明，王金刚，张小俊.五次多项式优化的平行泊车路径规划[J/OL].计算机工程与应用：1-9（2021-03-25）[2021?07?19].http：//kns.cnki.net/kcms/detail/11.2127.TP.
20210325.1007.008.html.
HU Q M，WANG J G，ZHANG X J.Optimized parallel parking path planning based on quintic polynomial[J/OL].Computer Engineering and Applications：1-9（2021-03-25）[2021-07-19].http：//kns.cnki.net/kcms/detail/11.2127.TP.
20210325.1007.008.html.
[14] 江绍康，江浩斌，马世典.基于反演滑模自适应策略的自动泊车路径跟踪控制[J].重庆理工大学学报（自然科学），2020，34（10）：9-16.
JIANG S K，JIANG H P，MA S D.Automatic parking path tracking control based on backstepping sliding mode adaptive strategy[J].Journal of Chongqing University of Technology（Natural Science），2020，34（10）：9-16
[15] 钱炎，王兆强，李培兴，等.基于二次线性规划的自动泊车的控制方法[J/OL].信息与控制：1-11[2021-07-19].https：//doi.org/10.13976/j.cnki.xk.2021.0592.
QIAN Y，WANG Z Q，LI P X，et al.Automatic parking control based on liner quadratic regulator[J/OL].Information and Control：1?11[2021-07-19].https：//doi.org/10.13976/j.cnki.xk.2021.0592.
[16] SONG J，ZHANG W，WU X，et al.Laser-based SLAM automatic parallel parking path planning and tracking for passenger vehicle[J].Intelligent Transport Systems，IET，2019（10）：1557-1568.
[17] YE H，JIANG H B，MA S D，et al.Linear model predictive control of automatic parking path tracking with soft constraints[J].International Journal of Advanced Robotic Systems，2019，16（3）：1-13.
[18] 黄江，魏德奎，秦良艳，等.自动泊车系统路径规划与跟踪控制方法研究[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.
[19] ZHOU R F，LIU X F，CAI G P.A new geometry-based secondary path planning for automatic parking[J].International Journal of Advanced Robotic Systems，2020，17（3）.
[20] 赵海兰，高松，孙宾宾，等.全自动平行泊车路径规划方法研究[J].科学技术与工程，2017，17（7）：263-269.
ZHAO H L，GAO S，SUN B B，et al.Research on path planning method of full-automatic parallel parking[J].Science Technology and Engineering，2017，17（7）：263-269.
[21] 王洋，雷希超.狭小车位内姿态调整的平行泊车算法研究[J].汽车实用技术，2019（3）：128-130.
WANG Y，LEI X C.The study of parallel parking algorithms in narrow parking Spaces[J].Automobile Applied Technology，2019（3）：128-130.
[22] 张家旭，王晨，赵健，等.面向狭小平行泊车位的路径规划与跟踪控制[J/OL].吉林大学学报（工学版）：1-7[2021-07-19].https：//doi.org/10.13229/j.cnki.Jdxbgxb20200417.
ZHANG J X，WANG C，ZHAO J，et al.Path planning and tracking control for narrow parallel parking space[J/OL].Journal of Jilin University（Engineering and Technology Edition）：1-7[2021-07-19].https：//doi.org/10.13229/j.cnki.Jdxbgxb20200417.
[23] 张猛.自动泊车路径规划算法研究[D].太原：太原科技大学，2018.
ZHANG M.Research on automatic parking path planning algorithm[D].Taiyuan：Taiyuan University of Science and Technology，2018.
[24] 郭夜啼.自动平行泊车路径规划及控制系统研究[D].兰州：兰州交通大学，2020.
GUO Y T.Research on path planning and control system for automatic parallel parking[D].Lanzhou：Lanzhou Jiaotong University，2020.
[25] 周仁芳，刘晓峰，蔡国平.非时间参考下的移动机器人路径跟踪控制[J].控制工程，2020，27（9）：1531-1537.
ZHOU R F，LIU X F，CAI G P.A non-time based path tracking control method for mobile robots[J].Control Engineering of China，2020，27（9）：1531-1537.