无人车网络编队的运动规划和协作定位方法及装置

摘要

本发明提供一种无人车网络编队的运动规划和协作定位方法及装置，所述方法包括：在一个规划周期内，根据获取到的无人车网络编队中每一车辆的初始位姿、目标位姿和运动学参数，生成路径规划，无人车网络编队包括一个领航车辆和若干个随从车辆；将路径规划发送到每一随从车辆，以供每一随从车辆根据路径规划完成相应的目标位姿。本发明提供的无人车网络编队的运动规划和协作定位方法及装置，采用分层式体系结构，设置领航车辆和随从车辆。路径规划部分考虑多种约束条件，采取Dubins最短路径规划方式，协作定位部分通过扩展卡尔曼滤波，利用UWB测距、惯性导航、陀螺仪等易于采集的进行信息融合，消除位姿估计的不确定性，提高了定位效率。