一种多无人驾驶车辆路径协同规划方法及系统
摘要:
本发明涉及一种多无人驾驶车辆路径协同规划方法及系统。该方法包括建立多无人驾驶车辆行驶的环境模型;建立每一无人驾驶车辆的运动学模型,并根据运动模型建立无人驾驶车辆之间的防碰撞包裹圆模型;根据无人驾驶车辆的之间防碰撞包裹圆模型以及环境模型,采用分离超平面定理,建立无人驾驶车辆与环境中动静态障碍物防碰撞模型;根据环境模型、运动学模型、防碰撞包裹圆模型以及无人驾驶车辆与环境中动静态障碍物防碰撞模型,基于交替方向乘子法逐步迭代对多无人驾驶车辆进行解耦式运动规划,确定每一无人驾驶车辆的最优路径。本发明能够合理的避免与动静态障碍物发生碰撞,进而实现多无人驾驶车辆协同规划控制。
公开/授权文献
0/0