CN106239505B - 一种输电线路巡检机器人故障诊断与复位方法 - Google Patents

一种输电线路巡检机器人故障诊断与复位方法 Download PDF

Info

Publication number
CN106239505B
CN106239505B CN201610629678.5A CN201610629678A CN106239505B CN 106239505 B CN106239505 B CN 106239505B CN 201610629678 A CN201610629678 A CN 201610629678A CN 106239505 B CN106239505 B CN 106239505B
Authority
CN
China
Prior art keywords
transmission line
robot
line polling
polling robot
swing arm
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
CN201610629678.5A
Other languages
English (en)
Other versions
CN106239505A (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 Southern Power Grid Power Technology Co Ltd
Original Assignee
Electric Power Research Institute of Guangdong Power Grid Co Ltd
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 Electric Power Research Institute of Guangdong Power Grid Co Ltd filed Critical Electric Power Research Institute of Guangdong Power Grid Co Ltd
Priority to CN201610629678.5A priority Critical patent/CN106239505B/zh
Publication of CN106239505A publication Critical patent/CN106239505A/zh
Application granted granted Critical
Publication of CN106239505B publication Critical patent/CN106239505B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B25J5/02—Manipulators mounted on wheels or on carriages travelling along a guideway
    • 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/1628—Programme controls characterised by the control loop
    • B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02G—INSTALLATION OF ELECTRIC CABLES OR LINES, OR OF COMBINED OPTICAL AND ELECTRIC CABLES OR LINES
    • H02G1/00—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines
    • H02G1/02—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines for overhead lines or cables

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Small-Scale Networks (AREA)

Abstract

本发明公开了一种输电线路巡检机器人故障诊断与复位方法，包括如下步骤：当展臂机构运动、并检测到用以驱动所述展臂机构的驱动器的反馈计数不呈线性变化时，并且检测到所述展臂机构的展臂传感器无限位信号产生时，则控制输电线路巡检机器人停止运行；和/或，当所述输电线路巡检机器人运行时，机器人传感器的输出信号不变化，则通过驱动电流控制所述输电线路巡检机器人的运行状态；和/或，当所述输电线路巡检机器人向控制基站发送指令后，未收到反馈信息时，则重启路由器。上述输电线路巡检机器人故障诊断与复位方法，能够快速准确的进行自主故障诊断，进行故障修复工作，为线路巡检机器人正常运行提供保障。

Description

一种输电线路巡检机器人故障诊断与复位方法
技术领域
本发明涉及输电线路巡检机器人技术领域，特别涉及一种输电线路巡检机器人故障诊断与复位方法。
背景技术
随着我国经济建设的快速发展，市场对于具有故障诊断与复位功能的输电线路巡检机器人的需求日益增大。
众所周知，机器人的自主故障诊断与复位是机器人在无人监控状态下自主运行的保障。尤其对于输电线路巡检机器人来说，故障产生的原因往往是多方面的，而且较容易出现级联反应，如当某一类型的故障产生后，会导致其他类型故障的接连产生，如果不及时诊断和处理，将导致机器人无法继续运行，甚至影响机器人的安全运行。
发明内容
本发明的目的是提供一种输电线路巡检机器人故障诊断与复位方法，该方法可以解决故障诊断不及时、造成输电线路巡检机器人无法正常运行的问题。
为实现上述目的，本发明提供一种输电线路巡检机器人故障诊断与复位方法，包括如下步骤：
当展臂机构运动、并检测到用以驱动所述展臂机构的驱动器的反馈计数不呈线性变化时，并且检测到所述展臂机构的展臂传感器无限位信号产生时，则控制输电线路巡检机器人停止运行；
和/或，当所述输电线路巡检机器人运行时，机器人传感器的输出信号不变化，则通过驱动电流控制所述输电线路巡检机器人的运行状态；
和/或，当所述输电线路巡检机器人向控制基站发送指令后，未收到反馈信息时，则重启路由器。
相对于上述背景技术，本发明提供的输电线路巡检机器人故障诊断与复位方法，可以首先按照输电线路巡检器人自身能检测的故障分为机械故障、电气故障和软件故障；其中电气故障中又分为传感器故障、板卡故障、通信设备故障和驱动单元故障。然后根据不同的故障类别分别进行故障诊断与修复。机械故障主要指机械传动部件之间的约束导致机构不能运动，其故障诊断及复位方法为：当驱动单元驱动展臂机构运动时，检测到驱动器反馈计数变化不呈线性，且传感器限位信号没有产生，这是表明机器人展臂机构被锁死，当出现这种情况依靠电机难以拖动。机器人检测到该故障后，通知控制系统停止运行，并等待人工修复。传感器故障表现为当有信号产生时，输出信号不变化，如机构运动到限位位置时，限位传感器不产生信号。但这种故障往往可以采用替换的方案，各个机构的单位运动都有行程的限制，还有驱动电流的限制，可采用多重保护机制来抑制故障的影响。通信设备故障表现为通信交互失败，路由器是核心通信设备，机器人可通过与控制基站进行交互，主动发送交互指令，如果没有收到反馈信息，机器人将重启路由器，一般可自恢复故障。采用上述故障诊断与复位方法，能够快速准确的进行自主故障诊断，进行故障修复工作，为线路巡检机器人正常运行提供保障。
优选地，还包括如下步骤：
当所述输电线路巡检机器人与所述控制基站定时交互、并且所述输电线路巡检机器人未收到反馈指令时，则控制所述输电线路巡检机器人停止运行。
优选地，还包括如下步骤：
当所述输电线路巡检机器人的控制系统向所述驱动器发送指令后，所述驱动器未能进行反馈，则控制所述输电线路巡检机器人停止运行。
优选地，还包括如下步骤：
当所述输电线路巡检机器人的操作系统的应用层与系统层定时交互、且响应超时时，重新启动所述操作系统。
优选地，所述当所述输电线路巡检机器人的操作系统的应用层与系统层定时交互、且响应超时时，重新启动所述操作系统的步骤具体为：
所述应用层内初始化watchdog；
向所述应用层内定时发送握手消息，并向所述系统层内发送监听消息；
判断是否在预设时间内收到所述监听消息；
如果没有在所述预设时间内收到所述监听消息，则向所述应用层发送监听故障信号，并重新启动所述操作系统。
优选地，所述判断是否在预设时间内收到所述监听消息的步骤还包括：
如果在所述预设时间内收到所述监听消息，则计数器清零。
优选地，所述操作系统具体为WinCE6.0。
附图说明
图1为本发明实施例所提供的输电线路巡检机器人的展臂机构运动至第一极限位置的示意图；
图2为图1中1展臂机构运动至第二极限位置的示意图；
图3为本发明实施例所提供的输电线路巡检机器人在诊断机械故障时的流程图；
图4为本发明实施例所提供的输电线路巡检机器人针对软件故障的诊断与恢复的流程图。
具体实施方式
本发明的核心是提供一种输电线路巡检机器人故障诊断与复位方法，该方法能够快速准确的进行自主故障诊断，进行故障修复工作，为线路巡检机器人正常运行提供保障。
为了使本技术领域的技术人员更好地理解本发明方案，下面结合附图和具体实施方式对本发明作进一步的详细说明。
请参考图1至图4，图1为本发明实施例所提供的输电线路巡检机器人的展臂机构运动至第一极限位置的示意图；图2为图1中1展臂机构运动至第二极限位置的示意图；图3为本发明实施例所提供的输电线路巡检机器人在诊断机械故障时的流程图；图4为本发明实施例所提供的输电线路巡检机器人针对软件故障的诊断与恢复的流程图。
本发明提供的输电线路巡检机器人故障诊断与复位方法，包括如下步骤：
当展臂机构运动、并检测到用以驱动所述展臂机构的驱动器的反馈计数不呈线性变化时，并且检测到所述展臂机构的展臂传感器无限位信号产生时，则控制输电线路巡检机器人停止运行；
和/或，当所述输电线路巡检机器人运行时，机器人传感器的输出信号不变化，则通过驱动电流控制所述输电线路巡检机器人的运行状态；
和/或，当所述输电线路巡检机器人向控制基站发送指令后，未收到反馈信息时，则重启路由器。
输电线路巡检器人自身能检测的故障分为机械故障、电气故障和软件故障，电气故障中又分为传感器故障、板卡故障、通信设备故障和驱动单元故障。
按故障处理方法不同，机器人故障又可分为可自恢复故障、可替换故障和需修复故障。可自恢复故障主要指机器人能自动诊断出故障，并自动恢复以排除故障，它可诊断出软件故障，通信设备故障。可替换故障是指机器人检测出该故障后，可以采用替换的方案来避免故障产生的影响，如传感器故障，传感器主要用于限位控制，它可通过计数控制而替换。需修复故障指故障发生后，机器人无法继续运行，如机械故障产生后往往限制了机器人关节动作执行，机器人一般无法自动修复，需要进行人工修复；需修复故障还包括板卡故障、驱动单元故障等。
机械故障主要指机械传动部件之间的约束导致机构不能运动，其故障诊断及复位方法为：当驱动单元驱动展臂机构运动时，检测到驱动器反馈计数变化不呈线性，且传感器限位信号没有产生，这是表明机器人展臂机构被锁死，当出现这种情况依靠电机难以拖动。机器人检测到该故障后，通知控制系统停止运行，并等待人工修复。这种现象往往发生在过杆塔障碍物的过程中，但对线路和机器人不会产生安全影响。它产生的原因主要是机构运动过程中出现电气故障或软件故障。如说明书附图1和2所示，第一展臂1与第二展臂2分别朝向两个极限位置运动时，若检测到驱动器反馈计数变化不呈线性，且传感器限位信号没有产生，即表明展臂机构被锁死，等待人工修复。图3示出了在诊断机械故障时的流程图。S1开始，S2发送运动指令给驱动单元，S3检测驱动单元返回，S31用于判断计数是否线性增加，S32同时判断传感器是否有信号，若均为否，则S4确定产生故障信号，S5结束。
传感器故障表现为当有信号产生时，输出信号不变化，如机构运动到限位位置时，限位传感器不产生信号。但这种故障往往可以采用替换的方案，各个机构的单位运动都有行程的限制，还有驱动电流的限制，可采用多重保护机制来抑制故障的影响。
处理板卡故障会使系统崩溃，该故障检测方法采用与基站定时交互，如果控制基站在规定的时间内没有信息反馈，可诊断出该故障，但不能自恢复。该故障产生后导致机器人无法控制，但此时机器人也会处于停滞状态，不会继续动作，等待救援。其他板卡可以通过数据监测来进行诊断，如串口通信失败、IO读取错误等方法来诊断，这些故障也属于需修复故障，故障产生后，机器人不能继续工作，需人工修复。
通信设备故障表现为通信交互失败，路由器是核心通信设备，机器人可通过与控制基站进行交互，主动发送交互指令，如果没有收到反馈信息，机器人将重启路由器，一般可自恢复故障。
驱动单元主要包括驱动器、编码器和电机，故障检测方法主要是通过读取驱动器状态信息，如果控制系统给驱动器发送指令，反馈失败可诊断出该单元出现故障，该故障的出现会导致机器人关节无法运动，导致规划动作无法完成，机器人将停止运行，通知控制中心，等待救援。
软件故障主要指应用程序的故障，机器人操作系统采用的是嵌入式WinCE6.0，操作系统采用的最小化功能定制，运行稳定。软件故障往往出现应用程序上，原因也有多种，如内存操作失败、文件读写失败、硬件地址操作失败、CPU温度过高、线路短路等等，当软件故障产生后，系统将响应变慢，无法响应控制指令，严重时系统出现崩溃。软件故障的检测主要采用Watchdog的功能，通过应用程序激活和设置Watchdog，它的实现原理是应用层和系统层定时进行交互，若响应超时，则认为软件产生故障。软件故障一般是一种可自恢复故障，只需将操作系统重新启动即可实现自恢复，当Watchdog检测到软件故障，立即重启操作系统，以便恢复系统。
说明书附图4为输电线路巡检机器人针对软件故障的诊断与恢复的流程图。步骤S10开始，并在应用层内进行S20初始化Watchdog，向应用层内定时发送握手消息S30，并向系统层内发送监听消息S50，判断是否在预设时间内收到监听消息S60；如果没有在所述预设时间内收到所述监听消息，发送故障信息S80，并将故障信息与应用层的监听故障信号S40连通，并重新启动所述操作系统S90，若在所述预设时间内收到所述监听消息，则计数器清零息S70。
需要说明的是，在本说明书中，诸如第一和第二之类的关系术语仅仅用来将一个实体与另外几个实体区分开来，而不一定要求或者暗示这些实体之间存在任何这种实际的关系或者顺序。
以上对本发明所提供的输电线路巡检机器人故障诊断与复位方法进行了详细介绍。本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以对本发明进行若干改进和修饰，这些改进和修饰也落入本发明权利要求的保护范围内。

Claims (5)

1.一种输电线路巡检机器人故障诊断与复位方法，其特征在于，包括如下步骤：
当展臂机构运动，检测到用以驱动所述展臂机构的驱动器的反馈计数不呈线性变化、且检测到所述展臂机构的展臂传感器无限位信号产生时，则控制输电线路巡检机器人停止运行；
和/或，当所述输电线路巡检机器人运行时，机器人传感器的输出信号不变化，则通过驱动电流控制所述输电线路巡检机器人的运行状态；
和/或，当所述输电线路巡检机器人向控制基站发送指令后，未收到反馈信息时，则重启路由器；
还包括如下步骤：
当所述输电线路巡检机器人的操作系统的应用层与系统层定时交互、且响应超时时，重新启动所述操作系统；
其中，所述当所述输电线路巡检机器人的操作系统的应用层与系统层定时交互、且响应超时时，重新启动所述操作系统的步骤具体为：
所述应用层内初始化watchdog；
向所述应用层内定时发送握手消息，并向所述系统层内发送监听消息；
判断是否在预设时间内收到所述监听消息；
如果没有在所述预设时间内收到所述监听消息，则向所述应用层发送监听故障信号，并重新启动所述操作系统。
2.根据权利要求1所述的方法，其特征在于，还包括如下步骤：
当所述输电线路巡检机器人与所述控制基站定时交互、并且所述输电线路巡检机器人未收到反馈指令时，则控制所述输电线路巡检机器人停止运行。
3.根据权利要求1所述的方法，其特征在于，还包括如下步骤：
当所述输电线路巡检机器人的控制系统向所述驱动器发送指令后，所述驱动器未能进行反馈，则控制所述输电线路巡检机器人停止运行。
4.根据权利要求1所述的方法，其特征在于，所述判断是否在预设时间内收到所述监听消息的步骤还包括：
如果在所述预设时间内收到所述监听消息，则计数器清零。
5.根据权利要求4所述的方法，其特征在于，所述操作系统具体为WinCE6.0。
CN201610629678.5A 2016-08-01 2016-08-01 一种输电线路巡检机器人故障诊断与复位方法 Active CN106239505B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610629678.5A CN106239505B (zh) 2016-08-01 2016-08-01 一种输电线路巡检机器人故障诊断与复位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610629678.5A CN106239505B (zh) 2016-08-01 2016-08-01 一种输电线路巡检机器人故障诊断与复位方法

Publications (2)

Publication Number Publication Date
CN106239505A CN106239505A (zh) 2016-12-21
CN106239505B true CN106239505B (zh) 2018-12-04

Family

ID=57606436

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610629678.5A Active CN106239505B (zh) 2016-08-01 2016-08-01 一种输电线路巡检机器人故障诊断与复位方法

Country Status (1)

Country Link
CN (1) CN106239505B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111026097B (zh) * 2019-12-30 2023-01-31 深圳供电局有限公司 一种巡检机器人的故障自诊断及预警方法
CN111426493A (zh) * 2020-03-25 2020-07-17 上海荣泰健康科技股份有限公司 按摩椅故障检测方法、系统、终端以及介质
CN112230623B (zh) * 2020-10-15 2022-09-06 京东科技信息技术有限公司 故障监控方法和装置、机器人功能装置和巡检机器人
US11858122B2 (en) * 2021-07-07 2024-01-02 MFE Enterprises, Inc. Ground based robot with an OGI camera with computer vision to automate the inspection
CN117086864B (zh) * 2023-08-02 2024-02-27 上海迪成智能科技有限公司 用于单轨吊运行的巡检机器人安全故障精准定位方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4472592B2 (ja) * 2004-08-30 2010-06-02 本田技研工業株式会社 運動体の制御方法、制御システム、制御プログラム
US9104650B2 (en) * 2005-07-11 2015-08-11 Brooks Automation, Inc. Intelligent condition monitoring and fault diagnostic system for preventative maintenance
JP2008290228A (ja) * 2007-04-24 2008-12-04 Fanuc Ltd 嵌合装置
CN101770221B (zh) * 2008-12-30 2012-01-04 中国科学院自动化研究所 基于现场总线的双臂巡线机器人控制系统
CN101745916B (zh) * 2009-12-16 2011-06-01 电子科技大学 带容错和纠错功能的并联机器人装置及其容错和纠错方法
JP5685842B2 (ja) * 2010-07-12 2015-03-18 セイコーエプソン株式会社 ロボット装置およびロボット装置の制御方法
CN102393656A (zh) * 2011-11-29 2012-03-28 北京邮电大学 一种基于fpga的模块化机器人嵌入式多核主控制器
CN102761460A (zh) * 2012-06-30 2012-10-31 上海工商信息学校 一种路由器的检测装置
CN104796937A (zh) * 2015-05-11 2015-07-22 重庆大学 一种基于移动机器人的无线传感器网络节点故障巡检方法

Also Published As

Publication number Publication date
CN106239505A (zh) 2016-12-21

Similar Documents

Publication Publication Date Title
CN106239505B (zh) 一种输电线路巡检机器人故障诊断与复位方法
CN103840432B (zh) 一种电机堵转检测方法和系统
CN103955188B (zh) 支持冗余切换功能的控制系统及方法
US7555680B2 (en) Distributed control apparatus
JP3234530B2 (ja) ドア用センサの自己診断装置
CN107614212B (zh) 工业机器人及其故障判断方法
CN106462485B (zh) 马达控制装置
CN103507082A (zh) 制动器异常诊断方法及制动器异常诊断装置
CN102619684B (zh) 故障诊断方法及系统
KR20210001001U (ko) 협동 로봇 모니터링 시스템
CN105843202A (zh) 工业机器人控制系统及其运行模式的切换方法
CN106559288B (zh) 一种基于icmp报文的快速故障检测方法
CN105972767B (zh) 空调器故障诊断方法及装置
CN105426263B (zh) 一种实现金库系统安全运行的方法及系统
KR20210084094A (ko) 무선 진동 센서의 배터리 상태 감시 시스템 및 방법
CN212825427U (zh) 一种应用于机器人控制系统的安全控制硬件平台
JP2000250625A (ja) 故障診断装置
US20140372809A1 (en) Graphic self-diagnostic system and method
CN110737256B (zh) 一种用于控制变频传动系统的方法及装置
CN114734438A (zh) 一种机器人关节的故障诊断方法及系统
CN110418027B (zh) 扫描装置跌落保护的控制方法及扫描装置
CN112631253B (zh) 快速检查agv驱动机构异常情况的方法
CN218825294U (zh) 一种同步控制装置
CN115431300B (zh) 机器人故障检测方法和机器人
TWI758926B (zh) 機器人安全監控系統及其診斷異常的方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20200116

Address after: 510000 room 501-503, annex building, Huaye building, No.1-3, Chumo new street, Xihua Road, Yuexiu District, Guangzhou City, Guangdong Province

Patentee after: Guangdong Electric Power Research Institute of energy technology limited liability company

Address before: 510080 Dongfeng East Road, Dongfeng, Guangdong, Guangzhou, Zhejiang Province, No. 8

Patentee before: ELECTRIC POWER RESEARCH INSTITUTE, GUANGDONG POWER GRID CO., LTD.

CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: Room 501-503, annex building, Huaye building, No.1-3 Chuimao new street, Xihua Road, Yuexiu District, Guangzhou City, Guangdong Province 510000

Patentee after: China Southern Power Grid Power Technology Co.,Ltd.

Address before: Room 501-503, annex building, Huaye building, No.1-3 Chuimao new street, Xihua Road, Yuexiu District, Guangzhou City, Guangdong Province 510000

Patentee before: GUANGDONG ELECTRIC POWER SCIENCE RESEARCH INSTITUTE ENERGY TECHNOLOGY Co.,Ltd.