可全程越障架空输电线巡线机器人设计

刘国平， 孙茂文， 缪　航， 秦科技， 俞振东

(南昌大学 机电工程学院， 江西 南昌 330031)



可全程越障架空输电线巡线机器人设计

刘国平， 孙茂文， 缪航， 秦科技， 俞振东

(南昌大学 机电工程学院， 江西 南昌 330031)

针对现有巡线机器人无法完全跨越所有地线障碍物的现状，提出一种新的巡线机器人越障方案.巡线机器人由单臂机构提供行走驱动力，双臂机构完成越障任务.该方案具有跨越所有障碍，且越障时动作简单，所需驱动力少的特点.通过理论分析及软件仿真的方法对巡线机器人越障关键环节进行分析，得到机器人越障过程的运动特性.在此基础上，制作出试验样机，并在模拟线路上进行越障实验，结果表明：该设计方案能完成预定的越障功能.证明了这种新的越障方案的有效性及可行性.

巡线机器人； 全程越障； 越障实验

为了保证输电线路安全、稳定地运行，需要对输电线路进行定期的巡检.而对巡线机器人的研制成为一大热点，国内外有不少研究机构对此进行了大量研究.

2001年，泰国的Peungsungwal等[1]设计了一台自给电巡线机器人，该试验型巡线机器人能在塔间的电力线上爬行，无避障能力.加拿大研制开发了Line Scout电力线带电维护机器人[2-3]，机器人整体为四臂式结构，能跨越直线线路障碍，重达100 kg.武汉大学吴功平教授研发团队针对220 kV高压输电线[4-5]，研制了一种两臂巡线机器人，在对线路进行改造的基础上，其能够跨越直线线路障碍和转角塔障碍.中国科学院沈阳自动化研究所开展了“沿500 kV地线巡检机器人”的研制，采用两臂越障的方式[6]，在越障过程中需要机构对巡线机器人进行质心调整[7].从现有的研究情况可以看出，由于实际输电线路环境复杂，跨越障碍是巡线机器人研发的一大难点.很多设计方案不具备越障功能或者需要对线路进行专门改造才能完成越障任务.同时，复杂的机构和过重的质量将给机器人的控制带来很大的麻烦.

为了解决巡线机器人越障问题，本文提出一种单臂驱动、双臂越障的设计.这种全新的设计具有更强的越障能力，能够跨越地线上所有障碍.同时在越障过程中，机器人自由度少[8-9]，无关节耦合动作[10-11]，降低了控制难度.并对新方案进行具体设计，通过理论分析和仿真实验对越障臂关键机构参数进行分析，最终制作出试验样机，通过实验的方法对越障臂设计的合理性进行验证.

1　越障臂机械结构

现有巡线机器人机构多为两臂结构[12-14]、三臂结构[15-17].本文提出一种全新的巡线机器人设计方式：在直线行走时以三臂触线，由驱动轮提供动力；跨越障碍时驱动轮脱离地线，双臂机构进行越障.

1.1越障臂结构特征

巡线机器人整体结构如图1(a)所示，整个巡线机器人包括：越障前臂、驱动轮、越障后臂，整体自由度为5.越障前臂由左右两个部分组成，两部分机械结构对称并相同，在实际的功能执行过程中也是同步运行，所以运动过程以单边进行分析.巡线机器人机构简图如图1(b)所示，文中分别以圆柱体和长方体表示旋转副和移动副.其中用qFi表示前臂各关节(qF3为无动力旋转关节)，qBi表示后臂各关节，中间驱动轮的伸关节用qM表示，li表示各关节之间的距离.根据巡线机器人的功能要求，对其各关节运动范围进行设置,如表1所示.

图1　巡线机器人Fig.1　Inspection robot

关节名称运动范围qF1,qB1-85°～85°qF20～500mmqF3-180°～180°qB25°～85°,-5°～-85°qB30～500mmqM0～65mm

1.2巡线机器人的越障原理

巡线机器人的越障种类主要分为直线塔障碍如防震锤、直线垂悬线夹和转角塔障碍如耐张线夹、跳线.针对障碍物的特点，巡线机器人具有2种越障模式.

1.2.1直线塔障碍的跨越

当巡线机器人需要跨越防震锤、直线悬垂线夹时，巡线机器人将以图2方式进行跨越.当巡线机器人直线行走(图2(a))，遇到障碍物时驱动轮停止，与地线分离，前、后臂夹具锁紧(图2(b)).前臂关节qF1释放，后臂关节qB3伸长，使驱动轮与前臂在同一垂直平面内(图2(c)).之后后臂夹具脱离地线，后臂关节qB1旋转跨过障碍，此过程中为了防止夹具对地线造成损伤，地线夹具设计为多爪结构，并在每个钩爪表面嵌入橡胶材料，该设计在增大摩擦力的同时，保护地线不受损伤(图2(d)).后臂上线之后(图2(e))，前、后臂关节qF2，qB3调整长度使驱动轮与后臂在同一垂直平面内(图2(f))，之后前臂关节qF1开始越障(图2(g))，最后完成整体越障(图2(h)).

图2　直线塔障碍的跨越步骤Fig.2　Steps of surmounting straight tower obstacles

1.2.2转角塔障碍的跨越

巡线机器人跨越转角塔障碍的过程如图3所示.当巡线机器人遇到转角塔障碍时，停止运动(图3(a)).前臂夹具脱离地线，后臂关节qB1调整使驱动轮与后臂在同一垂直平面内(图3(b)).此时通过后臂关节qB2旋转使前臂达到跳线位置，为防止对地线造成损伤，采用了与上一节相同的方法进行处理(图3(c))，完成前臂上跳线的任务.之后，调整两臂姿态使驱动轮与前臂在同一垂直平面(图3(d)).巡线机器人在跳线上完成一次跨越动作之后(图3(e)原理与图2跨越原理相似，不再重复叙述)，后臂关节qB2再次旋转，使前臂与地线接触(图3(f)).待前臂上线之后，后臂继续跨越脱离跳线(图3(g)).最后，后臂再次接触地线，调整前后臂角度与长度使驱动轮再次上线行走，完成转角塔障碍跨越的任务(图3(h)).

图3　转角塔障碍的跨越步骤Fig.3　Steps of surmounting angle tower obstacles

巡线机器人的2种越障模式有以下特点：1)直线塔障碍的跨越，主要由前后臂完成，由于末端旋转关节如qF3为无动力关节，跨越障碍的每个动作需要1至2个关节完成；2)在跨越转角塔障碍时通过后臂旋转关节qB2的配合使巡线机器人转向，完成跳线跨越的动作，其他动作与直线塔障碍的跨越相同；3)巡线机器人的越障主要是通过前后两臂交替跨越来完成，且关节之间没有运动耦合的要求.

2　越障过程运动学分析

通过分析巡线机器人在越障时的各种模式可以总结出巡线机器人越障臂的2个关键功能：1)驱动轮与地线脱离和重新上线；2)前后臂的配合过障.本章将针对以上功能进行运动学分析.

2.1驱动轮的地线脱离与重新上线

驱动轮脱离地线时，需要提升一段距离dδ.此过程通过两臂共同收缩一段距离lδ来使驱动轮提升.如图4所示，虚线部分为驱动轮提升后的状态.此过程提升距离dδ与两臂之间的运动关系为

(1)

式中：lF2=lF0+lδ;θδ=θF0-θF1；lF1为伸长后前臂长度，lδ为推杆电机的变化量.驱动轮与地线的重新上线与脱离过程相反，分析方法相同，篇幅所限不再赘述.

图4　巡线机器人直线行走的姿态变化Fig.4　The posture change during straight line moving of inspection robot

当机器人完成越障，再次行走在地线上的过程中，需要尽快调整两臂关节qF1，qB1间的转角θF0，θB0，使机器人前后两臂上线.图4实线所示为巡线机器人直线行走时的姿态示意图.两臂长度与各角度之间应满足:

(2)

(3)

为了简化控制，设定前、后两臂长度相等，在调整过程中仅对旋转目标角度θF0，θB0进行控制；θM为机器人中心线与地面的夹角，由姿态传感器返回；实际设计与实物制作中保证前、后臂初始长度lF，lB大于lM.此角度关系亦是巡线机器人在直线行走中需满足的条件.

2.2障碍物的跨越

2.2.1直线塔避障

从巡线机器人直线塔越障原理的过程分析可以看出，跨越障碍的关键动作是图2(d)与图2(f)所示动作.在这2个动作执行的过程中都只有1个臂的1至2个关节依次运动，巡线机器人的其他部分都与地线固联视为一个整体.前臂越障过程有3个关节运动，以此为例进行分析.

根据1.1节的越障前臂结构特征建立机械臂部分的正运动学矩阵A1[18]：

(4)

式中，sij为sin(qFi+qFj)的简写,cij为cos(qFi+qFj)的简写.由臂的正运动学方程可以看出，臂末端的方向与关节变量qF1,qF3有关，而末端位置与关节变量qF1,qF2有关且z轴位置坐标固定不变，即前臂的运动范围为一平面.设机械臂末端的预期位置为

(5)

则根据运动学逆解方法可以得到期望位置与各关节变量之间的关系[18]：

(6)

2.2.2转角塔避障

在跨越转角塔障碍的过程中，最为关键和复杂的动作是图3(c)所示的动作，需要前后臂的配合才能完成.所以对参与越障的各关节进行正运动学建模得到正运动学矩阵A2：

(7)

同样设运动过程的期望位置为

(8)

得到目标位置与各关节之间的关系：

(9)

运动学分析得出巡线机器人在越障过程的各关节与目标位置的运动学关系.通过对运动学表达式的分析能够对机器人的运动特性进行预判，同时也将为越障过程的仿真及实际操作控制提供理论依据.

3　越障臂运动仿真

3.1越障臂运动范围仿真

根据臂机构参数对越障臂跨越直线障碍运动范围进行仿真，结果如图5和图6所示.

图5　前臂运动范围Fig.5　Motion range of fore arm

图6　后臂运动范围Fig.6　Motion range of rear arm

图5中圆圈为前臂夹具可达到的位置.可以看出臂的运动范围是一个半径为849～1 449 mm、圆心角为180°的平面扇形区域，这与上一节运动学的分析一致.在此平面方向防震锤的尺寸为300 mm×40 mm，悬垂线夹为200 mm×82 mm，能够完全被臂的运动范围所包络，满足越障的要求.

从图6可以看出，当越障臂进行跳线寻找和跨越时，越障臂能够触及的范围是由后臂为旋转轴，旋转角度为180°，扫描平面圆心角为-90°～90°，半径为849～1 449 mm的平面扇形区域组成的立体空间.在实际线路中跳线与地线的夹角一般在0°～90°之间，弧垂最低点至底线距离一般在50～200 mm之间.可见越障臂的运动空间能够将跳线的位置区域完整包络进去，满足越障基本条件.

3.2障碍跨越运动仿真

以跨越防震锤为例，根据防震锤尺寸，要求手臂末端能够跨越极限位置，设定各关节初始位置为Do=[-430.8590]T，目标位置为Dt=[471.3520]T，运动时间为10 s，初始速度和结束速度为0.经运动仿真[19-20]得到如图7所示的运动仿真结果.

从仿真结果可以看出，臂模拟运行的位移曲线平滑，速度曲线连续说明在此工作过程中机械手臂的运行比较平稳，能够跨越障碍物极限位置到达目标点，整个结构不会产生较大振动.仿真结果为巡线机器人实际控制规划提供了必要的依据.

4　实验分析

4.1实验场地

图8(a)为巡线机器人试验样机，具体参数如下：主要材料为铝合金，质量为40 kg，最大运行速度为0.55 m/s.同时为了验证巡线机器人臂越障原理的正确性及越障臂机构设计的合理性，在室外环境下搭建一条模拟线路，如图8(b)所示，并在模拟线路上进行了相关障碍的跨越实验.

图7　越障臂运动仿真Fig.7　Motion simulation of manipulator

图8　巡线机器人样机与模拟实验场地Fig.8　Prototype of inspection robot and simulation site

4.2越障实验

按照1.2节介绍的巡线机器人跨障原理，在模拟线路上对巡线机器人进行实验，得出巡线机器人在跨越直线塔和转角塔障碍时各关节的运动情况，并以运动曲线形式进行分析(见图9和图10).

图9　巡线机器人直线塔越障实验数据Fig.9　Experimental datas of robot surmounting straight tower obstacles

图10　巡线机器人转角塔越障实验数据Fig.10　Experimental datas of robot surmounting angle tower obstacles

4.2.1直线塔越障实验

图9(a)为巡线机器人在直线塔越障过程中关节qF1角度的实时变化值， 图9(b)为关节qF2伸缩量的实时变化值.从实验现场采集回来的数据可以看出：越障时前臂从机器人右侧摆动至左侧，前臂摆角从57°变化到139.5°；为了跨越障碍，推杆电机在原有长度上伸长了200 mm；这2个关节运动过程平滑.

4.2.2转角塔越障实验

图10(a)为巡线机器人在转角塔越障过程中关节qB2角度的实时变化值， 图10(b)为关节qF1摆角变化值， 图10(c)为关节qF2伸缩量的实时变化值.为了前臂能够抓住跳线，后臂关节qB2首先转动25°使机器人旋转至合适的位置；之后前臂摆角从90.2°变化到141°；在确定跳线位置后，前臂推杆电机伸长使夹具抓住跳线.

从实验数据结果来看，跨越障碍的核心动作由2个或者3个关节依次运动完成，各关节运动平稳，没有出现剧烈抖动情况，符合预期规划.实验证明越障原理正确，新型臂机械设计结构合理，能完成既定任务.

5　总　结

1)根据国内外巡线机器人的研究状况得出，实现巡线机器人完全越障是当前工作的重点和难点.

2)提出一种“单臂驱动、双臂越障”的巡线机器人设计方案，并根据此思路设计出一款全新的巡线机器人.

3)对新方案进行具体设计，实现对地线上所有障碍的跨越.同时在越障时具有动作简单、控制难度小等特点.

4)对巡线机器人的驱动轮上下线和越障关键动作都采用了理论分析和仿真实验进行分析，得出跨越各种障碍的可能性和模拟出越障过程中各关节的运动特性.

5)实验结果表明：巡线机器人的越障臂能够灵活控制，完成越障任务.研究结果为巡线机器人在更为复杂的实际线路运行时提供良好的参考.

[1] PEUNGSUNGWAL S， PUNGSIRI B， CHAMNONGTHAI K， et al. Autonomous robot for a power transmission line Inspection[C]//The 2001 IEEE International Symposium on Circuits and Systems. Sydney， NSW Australia, 2001: 121-124．

[2] TOTH J， POULIOT N， MONTAMBAULT S. Field experiences using LinesCout technology on large BC transmission crossings[C]//2010 1st International Conference on Applied Robotics for the Power Industry. CARPI, 2010．

[3] POULIOT N， LATULIPPE P， MONTAMBAULT S. Reliable and intuitive teleoperation of LineScout: a mobile robot for live transmission line maintenance[C]//2009 IEEE/RSJ International Conference on Intelligent Robots and Systems， IROS, 2009: 1703-1710．

[4] 何缘，吴功平，王伟，等. 改进的穿越越障巡检机器人设计及越障动作规划[J]. 四川大学学报(工程科学版)，2015，47(6): 157-164.

HE Yuan， WU Gong-ping， WANG Wei， et al. Advanced design and motion plan of an improved inspection robot running across obstacles[J]. Journal of Sichuan University (Engineer Science Edition)，2015，47(6): 157-164．

[5] 吴功平，曹珩，皮渊，等.高压多分裂输电线路自主巡检机器人及其应用[J]. 武汉大学学报(工学版)，2012，45(1): 96-102．

WU Gong-ping， CAO Heng， PI Yuan， et al. An autonomous inspection robot for high voltage bundled transmission line and its application[J].Engineering Journal of Wuhan University， 2012，45(1): 96-102．

[6] WANG H， ZHANG F， JIANG Y， et al. Development of an inspection robot for 500 kV EHV power transmission lines[C]. IEEE/RSJ 2010 International Conference on Intelligent Robots and Systems， IROS 2010-Conference Proceedings， 5107-5112．

[7] 李贞辉，王洪光，王越超，等.输电线巡检机器人自主抓线的控制[J]. 吉林大学学报(工学版)，2015，45(5): 1519-1526．

LI Zhen-hui， WANG Hong-guang， WANG Yue-chao， et al. Line-grasping control for a power transmission line inspection robot[J]. Journal of Jilin University (Engineering and Technology Edition)， 2015，45(5): 1519-1526．

[8] 宋伟，江鹏，郑彦宁，等.基于模块化关节高压巡线机器人方案改进[J]. 仪器仪表学报，2014，35(S2): 42-49．

SONG Wei， JIANG Peng， ZHENG Yan-ning， et al. Improvement of modular joint for power transmission lines inspection robot[J]. Chinese Journal of Scientific Instrument， 2014， 35(S2): 42-49．

[9] 叶长龙，高露，余雪，等. 三臂结构高压线巡检机器人设计与运动学仿真效果研究[J]. 沈阳农业大学学报，2015，46(1): 79-84.

YE Chang-long， GAO Lu，YU Xue， et al. Mechanical design of high voltage line inspection robot with three arms and its simulation performance[J]. Journal of Shenyang Agricultural University， 2015， 46(1): 79-84．

[10] 魏永乐，房立金，陶广宏.新型双臂巡线机器人越障过程受力分析[J]. 机械科学与技术，2014，33(8): 1117-1121．

WEI Yong-le，FANG Li-jin，TAO Guang-hong. The mechanical analysis on the crossing obstacle process of new-type dual-arms inspection robot[J]. Mechanical Science and Technology for Aerospace Engineering， 2014，33(8): 1117-1121．

[11] 朱兴龙，王洪光，房立金，等. 自主越障巡检机器人质心调节控制[J].机器人，2006，28(4): 385-388．

ZHU Xing-long， WANG Hong-guang， FANG Li-jin， et al. Centroid adjustment control on autonomous obstacle negotiating inspection robot[J].Robot， 2006，28(4): 385-388．

[12] JAKA K，FRANJO P，BOSTJAN L. A survey of mobile robots for distribution power line inspection[J].IEEE Transactions on Power Delivery， 2010， 25 (1):485-493．

[13] POULIOT N， MONTAMBAULT S. Hydro-Québec LineScout technology: from inspection to robotic maintenance on live [C]. Transmission Power Lines 2009 IEEE International Conference on Robotics and Automation Kobe International Conference Center Kobe， Japan， May.2009: 12-17．

[14] 徐显金，李维峰，吴功平，等. 沿架空地线行驶的自主巡检机器人及应用[J]. 武汉大学学报(工学版)， 2010，43(6):752-756，761．

XU Xian-jin， LI Wei-feng， WU Gong-ping， et al. An autonomous inspection robot for transmission line along overhead ground line and its application[J].Engineering Journal of Wuhan University，2010，43(6): 752-756，761.

[15] 周风余，李贻斌，吴爱国，等.高压巡线机器人的设计与实现[J].机械科学与技术，2006，25(5): 623-626．

ZHOU Feng-yu， LI Yi-bin， WU Ai-guo， et al.Design and implementation of inspection robots for high voltage power transmission lines [J].Mechanical Science and Technology for Aerospace Engineering，2006，25(5): 623-626．

[16] WANG J D， SUN A Q， SU W， et al.Development of an expert control strategy for controlling obstacle crossing of a high-voltage transmission line inspection robot[C]//Proceedings of the 18th International Conference on Automation & Computing. Lough borough University，Leicestershire，UK，2012:285-289．

[17] 杨德伟，冯祖仁，张翔.新型三臂巡线机器人机构设计及运动分析[J].西安交通大学学报， 2012， 46 (9):43-48．

YANG De-wei，FENG Zu-ren，ZHANG Xiang.Mechanism design and kinematic analysis of a novel tribrachiation robot for transmission line inspection[J].Journal of Xi′an Jiaotong University，2012，46(9): 43-48.

[18] 霍伟.机器人动力学与控制[M].北京：高等教育出版社，2005: 23-31．

HUO Wei. Robot dynamics and control[M].Beijing: Higher Education Press， 2005: 23-31．

[19] PETER C. Robotics， vision and control fundamental algorithms in MATLAB[J]. Springer Tracts in Advanced Robotics, 2011, 73(8): 43-64．

[20] 李增刚.ADAMS入门详解与实例[M].2版.北京：国防工业出版社，2014: 340-342.

LI Zeng-gang. ADAMS introduction and training examples[M]. 2th ed. Beijing: National Defense Industry Press， 2014: 340-342．

Design of an inspection robot with surmounting all obstacles ability for overhead transmission lines

LIU Guo-ping， SUN Mao-wen， MIAO Hang， QIN Ke-ji， YU Zhen-dong

(School of Mechanical and Electrical Engineering， Nanchang University， Nanchang 330031， China)

Aiming to the status quo that the inspection robot couldn’t surmount all kinds of obstacles in overhead ground wires， a kind of brand-new method for the inspection robot obstacle negotiation was put forward. The inspection robot was driven by single arm and the mission of obstacle negotiation was accomplished by other two mechanical arms. This brand-new method could surmount all kinds of fittings with simple mechanical movements and less driving force. The key link of obstacle negotiation was calculated by theoretical analysis and simulation experiments which showed the motion characteristics of the robot during surmounting obstacles. On this base， an experimental prototype was came out to experiment on the high-voltage transmission lines in laboratory. The results show that the inspection robot can perform preplanned functions. The effectiveness and feasibility of the brand-new method are verified by surmounting obstacles test.

inspection robot； surmount all kinds of obstacles； surmounting obstacles test

2016-03-14.

江西省科技支撑计划项目(00406631100924020).

刘国平(1964—)，男，江西南昌人，教授，博士生导师，博士，从事智能机器人与视觉、机器人技术与智能自动化等研究，E-mail:liuguoping@ncu.edu.cn.http://orcid.org//0000-0002-6533-3733

10.3785/j.issn. 1006-754X.2016.05.011

TP 24

A

1006-754X(2016)05-0481-08

本刊网址·在线期刊：http://www.zjujournals.com/gcsjxb