本申请涉及一种多约束泊车路径规划方法、装置和汽车控制系统,其中,该多约束泊车路径规划方法包括:基于蜣螂优化算法和自车的当前位置确定自车的多个候选的泊车起始位置和泊车终点位置,自车从当前位置移动至泊车起始位置的路径为第一路径,自车从当前位置移动至泊车终点位置的路径为第二路径;通过目标优化模型从自车的多个候选的泊车起始位置和泊车终点位置中确定自车的目标泊车起始位置和目标泊车终点位置以及对应的第一路径和第二路径。本技术主要将泊车过程分为两个阶段,第一个阶段用于调整车辆位置第二个阶段用于执行泊车动作,以及通过改进的蜣螂优化算法直接计算得到两个阶段的路径终点,提高了自动泊车的路径规划效率。
背景技术
无人驾驶汽车泊车路径规划类型包括多项式曲线、圆弧-直线、B样条曲线、Sigmoid函数和反正切函数曲线规划等。例如,直线—过渡曲线—圆弧段—过渡曲线—圆弧段五段式平行泊车路径规划满足曲率连续要求,路径跟踪难度较小;基于圆弧—直线组合曲线推导平行泊车可行泊车起始区域边界,对固定回旋曲线旋转和翻转变换得到曲率连续的平行泊车路径。
上述无人驾驶汽车泊车路径规划方法多为单步泊车方法,即直接将自车的当前位置作为起点,规划一条驶入停车位的泊车路线。而自车的当前位置是由驾驶员确定的(通常为驾驶员停车后启动自动泊车功能),进而自车的当前位置并非理想的泊车起点。因此,上述无人驾驶汽车泊车路径规划方法,在一些情况下无法规划出较优的泊车路径,甚至无法规划出泊车路径,而较差的泊车路径会使得车辆最终位姿不理想或是与障碍物产生碰撞。
实现思路