CN102922529B - 一种沿分裂导线的巡检作业机器人系统 - Google Patents

Abstract

本发明公开了一种沿分裂导线的巡检作业机器人系统，包括若干个结构相同的驱动臂、联板框架及控制箱，其中驱动臂包括驱动轮机构、升降关节及旋转关节；驱动轮机构包括驱动轮，所述驱动臂成左右对称分布，驱动臂通过驱动轮悬挂在分裂导线上，所述驱动轮机构下端通过旋转关节与升降关节连接，升降关节和控制箱固定在联板框架上。本发明结构简单紧凑，可在任意水平相邻的两条分裂导线上运行，跨越输电导线上各种障碍物，在直线段上运行时机器人的驱动臂可自由调整，自适应导线的间距变化。本发明减轻了主控制器的负担，同时分散了系统风险，有利于提高系统可靠性。同时各功能模块相对独立且完整，便于程序中的功能实现，控制方便。

Description

一种沿分裂导线的巡检作业机器人系统

技术领域

本发明涉及一种机器人系统，尤其是在分裂导线上进行检测、作业的沿分裂导线的巡检作业机器人系统。

背景技术

超高压输电线路是高压电网的重要组成部分，为保证其在运行过程中的安全性和稳定性，需要定期的开展巡检工作；由于输电线路分布点多，远离城镇，地形复杂，并且导线暴漏在野外，长期风吹雨淋，且受到持续的机械张力，电气闪烙，材料老化的影响，容易引起磨损，断股，腐蚀等损伤，若不及时修复更换，易引起严重的事故，造成大面积停电及经济财产损失。所以，必须对输电线路进行定期的巡视检查，随时掌握和了解输电线路的安全运行情况，以便及时发现和消除隐患，预防事故的发生。

长期以来，我国对输电线路的巡检主要依靠人工，或望远镜，或红外热成像仪，边走边看，一些特殊的巡检还需要电力工人攀上高压线路进行检查，费时费力，危险性极大，有些原始森林、山崖线路人工根本无法巡检。利用机器人带电巡检和维护超高压输电网络，不但可以减轻工人千里巡线和带电作业的劳动强度，而且可提高检测精度和检测效率，取代人直接工作在高危险的场合，同时大大减少人力资源，对提高电网自动化作业水平、保障电网安全运行具有重要意义。

中国专利ZL200410061316.8公开了一种沿架空高压输电线路行驶的机器人，包括一对沿输电线运动的小臂机械手机构，二个小臂机械手的下端分别联接在一个能改变二个小臂相对距离的大臂的传动机构上，各小臂分别具有4个自由度，小臂上方为末端执行机构，该末端执行机构具有一个挂在输电线上的驱动轮及其第一驱动机构、一个从动轮和一个可抓握输电线的夹紧机构。综合分析，此专利主要有如下缺点：该专利机器人只能沿着单股导线行走，只具备检测功能，由于机器人只能沿单股导线运行，再扩展线上作业功能（清除熟料布异物、拆卸防震锤、修补导线等）时，机器人本体重心容易发生偏移，导致机器姿态不稳，无法保证安全作业。 

中国专利ZL200410020490.8公开了一种超高压输电线巡检机器人机构，它由移动车体、后手臂、前手臂组成,其中:移动车体由本体和行走轮组成,行走轮通过水平转动副和移动副安装在本体上,并与线相抓持,本体通过转动副分别与前、后手臂相连,手臂末端为手爪;所述前手臂、后手臂结构相同,其中每一手臂由上臂、下臂两部分组成,上臂为连杆及滚珠丝杠与滑块组合结构,通过水平转动副与下臂相连接,下臂为大行程伸缩机构。综合分析，此专利主要有如下缺点：只能在单股导线上运行，跨越防震锤和绝缘子串等障碍物，但越障效率较低，其狭长的移动平台不利于集成多种检测和作业工具。

发明内容

本发明的目的是为克服上述现有技术的不足，提供一种沿分裂导线的巡检作业机器人系统，其结构简单紧凑，能够横跨在水平相邻的两根分裂导线上运行，可跨越输电导线上各种障碍物（防震锤、间隔棒、悬垂绝缘子串等），在直线段上运行时机器人的驱动臂可自由调整，自适应导线的间距变化。该机器人运行时横跨在两根分裂导线上，即使重心发生偏移也能保证机器人的安全平稳性，有利于在机器人上集成摄像机、红外热像仪等检测工具，并且可以扩展作业机械臂及专用工具进行清障、线路修补等工作。

为实现上述目的，本发明采用下述技术方案。

一种沿分裂导线的巡检作业机器人系统，包括若干个结构相同的驱动臂、联板框架及控制箱，其中驱动臂包括驱动轮机构、升降关节及旋转关节；驱动轮机构包括驱动轮，所述驱动臂成左右对称分布，驱动臂通过驱动轮悬挂在分裂导线上，所述驱动轮机构下端通过旋转关节与升降关节连接，升降关节和控制箱固定在联板框架上。

所述控制箱包含锂电池组和机器人控制系统，所述机器人控制系统包括数据接收板、运动控制板、云台控制板、错误检测板、视频录像机、电机驱动器、视觉检测摄像机；所述升降关节及旋转关节上均设有电机驱动器，所述视频录像机和视觉检测摄像机通过云台和云台驱动器与CAN总线连接，所述数据接收板、运动控制板、云台控制板、错误检测板、电机驱动器均与CAN总线连接，通过CANopen协议实现对各部分的协调控制，组成了基于CAN总线的分布式控制系统，该系统将所有控制功能分为数据传输、运动控制、检测控制、错误检测四个功能部分，分别实现机器人的数据传输、运动控制、检测控制和错误检测功能，各部分功能上相互独立，通过CAN总线连接在一起，又可以实现信息交互，实现整体统一。

所述驱动轮机构包括驱动电机、驱动轮、驱动轴、传动装置及固定板；所述固定板一端通过旋转关节与升降关节连接，另一端铰接驱动轴；所述驱动轴两端分别设有驱动轮及传动装置，并与固定板铰接；传动装置可以是齿轮传动或者同步带传动或者涡轮蜗杆传动等；驱动电机与传动装置连接固定。

所述升降关节包括底板、丝杠、丝杠螺母、直线导轨、滑块、直流电机、连接板、限位开关及轴承座；所述丝杠通过轴承座与底板相连，丝杠一端与直流电机相连，丝杠上设置有丝杠螺母，所述直线导轨固定在底板上，与丝杠平行，直线导轨上设置有可自由滑动的滑块，连接板将丝杠螺母和滑块固定在一起，连接板连接旋转关节；丝杠底部固定有限位开关，用于控制升降关节下端的极限位置。

所述旋转关节包括旋转轴承座、旋转轴、U型连接件、电磁离合器定子、离合器转子及旋转电机；所述旋转轴架设在旋转轴承座上，所述旋转轴承座与升降关节的连接板相连；旋转轴中间通过轴承与U型连接件铰接，U型连接件与驱动轮机构的固定板相连；电磁离合器定子固定在U型连接件上，离合器转子固定在旋转轴上；旋转轴一端与旋转电机相连。

所述驱动臂成前中后排列且左右对称分布，前臂和中臂及中臂和后臂的有效距离稍大于输电线上最大障碍物的长度。

本发明主要由左右对称分布的若干个驱动臂构成，每个驱动臂都可以为机器人提供驱动力，并且每个驱动臂都包括结构相同的驱动轮机构、升降关节及旋转关节；驱动轮机构都通过旋转关节与升降关节相连。

本发明的工作原理：

本发明可在任意水平相邻的两条分裂导线上运行，每个驱动臂都能为机器人提供驱动力，在机器人遇到防震锤时无需做越障动作即可压过；在无障碍的导线段上运行时，电磁离合器的定子和转子是分离的，驱动轮机构可通过与之相连的U型连接围绕旋转轴自由转动，这样机器人可有效适应由间隔棒、风舞等引起的导线间距变化。

在机器人接近间隔棒、悬垂绝缘子串时，首先前端的两个驱动臂开始同时进行越障动作，离合器上电使离合器的转子和定子闭合，保持住驱动轮机构的当前位置状态，然后升降关节的直流电机驱动丝杠转动，通过直线导轨和滑块带动驱动轮机构向上移动，驱动轮脱离导线后，升降关节停止动作；此时，旋转关节上的旋转电机通过旋转轴带动驱动轮机构向导线外侧摆动，从而使驱动轮摆开导线及障碍物。

在控制系统协调控制下机器人中间和后端两个驱动臂带动机器人前进，待前端两个驱动臂越过障碍物后机器人停止前进，前端两个升降关节开始下降，带动驱动轮做与之前相反的动作，使驱动轮重新骑在导线上后离合器掉电，使离合器的定子和转子分离，驱动轮机构又可围绕旋转轴自由转动，自适应导线间距变化。

之后，机器人中间及后端的驱动臂都以前端驱动臂相同的方式越过障碍物。

本发明的有益效果是，本发明由于采用若干个结构相同且左右对称的驱动臂，结构简单紧凑，可在任意水平相邻的两条分裂导线上运行，跨越输电导线上各种障碍物（防震锤、间隔棒、悬垂绝缘子串等），在直线段上运行时机器人的驱动臂可自由调整，自适应导线的间距变化。该机器人运行时横跨在两根分裂导线上，即使重心发生偏移也能保证机器人的运行姿态，安全平稳，有利于在机器人上集成检测工具，并且可以扩展作业机械臂及专用工具进行清障、线路修补等工作。

控制系统采用基于CAN总线的分布式控制结构，将所有控制功能分为数据传输、运动控制、检测控制、错误检测四个功能部分，这种结构与主从式结构相比，减轻了主控制器的负担，同时分散了系统风险，有利于提高系统可靠性。同时各功能模块相对独立且完整，如运动控制功能中包含了机器人越障控制相关的主控制器，关节驱动器，位置传感器等全部节点，便于程序中的功能实现，控制方便。

附图说明

图1为本发明的立体结构示意图。

图2为本发明驱动臂及驱动轮机构结构示意图。

图3为本发明升降关节结构示意图。

图4为本发明旋转关节结构示意图。

图5为本发明控制系统结构图。

图6为本发明控制程序流程图。

其中：1、驱动臂，2、联板框架，3、控制箱，4、传动装置，5、驱动电机，6、驱动轮，7、驱动轴，8、固定板，9、旋转关节，10、升降关节，11、轴承座, 12、丝杠，13、底板，14、丝杠螺母，15、连接板，16、限位开关，17、直流电机，18、直线导轨，19、滑块, 20、旋转轴承座，21、U型连接件，22、离合器转子，23、离合器定子，24、旋转电机，25、旋转轴，26、无线数据接收板，27、运动控制板，28、云台控制板，29、错误检测板，30、视频录像机，31、电机驱动器，32、视觉检测摄像机，33、云台，34、云台驱动器，35、CAN总线，36、离合器及离合驱动，37、无线视频传输装置。

具体实施方式

下面结合附图和实施例对本发明进一步说明。

本发明在任意水平相邻的两条分裂导线上运行，能够自适应导线间距的变化，如图1、2所示，包括结构相同的驱动臂1、联板框架2及控制箱3，其中每个驱动臂1都包括结构相同的驱动轮机构、升降关节10及旋转关节9；驱动臂1通过驱动轮6悬挂在分裂导线上。

如图2所示，驱动轮机构包括传动装置4、驱动电机5、驱动轮6、驱动轴7及固定板8；其中，驱动轴7两端分别设有驱动轮6及传动装置4，并铰接在固定板8上，传动装置4设置在固定板8上，驱动电机5设置在传动装置4外壳上；固定板8下端与旋转关节9相连。

如图3所示，升降关节10包括轴承座11、丝杠12、底板13、丝杠螺母14、连接板15、限位开关16、直流电机17、直线导轨18及滑块19；其中，丝杠12两端通过轴承座11固定在底板13上，丝杠12一端通过轴承座11与直流电机17相连；在丝杠12一侧平行设置有直线导轨18，直线导轨18上有可上下自由滑动的滑块19，滑块19与设置在丝杠12上的丝杠螺母14通过连接板15连接固定，在连接板15上固定有旋转关节9；丝杠12底部固定有限位开关16，用于控制升降关节10下端的极限位置。

如图4所示，旋转关节9包括旋转轴承座20、U型连接件21、电磁离合器转子22、离合器定子23、旋转电机24及旋转轴25，旋转轴25架设在旋转轴承座20上，所述旋转轴承座20与升降关节10的连接板15相连，旋转轴25中间通过轴承与U型连接件21铰接，U型连接件21与驱动轮机构的固定板8相连，电磁离合器定子22固定在U型连接件21上，离合器转子23固定在旋转轴25上；旋转轴25一端与旋转电机24相连。

控制系统结构图如图5所示，所述控制箱3包含锂电池组和机器人控制系统，所述机器人控制系统包括无线数据接收板26、运动控制板27、云台控制板28、错误检测板29、视频录像机30、电机驱动器31、视觉检测摄像机32；所述升降关节10及旋转关节9上均设有电机驱动器31，所述视频录像机30和视觉检测摄像机32通过云台33和云台驱动器34与CAN总线35连接，视频录像机30还与无线视频传输装置37连接，所述无线数据接收板26、运动控制板27、云台控制板28、错误检测板29、电机驱动器31均与CAN总线35连接，CAN总线35上还连有离合器及离合驱动36，通过CANopen协议实现对各部分的协调控制，组成了基于CAN总线35的分布式控制系统，该系统将所有控制功能分为数据传输、运动控制、检测控制、错误检测四个功能部分，分别实现机器人的数据传输、运动控制、检测控制和错误检测功能，各部分功能上相互独立，通过CAN总线连接在一起，又可以实现信息交互，实现整体统一。

其中数据传输功能由无线数据接收节点和地面遥控器实现，用于接收来自遥控器的控制指令，进行指令解析并发送给相应的控制模块，同时反馈机器人的状态信息，如电池剩余电量，机器人运动状态，警告与错误等，便于系统调试。运动控制功能包括运动控制节点、关节驱动节点和与运动控制相关的传感器节点，协调各关节实现机器人越障控制。其他控制功能包括云台控制、线路检测、视频控制等均列为检测控制功能，通过云台控制节点、云台驱动节点、视频控制节点等实现。错误检测功能由错误检测节点实现，它作为CAN网络主节点，监控CAN网络状态，接收错误消息，并进行相应处理，保证机器人运行安全。

控制程序结构如图6所示，各主控制器在上电自检时，查询功能组内其他节点状态，确保系统上电后所有节点连接正常，并将查询结果发送给错误检测板29。主控制器在完成组内自检与初始化任务后，进入各自的功能控制循环，在功能控制中一旦出现错误，可立即通过错误消息发送给错误检测板29，错误检测板29可通过状态指示灯和反馈错误信息给遥控器等方式提供调试信息。

由于每个直流无刷电机连线较多，走线复杂，并且信号易受干扰，在各CAN节点的安装布局上，各关节驱动节点及手爪驱动节点等均采用在相应关节电机附近安装的方式，避免了电机信号长距离传输。各驱动节点之间仅通过CAN总线35和电源线串联连接，连线简单，可靠性增加。电机驱动器31（或驱动电路板）均采用微型化设计，嵌入越障臂内，不影响机械布局。

上述虽然结合附图对本发明的具体实施方式进行了描述，但并非对本发明保护范围的限制，所属领域技术人员应该明白，在本发明的技术方案的基础上，本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。

Claims (3)

1.一种沿分裂导线的巡检作业机器人系统，其特征是，包括3对结构相同的驱动臂、联板框架及控制箱，其中驱动臂包括驱动轮机构、升降关节及旋转关节；驱动轮机构包括驱动轮，所述驱动臂成左右对称分布，驱动臂通过驱动轮悬挂在分裂导线上，所述驱动轮机构下端通过旋转关节与升降关节连接，升降关节和控制箱固定在联板框架上；所述控制箱包含锂电池组和机器人控制系统，所述机器人控制系统包括数据接收板、运动控制板、云台控制板、错误检测板、视频录像机、电机驱动器、视觉检测摄像机；所述升降关节及旋转关节上均设有电机驱动器，所述视频录像机和视觉检测摄像机通过云台和云台驱动器与CAN总线连接，所述数据接收板、运动控制板、云台控制板、错误检测板、电机驱动器均与CAN总线连接；

所述升降关节包括底板、丝杠、丝杠螺母、直线导轨、滑块、直流电机、连接板、限位开关及轴承座；所述丝杠通过轴承座与底板相连，丝杠一端与直流电机相连，丝杠上设置有丝杠螺母；所述直线导轨固定在底板上，与丝杠平行，直线导轨上设置有能自由滑动的滑块，连接板将丝杠螺母和滑块固定在一起；连接板连接旋转关节；丝杠底部固定有限位开关。

2.如权利要求1所述的沿分裂导线的巡检作业机器人系统，其特征是，所述驱动轮机构包括驱动电机、驱动轮、驱动轴、传动装置及固定板；所述固定板一端通过旋转关节与升降关节连接，另一端铰接驱动轴；所述驱动轴的一端设有驱动轮，驱动轴的另一端设有传动装置；驱动电机与传动装置连接固定。

3.如权利要求1所述的沿分裂导线的巡检作业机器人系统，其特征是，所述旋转关节包括旋转轴承座、旋转轴、U型连接件、电磁离合器定子、离合器转子及旋转电机；所述旋转轴架设在旋转轴承座上，所述旋转轴承座与升降关节的连接板相连；旋转轴中间通过轴承与U型连接件铰接，U型连接件与驱动轮机构的固定板相连；电磁离合器定子固定在U型连接件上，离合器转子固定在旋转轴上；旋转轴一端与旋转电机相连。