基于3D实景地图和电子罗盘的巡检机器人路径优化控制器制造技术

本发明专利技术属于机器人避障路线选择优化控制技术领域，涉及一种基于3D实景地图和电子罗盘的巡检机器人路径优化控制器及控制方法。该方法采用基于3D实景地图和电子罗盘定位技术构成的变电站主控室二维定位坐标系统，同时结合电站主控室智能巡检机器人障碍检测系统，动态比对上述两个系统的数据计算并优化机器人的进行路径，从而动态实时的适应机器人周边作业环境的改变。解决了变电站巡检机器人无法针对变电站主控室环境多变的特点，实时自动调整其作业路径，动态适应巡检机器人作业场景的变更的问题。

Path optimization controller of patrol robot based on 3D real map and electronic compass

The invention belongs to the technical field of robot obstacle avoidance route selection and optimization control, and relates to a route optimization controller of a patrol robot based on a 3D real map and an electronic compass, and a control method thereof. The method adopts 3D substation real map and compass positioning technology is the main control room positioning system based on 2D coordinates, combined with the main control room of power plant intelligent inspection robot obstacle detection system, into the path for the dynamic comparison of the above two systems of data calculation and optimization of the robot, so as to adapt to dynamic real-time robot work environment change. It solves the problem that the substation inspection robot can not adjust the operation path automatically according to the changeable environment of the main control room of the substation, and it can adapt to the change of the scene of the patrol robot dynamically.

【技术实现步骤摘要】
基于3D实景地图和电子罗盘的巡检机器人路径优化控制器
本专利技术涉及一种巡检机器人路径优化控制器，尤其涉及一种基于3D实景地图和电子罗盘定位技术的变电站主控室巡检机器人路径优化控制器及控制方法，属于机器人避障路线选择优化控制

技术介绍
当下变电站智能机器人巡检系统已经开始实际应用于中国各省市的电力生产过程中，但在实际应用中机器人无法在变电站主控室进行自动巡检。其原因是目前常用的变电站巡检机器人地图及路径控制系统均无法实时自动调整，以适应巡检机器人作业场景的动态变更。有鉴于此，有必要提供一种基于3D实景地图和电子罗盘定位技术的变电站主控室巡检机器人路径优化控制器及控制方法，以解决上述问题。
技术实现思路
针对现有技术存在的不足，本专利技术的目的在于提供一种基于3D实景地图和电子罗盘定位技术的变电站主控室巡检机器人路径优化控制器及控制方法，采用基于3D实景地图和电子罗盘定位技术构成的变电站主控室二维定位坐标系统，同时结合电站主控室智能巡检机器人障碍检测系统，动态比对上述两个系统的数据计算并优化机器人的进行路径，从而动态实时的适应机器人周边作业环境的改变。为了实现上述目的，本专利技术本文档来自技高网...

【技术保护点】
基于3D实景地图和电子罗盘的巡检机器人路径优化控制器，其特征在于，包括变电站主控室实景3D地图模块、机器人电子罗盘定位模块、机器人电子罗盘定位修正模块、障碍检测模块、机器人行进蔽障及路径优化模块，其中：所述变电站主控室实景3D地图模块，用于构建变电站主控室实景3D地图，同时定义一个二维坐标系，标定实景3D地图中各个物体的坐标点，并在关键坐标点预先装设基于RFID技术的电子标签；所述机器人电子罗盘定位模块，首先通过在机器人本体装设的电子罗盘得到机器人正面所对的方向角度，获得机器人前进的方向角度信息，再根据装设在机器人行进轮伺服电机上的电子计数器，获得机器人行进轮向前或向后旋转的圈数，结合机器人行...

【技术特征摘要】
1.基于3D实景地图和电子罗盘的巡检机器人路径优化控制器，其特征在于，包括变电站主控室实景3D地图模块、机器人电子罗盘定位模块、机器人电子罗盘定位修正模块、障碍检测模块、机器人行进蔽障及路径优化模块，其中：所述变电站主控室实景3D地图模块，用于构建变电站主控室实景3D地图，同时定义一个二维坐标系，标定实景3D地图中各个物体的坐标点，并在关键坐标点预先装设基于RFID技术的电子标签；所述机器人电子罗盘定位模块，首先通过在机器人本体装设的电子罗盘得到机器人正面所对的方向角度，获得机器人前进的方向角度信息，再根据装设在机器人行进轮伺服电机上的电子计数器，获得机器人行进轮向前或向后旋转的圈数，结合机器人行进轮的周长，计算得到机器人行进的距离信息；最后通过将上述方向角度信息和行进的距离信息的叠加到基于变电站主控室实景3D地图的二维坐标系中，完成机器人定位，并让机器人的坐标计算原点和变电站主控室实景3D地图坐标系原点同步；所述机器人电子罗盘定位修正模块，该模块根据在变电站主控室实景3D地图坐标系中关键坐标预先装设基于RFID技术的电子标签，通过机器人自身携带的RFID电子标签读取器，读取该关键坐标的RFID技术的电子标签信息，判断机器人电子罗盘定位模块计算得到的机器人定位坐标是否与RFID电子标签所标记的关键坐标一致；如果一致则不用矫正机器人电子罗盘定位系统参数，如果不一致则根据关键坐标位置矫正机器人电子罗盘定位系统参数，并根据电子罗盘定位系统新参数修正机器人姿态；所述障碍检测模块，通过机器人自身携带的障碍检测模块，实时监测和发现机器人作业环境中动态出现的障碍物，测量出障碍物到机器人的距离和方位；所述机器人行进蔽障及路径优化模块，该模块根据机器人障碍检测模块反馈的机器人作业环境中动态出现的障碍物信息，包括障碍物离机器人的距离方位，以及机器人在变电站主控室二维定位坐标系中的当前坐标和姿态，在3D实景地图上标记出机器人的位置信息点；通过比对机器人反馈障碍物信息，模块首先判断该障碍物是固有的还是新增加的，如是固有的就按照原预设的路径调整机器人的行进方向按原路径巡检，如果是新增加的模块就根据机器人在3D实景地图的位置信息点查找周围环境信息，计算可行的新的路径避开障碍物，并计算新的路径到达下一个机器人巡检点的路径开销优化机器人的路径。2.如权利要求1所述的基于3D实景地图和电子罗盘的巡检机器人路径优化控制器，其特征在于，所述关键坐标点包括地图物理边界、道路拐点。3.基于3D实景地图和电子罗盘的巡检机器人路径优化控制方法，其特征在于，包括如下步骤：步骤1：构建变电站主控室实景3D地图，同时定义一个二维坐标系，标定实景3D地图中各个物体的坐标点，并在关键坐标点预先装设基于RFID技术的电子标签；步骤2：通过机器人电...

【专利技术属性】
技术研发人员：汤胜，李诚，刘海琼，徐琴，项涛，齐放，王丹君，张磊，彭钢，柯亮，胡伟文，张硕，陈艳，邹芹，王侨，
申请(专利权)人：国家电网公司，国网湖北省电力公司武汉供电公司，武汉易锐科技发展有限公司，
类型：发明
国别省市：北京,11