[发明专利]一种多无人驾驶车辆路径协同规划方法及系统

说明书

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

技术领域

本发明涉及无人驾驶领域，特别是涉及一种多无人驾驶车辆路径协同规划方法及系统。

背景技术

随着无人驾驶技术快速的发展，无人驾驶技术逐渐由单车智能向多车智能方向发展。真正实现无人驾驶技术的全面落地。其中，多无人驾驶车辆规划技术在整个无人车技术领域中占据着重要地位。高效合理的无人车辆规划技术可以实现车与车之间、车与障碍物之间不发生碰撞。

目前，多无人驾驶车辆规划技术主要面临由运动学约束、动力学约束和障碍物约束等导致复杂的求解过程。在多无人驾驶车辆规划相关技术中，处理这些复杂的约束过于复杂，难以满足规划的实时性要求。另外，无人车行驶的环境不确定，存在动静态行驶的障碍物，合理的规避这些动态障碍物是满足无人车安全性的前提。因此，如何能够合理的避免与动静态障碍物发生碰撞，是现在亟待解决的问题。

发明内容

本发明的目的是提供一种多无人驾驶车辆路径协同规划方法及系统，能够合理的避免与动静态障碍物发生碰撞，进而实现多无人驾驶车辆协同规划控制。

为实现上述目的，本发明提供了如下方案：

一种多无人驾驶车辆路径协同规划方法，包括：

建立多无人驾驶车辆行驶的环境模型；所述环境模型包括：车辆行驶区域、静态障碍物和动态障碍物；

建立每一无人驾驶车辆的运动学模型，并根据运动模型建立无人驾驶车辆之间的防碰撞包裹圆模型；所述防碰撞包裹圆模型为两个无人驾驶车辆的包裹圆不重叠；所述包裹圆的半径是根据对应无人驾驶车辆的前悬长度、后悬长度、车宽以及前后轴之间的距离进行确定；所述包裹圆的圆心是根据对应无人驾驶车辆的后轴中间坐标、在大地坐标系中的姿态角以及前后轴之间的距离进行确定；

根据无人驾驶车辆的之间防碰撞包裹圆模型以及环境模型，采用分离超平面定理，建立无人驾驶车辆与环境中动静态障碍物防碰撞模型；

根据环境模型、运动学模型、防碰撞包裹圆模型以及无人驾驶车辆与环境中动静态障碍物防碰撞模型，基于交替方向乘子法逐步迭代对多无人驾驶车辆进行解耦式运动规划，确定每一无人驾驶车辆的最优路径。

可选地，所述建立多无人驾驶车辆行驶的环境模型，具体包括：

获取动态障碍物的起始点位置、运动时间以及运动速度；

根据动态障碍物的起始点位置、运动时间以及运动速度确定动态障碍物的运动轨迹。

可选地，所述建立每一无人驾驶车辆的运动学模型，并根据运动模型建立无人驾驶车辆之间的防碰撞包裹圆模型，具体包括：

利用公式确定无人驾驶车辆之间的防碰撞包裹圆模型；

其中，为第i个无人驾驶车辆的包裹圆的半径，为第j个无人驾驶车辆的包裹圆的半径，，为第i个无人驾驶车辆的包裹圆的圆心坐标，，为第j个无人驾驶车辆的包裹圆的圆心坐标，N为无人驾驶车辆的个数。

可选地，所述根据无人驾驶车辆的之间防碰撞包裹圆模型以及环境模型，采用分离超平面定理，建立无人驾驶车辆与环境中动静态障碍物防碰撞模型，具体包括：

利用公式确定无人驾驶车辆与环境中动静态障碍物防碰撞模型；