[发明专利]一种基于改进SLAM的巡检机器人导航控制方法

说明书

一种基于改进SLAM的巡检机器人导航控制方法。该方法包括以下步骤：步骤1，采集巡检机器人运行时的数据；步骤2，建立改进的SLAM机器人定位算法；步骤3，依据步骤2所获得的地图对机器人进行路径规划；步骤4，对巡检机器人加速度、速度和目标方位角闭环控制；步骤5，巡检路线上的异常情况处理。本发明通过巡检机器人相邻时刻的位姿差对SLAM算法中的提议分布函数进行改进，并通过线速度和角速度的轨迹评价函数对下一时刻的速度进行更新，并通过矢量控制和PID闭环算法完成巡检机器人的导航控制，可提高巡检机器人位姿的精确度和可靠性。

技术领域

本发明涉及巡检车循迹领域，特别是涉及一种基于改进SLAM的巡检机器人导航控制方法。

背景技术

随着社会的发展与科技的进步，特种作业机器人在军用、民用、科学研究等多个领域得到了广泛的应用。在众多危险、不宜人类活动的环境下，机械、重复性高的岗位上，特种作业机器人正在逐步替代人类完成各种危险工作。作为一种具有高度灵活性的自主移动机器人，需具备环境感知、路径规划、自主充电和远程通讯能力。巡检机器人自主巡检过程中，会面临各种复杂的不确定性环境，自主巡检功能主要体现在对环境的感知能力，而这种环境感知能力依赖于自身携带的外部传感器，如激光雷达、相机、毫米波雷达和超声波雷达等，这些传感器能够感知外部环境变化，可协助机器人完成更多的危险工作。

在机器人感知外部环境过程中实时定位与地图构建技术作为巡检机器人研究的核心技术之一，能够构建精确的环境地图是实现机器人巡检功能的重要环节，而机器人SLAM的关键在于自身定位功能的实现，以确保机器人在感知外部环境信息的同时能确定自身的位姿信息；同时，对周围环境地图信息感知的准确程度又是机器人能否实现精确定位的基础。目前基于先验地图的机器人自主导航研究已经趋于成熟并被广泛应用，但在未知环境下，机器人仅根据自身携带的外部传感器自主探索感知环境并生成高精度地图仍然是一个研究难点。

发明内容

为解决上述问题，本发明提出了一种基于改进SLAM的巡检机器人导航控制方法，通过SLAM算法对定位与地图的构建，结合路径规划算法，实现巡检机器人自主运动。为了提高巡检机器人位姿的精确度和可靠性，通过巡检机器人相邻时刻的位姿差对SLAM算法中的提议分布函数进行改进。本发明提供一种基于改进SLAM的巡检机器人导航控制方法，具体步骤如下，其特征在于：

步骤1，采集巡检机器人运行时的数据：通过激光雷达采集巡检机器人的位置信息，并根据驱动器反馈记录巡检机器人的动作信息；

步骤2，建立改进的SLAM机器人定位算法：将当前时刻与上一时刻的位姿差作为SLAM的提议分布，获得改进后的SLAM机器人定位算法，并通过SLAM算法对当前运行环境建立全局地图；

步骤3，依据步骤2所获得的地图对机器人进行路径规划，对巡检机器人行驶速度进行采样，并根据评价公式对巡检机器人当前行驶的速度进行更新；

步骤4，对巡检机器人加速度、速度和目标方位角闭环控制：通过矢量控制实现巡检机器人的电机控制，并对巡检机器人的加速度、速度和目标方位角进行PID闭环控制

步骤5，巡检路线上的异常情况处理：通过实时图像采集系统采集巡检路线上的人员求助和违法犯罪等紧急情况，同时启动中断处理机制，日志模块记录车载终端的异常情况。

进一步，步骤2中建立改进的SLAM机器人定位算法的过程可以表示为：

通过联合概率密度函数将算法模型表示成定位和建图两个过程

p(x_k，m|z_k，u_k-1)＝p(x_k|z_k，u_k-1)p(m|x_k，z_k) (1)