[发明专利]变电站巡检机器人定位导航系统及方法

摘要

本发明公开了变电站巡检机器人定位导航系统及方法，激光测距模块及航位推算模块所得到的信息分别输出至地图创建模块与位姿解算模块，地图创建模块创建表示机器人运行环境的激光路标地图与激光栅格地图并输入地图存储模块进行存储，位姿解算模块利用地图存储模块中的地图数据以及航位推算模块的输出数据实时解算机器人当前位置和姿态并将所得到的位姿数据接入路径规划模块与运动控制模块，路径规划模块生成机器人运行路径数据并输出至运动控制模块，运动控制模块依据机器人当前位置姿态数据及路径规划数据生成运动控制量，之后由电机控制模块执行。本发明保证定位导航实时性的前提下实现巡检机器人变电站内精确定位。

主权项

变电站巡检机器人定位导航系统的方法，其特征是，包括以下步骤：步骤一：利用激光测距模块采集的机器人周边障碍物相对于激光传感器扫描中心的距离信息，利用航位推算模块得到的当前机器人在全局坐标系下的位置姿态估计，将激光测距模块及航位推算模块的结果分别输出至地图创建模块与位姿解算模块；步骤二：地图创建模块根据得到的信息创建表示机器人运行环境的激光路标地图与激光栅格地图并输入地图存储模块进行存储；步骤三：位姿解算模块利用地图存储模块中的地图数据以及航位推算模块的输出数据实时解算机器人当前位置和姿态并将所得到的位姿数据接入路径规划模块与运动控制模块；步骤四：路径规划模块生成机器人激光路标拓扑地图与全局路径规划用拓扑地图，依据巡检任务规划机器人巡检运行路线，路径规划得到的路径数据输入运动控制模块执行；所述步骤二中，地图创建模块创建表示机器人运行环境的激光路标地图与激光栅格地图，具体包括以下步骤：步骤：2‑1)：地图创建初始化；步骤:2‑2)：获取k至k+1时刻过程中机器人位置姿态变化量，经航位推算模块计算得到机器人全局坐标系下的位置姿态估计值；步骤：2‑3)：在k+1时刻，获取激光测距模块数据，与地图存储模块中距机器人当前位置最近的已有激光路标包含的激光测距数据匹配，得到机器人相对于该路标的距离和夹角的观测向量；步骤：2‑4)：利用扩展卡尔曼滤波方法将航位推算输出机器人位置姿态估计值与匹配得到的路标观测值融合，从而得到机器人当前位置姿态的精确估计；步骤：2‑5)：计算当前机器人位置与路标位置的距离，并与设定的相邻路标间隔距离阈值比较，再执行下子步骤：2‑5‑1)如果小于等于预先设定的阈值，机器人返回步骤2‑2)执行；2‑5‑2)如果大于设定阈值，则读取激光测距数据和机器人当前位置姿态，形成新的激光路标并进行存储，之后再返回步骤2‑2)执行；步骤：2‑6)：重复执行步骤2‑2)至2‑5)，直至建立完整的机器人运行环境电子地图；步骤：2‑7)：对上述步骤生成地图中的激光路标数据进行进一步数据处理，路标点相关激光扫描数据可栅格化后形成栅格地图。