一种基于路面不平度的农业巡检机器人导航决策规划方法

本发明提供了一种基于路面不平度的农业巡检机器人导航决策规划方法，包括控制农业巡检机器人构建二维栅格地图，根据二维栅格地图进行全局路径规划，得到全局最优路径。测量高度数据点的高度值，根据高度值计算激光评定值。根据激光评定值和视觉评定值计算路面不平度，根据路面不平度进行局部路径规划，得到局部最优路径。控制农业巡检机器人运动，更新全局最优路径和局部最优路径，直到农业巡检机器人到达目标终点。结合激光评定值和视觉评定值计算路面不平度，可以提前对周围环境的路面不平度进行识别与预测，提高了路面不平度评估的准确性和鲁棒性。根据场景实际情况实时更新全局最优路径和局部最优路径，可以保证巡检作业的顺利进行。