CN106272434B - 一种巡检机器人的一键返航控制方法及*** - Google Patents

一种巡检机器人的一键返航控制方法及*** Download PDF

Info

Publication number
CN106272434B
CN106272434B CN201610868066.1A CN201610868066A CN106272434B CN 106272434 B CN106272434 B CN 106272434B CN 201610868066 A CN201610868066 A CN 201610868066A CN 106272434 B CN106272434 B CN 106272434B
Authority
CN
China
Prior art keywords
robot
tag
rfid
distance
magnetic induction
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610868066.1A
Other languages
English (en)
Other versions
CN106272434A (zh
Inventor
张浩杰
苏波
宋海平
陶进
杨景槐
满艺
苏治宝
金宇春
朱林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China North Vehicle Research Institute
Original Assignee
China North Vehicle Research Institute
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China North Vehicle Research Institute filed Critical China North Vehicle Research Institute
Priority to CN201610868066.1A priority Critical patent/CN106272434B/zh
Publication of CN106272434A publication Critical patent/CN106272434A/zh
Application granted granted Critical
Publication of CN106272434B publication Critical patent/CN106272434B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种巡检机器人的一键返航控制方法及***，方法包括：写入RFID标签信息；记录测量的RFID标签间的距离；给机器人发送指令以移动至有效RFID标签；发送返回原点的最佳路径指令。本发明的巡检机器人一键返航控制方法及***，实现机器人在部件损坏或电池电量偏低等意外情况发生时快速返回任务起点，保证巡检工作顺利进行。

Description

一种巡检机器人的一键返航控制方法及***
技术领域
本发明涉及巡检机器人自主导航***，尤其涉及巡检机器人的一键返航控制方法及***。
背景技术
巡检机器人能够代替巡检工，可靠巡检、自主充电，实时采集、存储、传输现场的图像、声音、温度、烟雾等数据。通过对数据的分析，判断是否存在设备故障以及故障位置，把巡检工从恶劣的工作环境中解脱出来，减轻劳动强度、降低劳动风险，避免事故扩大化，大大降低生产过程中的非正常停机时间，且具有终点自动换向、限位停止、定点校正等功能。巡检机器人平台主要由巡检机器人本体、控制箱、无线通讯***、充电装置和轨道***组成，适用于城市综合管廊、电缆管廊、矿山水泵房、变电所、大型胶带输送机巷道移动巡检。
在变电站强电磁环境中，变电站巡检机器人一般采用路面磁条引导加射频识别(RFID)标签的方法。变电站巡检机器人在跟踪路面磁条执行任务过程中，偶尔会发生部件损坏或电池电量过低等意外情况，导致其无法继续执行巡检任务，这时单纯依赖变电站工作人员实施救援，既耗费时间，又耗费人力。尤其在一些狭窄区域，难予施救。
发明内容
针对现有技术存在的上述不足，本发明提供一种巡检机器人的一键返航控制方法及***，本发明的目的是采用以下技术方案实现的：
本发明的巡检机器人的一键返航控制方法，其改进之处在于，所述方法包括：
A写入RFID标签信息；
B记录测量的RFID标签间的距离；
C给机器人发送指令以移动至有效RFID标签；
D发送返回原点的最佳路径指令。
优选地，所述步骤A中，所述标签信息由用字母‘S’、‘D’、‘L’或‘R’表示的包头和从000开始排列的数字共同组成的4个字节。
优选地，将所述‘S’标签固定于各个停靠点，将‘L’或‘R’标签固定于各个转弯处，将‘D’标签固定于狭窄断头路区域的停靠点。
优选地，所述步骤B中，将所述RFID标签设于闭环路径中，按照所述标签信息的数字序号将测量的距离值记录于distance.txt文本文档中，启动工控机，将所述distance.txt文本文档的距离值读入到一维数组distance中；其中将L或R标签至D标签间的距离记为0。
优选地，所述步骤C中，向机器人发送返航指令后行驶至所述RFID标签，若有‘S’、‘L’或‘R’的有效标签，则读取签号i；若是信息包头为‘D’的无效标签，则执行后退运动直至有所述有效RFID标签感应。
优选地，所述步骤D中，接收指令的机器人根据当前的签号i，计算distance[0]～distance[i]的累加和Lb同剩余路径的累加和Lf，并将此两累加和比较，若Lb>Lf，则向机器人发出前进指令，否则发送后退指令，直至运动到标签S000处。
一种基于上述方法的巡检机器人的一键返航控制***，包括工控机、运动控制器、前端磁感应传感器、后端磁感应传感器、RFID传感器；其改进之处在于，所述工控机分别与所述前端磁感应传感器、后端磁感应传感器、RFID传感器和运动控制器连接。
优选地，所述RFID传感器设于机器人底盘几何中心处，所述RFID标签设于机器人完成任务的闭环路径中。
优选地，所述前端磁感应传感器和后端磁感应传感器由16阵列磁感应点组成。
优选地，所述RFID传感器采用实时检测模式。
与最接近的现有技术相比，本发明具有如下有益效果：
本发明的巡检机器人的工控机接收前端磁感应传感器、后端磁感应传感器和RFID传感器传输的数据，发送指令至运动控制器，接收指令的机器人感应有效标签，确定最短路径并最终返回原点。本发明的一键返航方法流程简单，且用时时间极短，保证了机器人在部件损坏或电池电量偏低等意外情况发生时快速返回任务起点，无需依赖变电站工作人员施救，确保巡检工作的顺利进行。
附图说明
图1为本发明的一键返航控制方法流程图
图2为本发明巡检路径示意图
图3是本发明的一键返航控制***示意图
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对实施例中的技术方案进行清楚、完整地描述，以下实施例用于说明本发明，但不用来限制本发明的范围。
本发明提供的巡检机器人的一键返航控制方法，使机器人在执行巡检任务时发生部件损坏或电池电量过低等意外情况时能自主返回起点。在一键返航命令触发后，机器人可快速计算出最短的返回路径，最快并以最少的能量消耗返回起点。
如图1所示，具体步骤为：
(1)写入RFID标签信息，标签信息由数据包头和数字共四个字节组成，比如S001。包头采用字母‘S’、‘D’、‘L’和‘R’表示，信息包头为‘S’的标签固定在各个停靠点，包头为‘L’和‘R’的标签固定在各个转弯处，而包头为‘D’的标签则顺序固定在狭窄断头路区域的停靠点处；数字由三字节表示，从000(起点)开始顺序排列。
(2)人工测量各个RFID标签之间的距离信息，按照RFID标签信息的数字序号将测量的距离值记录在distance.txt文本文档中，其中L或R标签到D标签的距离记为0；
启动工控机，将distance.txt文本文档中的距离值读入到一维数组distance中。
(3)机器人在执行巡检任务过程中接收工作人员一键返航指令后，继续正常行驶至RFID标签点后停止，若当前时刻RFID标签为‘S’、‘L’或‘R’，则停止前行，若当前时刻RFID标签为‘D’，则执行后退运动，直至感应到‘L’、‘R’或‘S’标签停止前行，读取标签号i。
(4)根据当前的RFID标签号i，计算distance[0]～distance[i]的累加和Lb同剩余路径累加和Lf，二者比较；其中若Lb<Lf，则机器人执行后退运动，否则执行前进运动；在前行或后退运动过程中忽略其它标签信息，直至运动到标签S000处停止，即完成一键返航操作。
如图2所示，建立于坐标系上的矩形框为磁条，信息包头为‘S’的标签固定在各个停靠点，包头为‘L’和‘R’的标签固定在各个转弯处，而包头为‘D’的标签则顺序固定在狭窄断头路区域的停靠点处；数字由三字节表示，S000代表起点。
若机器人接收一键返航指令后行驶至D005处，则执行后退运动移动至L004，判断distance[0]～distance[4]的距离小于剩余路径距离，则沿前者运动直至原点。
如图3所示，巡检机器人的一键返航控制***，包括工控机、运动控制器、前端磁感应传感器、后端磁感应传感器、RFID传感器、RFID标签；工控机接收前端磁感应传感器、后端磁感应传感器、RFID传感器的信息，解算出运动控制量并发送给运动控制器。
RFID传感器安装于机器人底盘几何中心处，RFID标签设于机器人可完成任务的闭环路径中，采用实时检测模式。前端磁感应传感器和后端磁感应传感器由16阵列磁感应点组成。
机器人根据磁条运动时，工控机上运行自主导航***，采集磁传感器数据，按照下式计算机器人横摆角速度w和行驶速度v：
Figure BDA0001123488850000041
v＝const
其中，l和r分别是磁感应传感器左右感应到磁条的磁感应点数目总和，n为磁感应点数目总和，wmax为机器人的最大横摆角速度，const为常值。
工控机将机器人横摆角速度和行驶速度运动控制量发送给运动控制器，驱动机器人沿着磁轨迹移动；依据当前时刻及上一时刻接收到的数据包头信息切换跟踪控制模式，设定前进模式、后退模式、左转模式及右转模式。在后退模式控制过程中，控制量解算器采集后端磁传感器数据计算机器人运动控制量，而在其它模式采集前端磁传感器数据计算运动控制量。针对变电站巡检环境，设计了前进模式、后退模式、左转模式及右转模式进行切换，在每个模式中采用控制量解算器实时计算机器人调整姿态的运动控制量，并下发给运动控制器，实现了机器人在停靠点的精确控制，避免了其原地转向运动，有效降低能量消耗，提高机器人***的运行效率。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (6)

1.一种巡检机器人的一键返航控制方法，其特征在于，所述方法包括如下步骤：
步骤A写入RFID标签信息；
步骤B记录测量的RFID标签间的距离；
步骤C给机器人发送指令移动至有效RFID标签；
步骤D发送返回原点的最佳路径指令；
所述步骤A中，所述标签信息包括由用字母‘S’、‘D’、‘L’或‘R’表示的包头和从000开始排列的数字共同组成的4个字节；
所述步骤B中，将所述RFID标签设于闭环路径中，按照所述标签信息的数字序号将测量的距离值记录于distance.txt文本文档中，启动工控机，将所述distance.txt文本文档的距离值读入到一维数组distance中；其中将L或R标签至D标签间的距离记为0；
所述步骤C中，向机器人发送返航指令后行驶至所述RFID标签，若有‘S’、‘L’或‘R’的有效标签，则读取签号i；若是信息包头为‘D’的无效标签，则执行后退运动直至有所述有效RFID标签感应；
所述步骤D中，接收指令的机器人根据当前的签号i，计算distance[0]～distance[i]的累加和Lb同剩余路径的累加和Lf，并将此两累加和比较，若Lb>Lf，则向机器人发出前进的指令，否则发送后退指令，直至运动到标签S000处。
2.如权利要求1所述的一键返航控制方法，其特征在于，将所述‘S’标签固定于各个停靠点，将‘L’或‘R’标签固定于各个转弯处，将‘D’标签固定于狭窄断头路区域的停靠点。
3.一种用于如权利要求1-2任一项所述巡检机器人的一键返航控制方法的***，包括工控机、运动控制器、前端磁感应传感器、后端磁感应传感器、RFID传感器；其特征在于，所述工控机分别与所述前端磁感应传感器、后端磁感应传感器、RFID传感器和运动控制器连接。
4. 如权利要求3所述的***，其特征在于，所述RFID传感器 设于机器人底盘几何中心处，所述RFID标签设于机器人完成任务的闭环路径中。
5.如权利要求3所述的***，其特征在于，所述前端磁感应传感器和后端磁感应传感器由16阵列磁感应点组成。
6.如权利要求4所述的***，其特征在于，所述RFID传感器采用实时检测模式。
CN201610868066.1A 2016-09-29 2016-09-29 一种巡检机器人的一键返航控制方法及*** Active CN106272434B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610868066.1A CN106272434B (zh) 2016-09-29 2016-09-29 一种巡检机器人的一键返航控制方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610868066.1A CN106272434B (zh) 2016-09-29 2016-09-29 一种巡检机器人的一键返航控制方法及***

Publications (2)

Publication Number Publication Date
CN106272434A CN106272434A (zh) 2017-01-04
CN106272434B true CN106272434B (zh) 2021-07-13

Family

ID=57716664

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610868066.1A Active CN106272434B (zh) 2016-09-29 2016-09-29 一种巡检机器人的一键返航控制方法及***

Country Status (1)

Country Link
CN (1) CN106272434B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107414837B (zh) * 2017-09-13 2020-09-25 上海伟世通汽车电子***有限公司 工业机器人非正常停机后安全自动回原位的方法及其***
CN109240290B (zh) * 2018-09-04 2021-09-03 南京理工大学 一种电力巡检机器人返航路径确定方法
CN111122779A (zh) * 2019-12-23 2020-05-08 北京海益同展信息科技有限公司 用于巡检设备检测气体的方法和装置、检测***
CN111629338B (zh) * 2020-05-25 2022-11-08 京东科技信息技术有限公司 定位方法、装置、机器人、信标、***、设备及介质
CN112008732B (zh) * 2020-09-09 2021-12-10 中科新松有限公司 机器人逆行方法、装置、终端和存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6049745A (en) * 1997-02-10 2000-04-11 Fmc Corporation Navigation system for automatic guided vehicle
CN202058039U (zh) * 2011-04-23 2011-11-30 山东电力研究院 变电站智能巡检机器人多传感器融合的组合定位***
CN102420392A (zh) * 2011-07-30 2012-04-18 山东鲁能智能技术有限公司 基于磁导航的变电站巡检机器人全局路径规划方法
CN104089616A (zh) * 2014-07-31 2014-10-08 四川阿泰因机器人智能装备有限公司 移动机器人定位***

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6049745A (en) * 1997-02-10 2000-04-11 Fmc Corporation Navigation system for automatic guided vehicle
CN202058039U (zh) * 2011-04-23 2011-11-30 山东电力研究院 变电站智能巡检机器人多传感器融合的组合定位***
CN102420392A (zh) * 2011-07-30 2012-04-18 山东鲁能智能技术有限公司 基于磁导航的变电站巡检机器人全局路径规划方法
CN104089616A (zh) * 2014-07-31 2014-10-08 四川阿泰因机器人智能装备有限公司 移动机器人定位***

Also Published As

Publication number Publication date
CN106272434A (zh) 2017-01-04

Similar Documents

Publication Publication Date Title
CN106272434B (zh) 一种巡检机器人的一键返航控制方法及***
CN106383519B (zh) 一种机器人自主定位充电***及方法
CN106680290B (zh) 狭窄空间的多功能检测车
CN108535279B (zh) 一种基于污水管线检测机器人的检测方法
CN108431713B (zh) 用于给移动机器人充电的对接***和方法
CN107516143A (zh) 一种基于Dijkstra算法的路径优选AGV搬运***
CN204347616U (zh) 一种基于rfid技术的自动导引运输车
CN104991560A (zh) 自主移动式智能机器人
CN214475072U (zh) 一种面向地下综合管廊的巡检***
CN112571415A (zh) 一种基于视觉导引的机器人自主开门方法与***
CN209833821U (zh) 智能物流小车
CN110977973A (zh) 架空输电线路巡检机器人自主越障装置
CN109993788B (zh) 一种轮胎吊的纠偏方法、装置及***
CN111476166A (zh) 一种地面巡检机器人自助充电对准方法
CN112476461A (zh) 一种搭载无人机的变电站巡检机器人及巡检方法
CN110244727A (zh) 一种基于二维码定位导航的agv***及其方法
CN208737303U (zh) 一种上位机集中控制的仓库机器人***
CN109591916A (zh) 一种自充电式激光导航防撞搬运车
CN108490960A (zh) 一种选矿摇床自动巡检装置和方法
CN207937872U (zh) 一种避障小车
CN210222567U (zh) 基于uwb技术的室内低速自动驾驶***
CN115284249A (zh) 一种基于超声波寻迹的智能巡检机器人及其定位导航方法
CN215548735U (zh) 一种搭载无人机的变电站巡检机器人
CN111352412A (zh) 一种智能轨道巡检机器人
CN107908190A (zh) 基于刚体变换的视觉导引方法及视觉导引车

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant