首先人为控制小车行驶,在行驶过程中小车会相隔一段距离生成一个带序号的路径点,在行驶完成后,可指定路径点的序号,使小车自动行驶到相应位置。
在室外开阔无遮挡环境下,通过RTK的实时差分技术可实现高精度定位。本车有两个RTK装置,左右各一个,可以得到较为精准的位置信息 (经纬度)和航向信息。
在得到地图后,通过激光雷达扫描得到的点 云帧与全局点云地图进行NDT算法匹配得到小车的位置与姿态。
Astar算法一种广泛使用的路径搜索算法,特别适用于图搜索问题,它通过在图中寻找从起点到终点的最短路径,同时避开障碍物。