一种空地协同的无人车路径规划方法
摘要:
本发明属于多无人系统协同控制领域,公开了一种空地协同的无人车路径规划方法,步骤如下:首先,基于无人车和无人机搭载的激光雷达,分别得到各自的点云地图;其次,将无人机的点云地图转换到无人车坐标系下,得到融合点云,生成三维栅格地图;再次,由三维栅格地图生成地面二维栅格地图;最后,基于导航地图进行可执行路径搜索,基于复杂地形的改进A*算法生成初始路径,由B样条曲线将初始路径拟合为光滑轨迹,然后基于软约束的优化方法,通过动力学可行性、轨迹光滑性、碰撞安全性三项惩罚对光滑轨迹进行优化,得到规划轨迹,进而可实现无人车高效快速安全的目标区域搜索任务。
公开/授权文献
0/0