[发明专利]多车辆协同避碰方法、装置、系统、存储介质及终端

权利要求书

1.一种多车辆协同避碰方法，其特征在于，包括：

获取车辆的实时运行信息以及参考速度数据；

根据所述实时运行信息以及所述参考速度数据确定所述车辆在预设时间间隔后的位姿信息；

当基于所述位姿信息确定至少两个目标车辆之间预期发生碰撞，则确定所述目标车辆协同避碰的速度策略，并根据所述速度策略控制所述目标车辆进行协同避碰；

其中，所述确定所述目标车辆协同避碰的速度策略包括：

获取参考速度调整策略，所述参考速度调整策略包括各车辆预期发生碰撞时对所述参考速度数据进行调整的至少一个速度策略；

根据所述参考速度调整策略以及预期发生碰撞的所述目标车辆的约束关系构建速度策略对应关系，所述速度策略对应关系中包括各目标车辆与不同参考速度调整策略之间的选取关系；其中，所述约束关系包括第一约束关系以及第二约束关系，所述第一约束关系用于表征一个目标车辆与一个参考速度调整策略的唯一选取关系，所述第二约束关系用于表征任意两个目标车辆选取相应参考速度调整策略时预期发生碰撞的禁止同时选取关系；

从所述速度策略对应关系中确定与所述目标车辆存在选取关系的速度策略，以作为所述目标车辆协同避碰的速度策略。

2.根据权利要求1所述的方法，其特征在于，所述根据所述参考速度调整策略以及预期发生碰撞的所述目标车辆的约束关系构建速度策略对应关系包括：

构建所述参考速度调整策略与所述目标车辆之间的初始速度策略矩阵，所述初始速度策略矩阵的第一约束关系为所述目标车辆所对应的行或列中元素值之和等于预设阈值；

为预期发生碰撞的所述目标车辆与所述参考速度调整策略配置第二约束关系，所述第二约束关系为预期发生碰撞的所述目标车辆与所述参考速度调整策略所对应的矩阵元素值之和小于等于所述预设阈值；

基于所述第一约束关系、所述第二约束关系线性规划求解所述初始速度策略矩阵，得到速度策略对应关系。

3.根据权利要求2所述的方法，其特征在于，所述基于所述第一约束关系、所述第二约束关系线性规划求解所述初始速度策略矩阵，得到速度策略对应关系包括：

为所述初始速度策略矩阵中的各元素配置策略权重，并根据带有所述策略权重的所述初始速度策略矩阵、所述第一约束关系、所述第二约束关系进行最优线性规划求解，得到速度策略对应关系，所述速度策略对应关系中通过所述目标车辆所对应的行或列中的元素值确定选取对应的参考速度调整策略。

4.根据权利要求1所述的方法，其特征在于，所述位姿信息包括估计参考速度以及位置朝向，所述根据所述实时运行信息以及所述参考速度数据确定所述车辆在预设时间间隔后的位姿信息包括：

基于所述参考速度调整策略、所述参考速度数据对所述实时运行信息中的实时速度数据进行调整，并基于调整得到的估计参考速度确定所述车辆在预设时间间隔后的行驶路程；

通过所述车辆的参考路径查找所述车辆预期行驶所述行驶路程的位置点，并基于所述参考路径的航向角确定处于所述位置点的所述车辆的位置朝向。

5.根据权利要求4所述的方法，其特征在于，所述确定所述目标车辆协同避碰的速度策略之前，所述方法还包括：

获取任意两个车辆所对应的位置朝向，以及所述车辆的尺寸信息，并按照所述车辆的位置中心点和所述车辆的尺寸信息，构建匹配所述车辆的碰撞区域；

若任意两个车辆的碰撞区域存在交叉，则确定所述车辆为预期发生碰撞的目标车辆。

6.根据权利要求1-5任一项所述的方法，其特征在于，所述获取车辆的参考速度数据包括：

获取所述车辆行驶的参考路径，并将所述参考路径所配置的预设速度数据确定为参考速度数据；或，

接收与开放作业区、作业环境、所述车辆至少一项所匹配的录入速度数据，并将所述录入速度数据确定为参考速度数据。