一种任意起始位姿的连续曲率泊车路径在线规划方法
CSTR:
作者:
作者单位:

同济大学 汽车学院, 上海 201804

作者简介:

刘美岑(1997—),女,硕士生,主要研究方向为自动驾驶运动规划。E-mail: meicenliu@tongji.edu.cn

通讯作者:

陈慧(1964—),男,教授,博士生导师,工学博士,主要研究方向为智能车辆技术。E-mail: hui-hen@tongji.edu.cn

中图分类号:

U461


An Online Curvature Continuous Parking Path Planning Method for Arbitrary Starting Posture
Author:
Affiliation:

School of Automotive Studies, Tongji University, Shanghai, 201804, China

  • 摘要
  • | |
  • 访问统计
  • |
  • 参考文献 [31]
  • |
  • 相似文献 [20]
  • | | |
  • 文章评论
    摘要:

    针对目前泊车路径规划算法对起始位姿要求严格,且难以兼顾最终位姿精度、路径质量及计算效率等问题,提出了一种任意起始位姿的连续曲率路径在线规划方法。该方法将整个泊车路径规划分为库位内调整与入库过程两部分。库位内调整采用以最终位姿高精度与调整次数最少为目标函数的最优化方法进行逐段规划;入库过程采用连续曲率曲线组用于混合A*算法的状态节点扩展以直接生成无需后处理的可执行路径。设计考虑路径的曲率变化与方向改变次数的估价函数;采用由路径几何形状特征点构建特征多边形的碰撞检测方法以提高计算效率。离线仿真与实车试验结果验证了该方法的有效性。

    Abstract:

    An online curvature continuous parking path planning method that has no requirement on parking initial posture is proposed to balance the accuracy of parking final posture, path quality, and computation efficiency. The entire path planning process is divided into two parts. An optimization-based approach is used within the parking lot for piecewise planning to improve the accuracy of final posture and reduce the number of adjustments. An adapted hybrid A* algorithm that expands the state node with curvature continuous curve groups is used when reversing into the parking lot, which skips post-process and improves computation efficiency. In the proposed adapted hybrid A* algorithm, a cost function taking into account the path curvature changes and the number of direction changes is designed, and a collision detection method using feature polygon constructed by path geometry feature points is proposed to improve the computation efficiency. Simulations and real vehicle test verifies the effectiveness of the proposed method.

    参考文献
    [1] LI M H , TSENG P K . Implementation of an autonomous driving system for parallel and perpendicular parking[C]//IEEE/SICE International Symposium on System Integration (SII), [S. I.]: IEEE, 2016:198.
    [2] CHAI R, TSOURDOS A, SAVVARIS A, et al. Multi-objective optimal parking maneuver planning of autonomous wheeled vehicles[J]. IEEE Transactions on Industrial Electronics, 2020, 67(12):10809.
    [3] GONZáLEZ D, PéREZ J, MILANéS V, et al. A review of motion planning techniques for automated vehicles[J]. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(4):1135.
    [4] 张野, 陈慧, 程昆朋. 基于两步法的平行泊车分段路径规划算法[J]. 计算机仿真, 2013, 30(6):169.ZHNAG Ye, CHEN Hui, CHENG Kunpeng. Path planning method for parallel parking assist system[J]. Computer Simulation, 2013, 30(6):169.
    [5] CHEN C. Optimal path for a car-like robot to reach a given straight line[C]//International Conference on Intelligent Transportation Systems. Maui: IEEE, 2018:2270.
    [6] PIAZZI A, BIANCO C L, BERTOZZI M, et al. Quintic G2-splines for the iterative steering of vision-based autonomous vehicles[J]. IEEE Transactions on Intelligent Transportation Systems, 2002, 3(1):27.
    [7] GLASER S, VANHOLME B, MAMMAR S, et al. Maneuver-based trajectory planning for highly autonomous vehicles on real road with traffic and driver interaction[J]. IEEE Transactions on Intelligent Transportation Systems, 2010, 11(3):589.
    [8] KWANGJIN Y, SUKKARIEH S. An analytical continuous-curvature path-smoothing algorithm[J]. IEEE Transactions on Robotics, 2010, 26(3): 561.
    [9] CONNORS J, ELKAIM G. Analysis of a spline based, obstacle avoiding path planning algorithm[C]// 2007 IEEE 65th Vehicular Technology Conference. [S. l.]: IEEE, 2007:2565.
    [10] SONG J, ZHANG W, WU X, et al. Laser-based SLAM automatic parallel parking path planning and tracking for passenger vehicle[J]. IET Intelligent Transport Systems, 2019, 13(10):1557.
    [11] 李红, 王文军, 李克强. 基于B样条理论的平行泊车路径规划[J]. 中国公路学报, 2016, 29(9): 143.LI Hong, WANG Wenjun, LI Keqiang. Path planning for parallel parking based on b spline theory[J]. China Journal of Highway and Transport, 2016, 29(9): 143.
    [12] DOLGOV D, THRUN S, MONTEMERLO M, et al. Practical search techniques in path planning for autonomous driving. Ann Arbor, 2008.
    [13] ZHANG S, CHEN Y, CHEN S, et al. Hybrid A*-based curvature continuous path planning in complex dynamic environments[C]//2019 IEEE Intelligent Transportation Systems Conference. Auckland, New Zealand: IEEE, 2019: 3802.
    [14] SEDIGHI S, NGUYEN D, KAPSALAS P, et al. Implementing Voronoi-based Guided Hybrid A* in Global Path Planning for Autonomous Vehicles[C], 2019 IEEE Intelligent Transportation Systems Conference. Auckland, New Zealand: IEEE, 2019: 3845.
    [15] JHANG J H, LIAN F L, HAO Y H. Human-like motion planning for autonomous parking based on revised bidirectional rapidly-exploring random tree* with Reed-Shepp curve[J]. Asian Journal of Control, 2020(4):1002.
    [16] ZIPS P, BOCK M, KUGI A. A fast motion planning algorithm for car parking based on static optimization[C]//Intelligent Robots and Systems (IROS), 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. [S. l.]: IEEE, 2013: 2392.
    [17] LI B, SHAO Z. A unified motion planning method for parking an autonomous vehicle in the presence of irregularly placed obstacles[J]. Knowledge Based Systems, 2015, 86:11.
    [18] ZHANG X, LINIGER A, SAKAI A, et al. Autonomous parking using optimization-based collision avoidance[C]//2018 IEEE Conference on Decision and Control (CDC). Miami: IEEE, 2018:4327.
    [19] SHI S, XIONG Y , CHEN J, et al. A bilevel optimal motion planning (BOMP) model with application to autonomous parking[J]. International Journal of Intelligent Robotics and Applications, 2019, 3(4):370.
    [20] ZHANG X, LINIGER A, SAKAI A, et al. Autonomous parking using optimization-based collision avoidance[C]//2018 IEEE Conference on Decision and Control (CDC), 2018:4327-4332.
    [21] LIM W, LEE S, SUNWOO M, et al. Hierarchical trajectory planning of an autonomous car based on the integration of a sampling and an optimization method[J]. IEEE Transactions on Intelligent Transportation Systems, 2018(2):1.
    [22] HUIFANG W, YANGZHOU C, SOUERES P. An efficient geometric algorithm to compute time-optimal trajectories for a car-like robot[C]//IEEE Conference on Decision & Control. [S. l.]: IEEE, 2007: 5383.
    [23] LIU W, LI Z, LI L, et al. Parking like a human: a direct trajectory planning solution[J]. IEEE Transactions on Intelligent Transportation Systems, 2017, 18(12):3388.
    [24] LIN Y, LI L, DAI X, et al. Master general parking skill via deep learning[C]//IEEE Intelligent Vehicles Symposium (IV). [S. l.]: IEEE, 2017:941.
    [25] ZHANG J, CHEN H, SONG S, et al. Reinforcement learning-based motion planning for automatic parking system[J], IEEE Access, 2020, 8: 154485.
    [26] DU Z, MIAO Q, ZONG C. Trajectory planning for automated parking systems using deep reinforcement learning[J]. International Journal of Automotive Technology, 2020, 21(4):881.
    [27] ZHANG P, XIONG L, YU Z. Reinforcement learning-based end-to-end parking for automatic parking system[J]. Sensors, 2019, 19(18):3996.
    [28] HART P E, NILSSON N J, RAPHAEL B. A formal basis for the heuristic determination of minimum cost paths[J]. IEEE Transactions on Systems Science and Cybernetics, 1968, 4(2):100.
    [29] DOLGOV D, THRUN S, MONTEMERLO M, et al. Path planning for autonomous vehicles in unknown semi-structured environments[J]. International Journal of Robotics Research, 2010, 29(5):485.
    [30] 郑建华,吴根兴. 象限法——判断点在平面多边形之内或之外[C]//六省市工程图学学术会议. 厦门: 集美大学学报, 2001:40.ZHENG Jianhua, Wu Genxing. Quadrant method-determine whether the point is inside or outside the plane polygon[C]//Six provincial and municipal engineering graphics academic conferences. Xiamen: Journal of Jimei University, 2001:40.
    [31] FAN Z S, CHEN H. Study on path following control method for automatic parking system based on LQR[J]. SAE International Journal of Passenger Cars Electronic & Electrical Systems, 2016, 10(1):1881.
    引证文献
    网友评论
    网友评论
    分享到微博
    发 布
引用本文

刘美岑,陈慧,张书恺.一种任意起始位姿的连续曲率泊车路径在线规划方法[J].同济大学学报(自然科学版),2021,49(S1):114~122

复制
分享
文章指标
  • 点击次数:105
  • 下载次数: 500
  • HTML阅读次数: 38
  • 引用次数: 0
历史
  • 收稿日期:2021-08-16
  • 在线发布日期: 2023-02-28
文章二维码