[go: up one dir, main page]

CN112838516B - Overhead conductor robot live working device and method - Google Patents

Overhead conductor robot live working device and method Download PDF

Info

Publication number
CN112838516B
CN112838516B CN202110017784.9A CN202110017784A CN112838516B CN 112838516 B CN112838516 B CN 112838516B CN 202110017784 A CN202110017784 A CN 202110017784A CN 112838516 B CN112838516 B CN 112838516B
Authority
CN
China
Prior art keywords
overhead wire
telescopic
robot
motor
longitudinal movement
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
CN202110017784.9A
Other languages
Chinese (zh)
Other versions
CN112838516A (en
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.)
Electric Power Research Institute of Yunnan Power Grid Co Ltd
Original Assignee
Electric Power Research Institute of Yunnan 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 Yunnan Power Grid Co Ltd filed Critical Electric Power Research Institute of Yunnan Power Grid Co Ltd
Priority to CN202110017784.9A priority Critical patent/CN112838516B/en
Publication of CN112838516A publication Critical patent/CN112838516A/en
Application granted granted Critical
Publication of CN112838516B publication Critical patent/CN112838516B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02GINSTALLATION OF ELECTRIC CABLES OR LINES, OR OF COMBINED OPTICAL AND ELECTRIC CABLES OR LINES
    • H02G1/00Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines
    • H02G1/02Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines for overhead lines or cables
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Manipulator (AREA)

Abstract

The invention relates to an overhead conductor robot live working method and a device, wherein the method comprises the following steps: the overhead conductor robot positions the overhead conductor by using the vision sensor arranged on the overhead conductor robot to acquire the position of the overhead conductor; the overhead conductor robot adopts a rapid expansion random tree RRT to plan the path of an operation device on the overhead conductor robot according to the position of the overhead conductor; the overhead conductor robot advances towards the overhead conductor according to the route planning to utilize the inertial measurement unit compensation operation device's that sets up on it motion skew, control operation device and accomplish the operation, wherein, operation device includes: the device comprises a transverse moving mechanism, a longitudinal moving mechanism, a lifting mechanism, a rotary joint, a telescopic mechanism and a tail end mechanism. The invention improves the inspection efficiency of the overhead conductor robot, improves the safety of the overhead conductor robot during operation and has good applicability.

Description

一种架空导线机器人带电作业装置及方法A kind of overhead wire robot live working device and method

技术领域technical field

本申请涉及电气设备技术领域,尤其涉及一种架空导线机器人带电作业装置及方法。The present application relates to the technical field of electrical equipment, and in particular, to an overhead wire robot live working device and method.

背景技术Background technique

电力线路是是电力系统的重要组成部分,承担着输送和分配电能的任务。电力线及杆塔附件长期暴露在野外,受到持续的机械张力、电气闪络、材料老化影响而产生损伤,如果不及时修复更换,原本微小的破损和缺陷就可能扩大,最终导致严重事故。因此,必须对输电线路进行定期巡视检查,确保供电安全。Power lines are an important part of the power system and undertake the task of transmitting and distributing electrical energy. Power lines and tower accessories have been exposed to the field for a long time, and are damaged by continuous mechanical tension, electrical flashover, and material aging. If they are not repaired and replaced in time, the original small damage and defects may expand, eventually leading to serious accidents. Therefore, regular inspections of transmission lines must be carried out to ensure the safety of power supply.

目前对架空输电线路的检修工作主要由人工完成,传统作业方法要求工作人员佩戴众多防护和检修设备,攀登上杆塔后沿高压线路巡查完成检修,这种方法劳动强度大、效率低,并且由于高压输电线路有很多架设在人烟稀少的地区,工作环境较为恶劣。近年来,各研究机构开始研制用于完成架空输电线路带电巡检工作的巡线机器人,这种机器人能够在输电线路上完成自主巡察和故障诊断工作,然而现有的巡线机器人功能单一,无法较好地完成故障维修任务。At present, the maintenance work of overhead transmission lines is mainly done manually. The traditional operation method requires staff to wear many protective and maintenance equipment, climb the tower and then inspect the high-voltage line to complete the maintenance. This method is labor-intensive, low-efficiency, and due to high-voltage Many transmission lines are erected in sparsely populated areas, and the working environment is relatively harsh. In recent years, various research institutions have begun to develop line inspection robots for live inspection of overhead transmission lines. This robot can complete autonomous inspection and fault diagnosis on transmission lines. However, the existing line inspection robots have single functions and cannot Complete troubleshooting tasks well.

架空导线机器人需要在高压架空导线上工作,因此,提供一种具有良好的适用性带电作业方法及装置,能够有效适用于室外架空导线机器人自主避障和检测工作,是本发明需要解决的主要问题。The overhead wire robot needs to work on high-voltage overhead wires. Therefore, it is the main problem to be solved by the present invention to provide a live working method and device with good applicability, which can be effectively applied to the autonomous obstacle avoidance and detection work of the outdoor overhead wire robot. .

发明内容SUMMARY OF THE INVENTION

本申请提供了一种架空导线机器人带电作业装置及方法,能够有效适用于室外架空导线机器人自主避障和检测工作。The present application provides a live working device and method for an overhead wire robot, which can be effectively applied to autonomous obstacle avoidance and detection work of an outdoor overhead wire robot.

本申请采用的技术方案如下:The technical scheme adopted in this application is as follows:

本发明提供了一种架空导线机器人带电作业方法,所述作业方法包括以下步骤:The present invention provides a live working method for an overhead wire robot, and the working method includes the following steps:

S01:架空导线机器人利用其上设置的视觉传感器定位架空导线,获取架空导线的位置;S01: The overhead wire robot uses the vision sensor set on it to locate the overhead wire to obtain the position of the overhead wire;

S02:架空导线机器人根据所述架空导线的位置,采用快速扩展随机树RRT对架空导线机器人上的作业装置进行路径规划;S02: According to the position of the overhead wire, the overhead wire robot uses the rapidly expanding random tree RRT to plan the path of the working device on the overhead wire robot;

S03:架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元补偿作业装置的运动偏移,控制作业装置完成作业,其中,作业装置包括:横向移动机构、纵向移动机构、升降机构、旋转关节、伸缩机构以及末端机构。S03: The overhead wire robot advances towards the overhead wire according to the path planning, and uses the inertial measurement unit set on it to compensate the motion offset of the operation device, and controls the operation device to complete the operation, wherein the operation device includes: a lateral movement mechanism, a longitudinal movement mechanism, Lifting mechanism, rotary joint, telescopic mechanism and end mechanism.

进一步地,架空导线机器人利用其上设置的视觉传感器定位架空导线,获取架空导线的位置,包括:Further, the overhead wire robot uses the vision sensor set on the overhead wire to locate the overhead wire, and obtains the position of the overhead wire, including:

在架空导线机器人上安装两个RGB相机,通过两个RGB相机的双目测距原理定位架空导线与架空导线机器人的相对位置;Install two RGB cameras on the overhead wire robot, and locate the relative position of the overhead wire and the overhead wire robot through the binocular ranging principle of the two RGB cameras;

假设o1、o2分别为左右两相机的光心,设空间中有一点P,u1、u2分别为P点在左右两个RGB相机感光器上的成像点到感光器一侧边界的距离,则则根据三角测量原理可得:Assuming that o 1 and o 2 are the optical centers of the left and right cameras respectively, suppose there is a point P in the space, and u 1 and u 2 are the image points of the P point on the left and right RGB camera photoreceptors to the boundary of one side of the photoreceptor respectively. distance, then according to the principle of triangulation, we can get:

Figure BDA0002887300890000021
Figure BDA0002887300890000021

式中,f为相机的焦距,T为两个相机中心距,zc为P点到相机的垂直距离In the formula, f is the focal length of the camera, T is the center distance between the two cameras, and z c is the vertical distance from point P to the camera

由(1)式推导后可得距离zcThe distance z c can be obtained after deriving from equation (1):

Figure BDA0002887300890000022
Figure BDA0002887300890000022

进一步地,架空导线机器人根据所述架空导线的位置,采用快速扩展随机树RRT对架空导线机器人上的作业装置进行路径规划,包括:Further, the overhead wire robot adopts the rapid expansion random tree RRT to carry out path planning to the working device on the overhead wire robot according to the position of the overhead wire, including:

S021:获取输入机器人当前坐标,作为根节点,并将所述根节点发送给架空导线机器人的控制系统;S021: Obtain the current coordinates of the input robot as a root node, and send the root node to the control system of the overhead wire robot;

S022:架空导线机器人的控制系统在作业装置工作空间中自由空间内部产生随机点;S022: The control system of the overhead wire robot generates random points inside the free space in the working space of the working device;

S023:重复迭代遍历由所述随机点构成的随机树所有子节点并搜索与之最近的子节点;S023: Repeatedly iteratively traverses all child nodes of the random tree formed by the random points and searches for the nearest child nodes;

S024:计算所有子节点与当前随机节点的距离,定义距离最短的节点为xnearS024: Calculate the distance between all child nodes and the current random node, and define the node with the shortest distance as x near ;

S025:在xnear与产生的随机点方向上,以一定步长生成新节点;S025: Generate a new node with a certain step size in the direction of x near and the generated random point;

S026:判断新节点与目标节点的距离,若距离小于给定的距离要求,则表示搜索到对应的规划路径,否则以新节点代替根节点循环S022~S026,直到找到符合条件的路径。S026: Judging the distance between the new node and the target node, if the distance is less than the given distance requirement, it means that the corresponding planned path is searched, otherwise the new node is used instead of the root node to cycle through S022-S026 until a path that meets the conditions is found.

进一步地,架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元补偿作业装置的运动偏移,控制作业装置完成作业,包括:Further, the overhead wire robot advances toward the overhead wire according to the path planning, and uses the inertial measurement unit set on it to compensate the motion offset of the working device, and controls the working device to complete the operation, including:

架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元采集机器人的偏移量;The overhead wire robot moves towards the overhead wire according to the path planning, and uses the inertial measurement unit set on it to collect the offset of the robot;

机器人可以给作业装置的横向移动机构、纵向移动机构和升降机构发送信号,由横向移动机构、纵向移动机构和升降机构活动而补偿平行于导线的偏移量。The robot can send signals to the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism of the working device, and the movement of the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism compensates the offset parallel to the wire.

进一步地,一种架空导线机器人带电作业装置,应用于架空导线机器人带电作业方法,所述作业装置包括:Further, a live working device for an overhead wire robot is applied to a live working method for an overhead wire robot, and the working device includes:

横向移动机构,所述横向移动机构包括横移电机、横移滑块和横移丝杆,所述横移丝杆设置在所述横移电机上,所述横移滑块左右可移动的设置在所述横移丝杆上;A lateral movement mechanism, the lateral movement mechanism includes a lateral movement motor, a lateral movement slider and a lateral movement screw rod, the lateral movement screw rod is arranged on the lateral movement motor, and the lateral movement slider is set so as to be movable left and right on the traverse screw;

纵向移动机构,所述纵向移动机构包括纵移电机、纵移滑块和纵移丝杆,所述纵移电机设置在所述横移滑块上,所述纵移丝杆设置在所述纵移电机上,所述纵移滑块可前后移动的设置在所述纵移丝杆上;Longitudinal movement mechanism, the longitudinal movement mechanism includes a longitudinal movement motor, a longitudinal movement slider and a longitudinal movement screw, the longitudinal movement motor is arranged on the transverse movement slider, and the longitudinal movement screw rod is arranged on the longitudinal movement On the moving motor, the vertical moving slider is arranged on the vertical moving screw so that it can move back and forth;

升降机构,升降机构设置在所述纵向滑块上;a lifting mechanism, the lifting mechanism is arranged on the longitudinal slider;

旋转关节,所述旋转关节设置在所述升降机构远离所述纵向滑块的一端;a rotating joint, the rotating joint is arranged at one end of the lifting mechanism away from the longitudinal sliding block;

伸缩机构,所述伸缩机构包括伸缩电机、伸缩丝杆和伸缩滑块,所述伸缩丝杆连接在所述伸缩电机上,所述伸缩滑块可移动的设置在所述伸缩丝杆上,所述伸缩滑块与所述旋转关节连接;A telescopic mechanism, the telescopic mechanism includes a telescopic motor, a telescopic screw rod and a telescopic slider, the telescopic screw rod is connected to the telescopic motor, and the telescopic slider is movably arranged on the telescopic screw rod, so the telescopic slider is connected with the rotary joint;

末端机构,所述末端机构为执行机构,用于执行具体任务,且所述末端机构可拆卸设置。The end mechanism, which is an actuator, is used to perform specific tasks, and the end mechanism is detachable.

进一步地,横向移动机构,还包括横移导轨,所述横移电机设置在所述横移导轨内,所述横移丝杆设置在所述横移电机上且所述横移丝杆沿横移导轨的长度方向设置;Further, the lateral movement mechanism further includes a lateral movement guide rail, the lateral movement motor is arranged in the lateral movement guide rail, the lateral movement screw rod is arranged on the lateral movement motor, and the lateral movement screw rod is arranged along the lateral movement guide rail. Set the length direction of the moving guide rail;

纵向移动机构,还包括纵移导轨,所述纵移电机设置在所述纵移导轨内,所述纵移丝杆设置在所述纵移电机上且所述纵移丝杆沿纵移导轨的长度方向设置,所述纵移导轨固定在所述纵移滑块上。The longitudinal movement mechanism further includes a longitudinal movement guide rail, the longitudinal movement motor is arranged in the longitudinal movement guide rail, the longitudinal movement screw rod is arranged on the longitudinal movement motor, and the longitudinal movement screw rod is arranged along the longitudinal movement guide rail. It is arranged in the longitudinal direction, and the longitudinal movement guide rail is fixed on the longitudinal movement slider.

进一步地,所述升降机构包括升降电机、升降丝杆、升降滑块、滑套、导向柱,Further, the lifting mechanism includes a lifting motor, a lifting screw, a lifting slider, a sliding sleeve, and a guide column,

所述升降丝杆设置在所述升降电机上,所述升降滑块可竖直移动的设置在所述升降丝杆上,所述滑套设置在所述升降滑块上,所述导向柱可活动的设置在所述滑套内,所述导向柱的底部设置在所述纵向导轨上;The lifting screw is arranged on the lifting motor, the lifting sliding block is vertically movable on the lifting screw, the sliding sleeve is arranged on the lifting sliding block, and the guide column is movable. The movable part is arranged in the sliding sleeve, and the bottom of the guide column is arranged on the longitudinal guide rail;

所述旋转关节设置在所述升降电机的上方。The rotating joint is arranged above the lifting motor.

进一步地,所述旋转关节,包括安装架和摆动关节电机,Further, the rotating joint includes a mounting frame and a swinging joint motor,

所述安装架呈L形,包括横板和竖板,所述升降电机设置在所述横板的下方,所述摆动关节电机设置在所述横板的上方,所述竖板具有过孔,所述摆动关节电机的轴穿过所述过孔设置;The mounting frame is L-shaped and includes a horizontal plate and a vertical plate, the lifting motor is arranged below the horizontal plate, the swing joint motor is arranged above the horizontal plate, and the vertical plate has a through hole, The shaft of the swing joint motor is arranged through the through hole;

所述摆动关节电机的轴与所述伸缩机构的伸缩滑块相连接带动所述伸缩机构旋转。The shaft of the swing joint motor is connected with the telescopic sliding block of the telescopic mechanism to drive the telescopic mechanism to rotate.

进一步地,伸缩机构,还包括伸缩导轨,所述伸缩电机设置在所述伸缩导轨内,所述伸缩丝杆设置在所述伸缩电机上且所述伸缩丝杆沿纵移导轨的长度方向设置;Further, the telescopic mechanism further includes a telescopic guide rail, the telescopic motor is disposed in the telescopic guide rail, the telescopic screw rod is disposed on the telescopic motor, and the telescopic screw rod is disposed along the length direction of the longitudinal movement guide rail;

所述伸缩滑块上具有旋转关节轴孔,所述摆动关节电机的轴通过旋转关节轴孔设置在所述伸缩滑块上。The telescopic sliding block is provided with a rotating joint shaft hole, and the shaft of the swing joint motor is arranged on the telescopic sliding block through the rotating joint shaft hole.

进一步地,所述末端机构可拆卸的设置在所述伸缩导轨远离所述摆动关节电机的一端;Further, the end mechanism is detachably arranged at one end of the telescopic guide rail away from the swing joint motor;

所述末端机构可以为夹爪和套筒。The end mechanism may be a jaw and a sleeve.

采用本申请的技术方案的有益效果如下:The beneficial effects of adopting the technical solution of the present application are as follows:

本发明的一种适合于架空导线环境的作业方法及装置,首先架空导线机器人利用视觉传感器定位架空导线;为避免作业装置与高压导线相碰,采用快速扩展随机树RRT(Rapidly-Exploring Random Tree)进行路径规划;为提高作业精度,利用惯性测量单元IMU(Inertial Measurement Unit)补偿运动偏移,控制作业装置完成作业。An operation method and device suitable for the overhead wire environment of the present invention, firstly, the overhead wire robot uses a vision sensor to locate the overhead wire; in order to avoid the collision between the working device and the high-voltage wire, a Rapidly-Exploring Random Tree (RRT) is used. Carry out path planning; in order to improve the operation accuracy, the inertial measurement unit IMU (Inertial Measurement Unit) is used to compensate the motion offset, and the operation device is controlled to complete the operation.

本发明提高了架空导线机器人巡检效率;提高了架空导线机器人作业时的安全性;且具有良好的适用性。The invention improves the inspection efficiency of the overhead wire robot; improves the safety of the overhead wire robot during operation; and has good applicability.

附图说明Description of drawings

为了更清楚地说明本申请的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,对于本领域普通技术人员而言,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions of the present application more clearly, the accompanying drawings required in the embodiments will be briefly introduced below. Obviously, for those of ordinary skill in the art, without creative work, the Additional drawings can be obtained from these drawings.

图1为本发明实施例的一种架空导线机器人带电作业装置的结构示意图;1 is a schematic structural diagram of an overhead wire robot live working device according to an embodiment of the present invention;

图2为图1中横向移动机构和纵向移动机构的示意图;Fig. 2 is the schematic diagram of the lateral movement mechanism and the longitudinal movement mechanism in Fig. 1;

图3为图1中升降机构和旋转关节的示意图;Fig. 3 is the schematic diagram of the lifting mechanism and the rotating joint in Fig. 1;

图4为图1中伸缩机构的示意图;Fig. 4 is the schematic diagram of the telescopic mechanism in Fig. 1;

图5为本发明实施例的一种架空导线机器人带电作业方法的双目定位原理图;5 is a schematic diagram of binocular positioning of an overhead wire robot live working method according to an embodiment of the present invention;

图6为一种架空导线机器人带电作业装置在机器人平台上工作的示意图;6 is a schematic diagram of an overhead wire robot live working device working on a robot platform;

图示说明:Illustration description:

其中,1-横向移动机构;11-横移电机;12-横移滑块;13-横移丝杆;14-横移导轨;Among them, 1-traverse movement mechanism; 11-traverse motor; 12-traverse slider; 13-traverse screw; 14-traverse guide rail;

2-纵向移动机构;21-纵移电机;22-纵移导轨;2-longitudinal movement mechanism; 21-longitudinal movement motor; 22-longitudinal movement guide rail;

3-升降机构;31-升降电机;32-滑套;35-导向柱;3-Lifting mechanism; 31-Lifting motor; 32-Sliding sleeve; 35-Guiding column;

4-旋转关节;41-安装架;42-摆动关节电机;43-过孔;4-Rotary joint; 41-Mounting frame; 42-Swing joint motor; 43-Through hole;

5-伸缩机构;51-伸缩电机;52-伸缩丝杆;53-伸缩滑块;54-伸缩导轨;55-旋转关节轴孔;5- telescopic mechanism; 51- telescopic motor; 52- telescopic screw rod; 53- telescopic slider; 54- telescopic guide rail; 55- rotating joint shaft hole;

6-末端机构;61-夹爪。6-End mechanism; 61-Gripper.

具体实施方式Detailed ways

下面将详细地对实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下实施例中描述的实施方式并不代表与本申请相一致的所有实施方式。仅是与权利要求书中所详述的、本申请的一些方面相一致的系统和方法的示例。Embodiments will be described in detail below, examples of which are illustrated in the accompanying drawings. Where the following description refers to the drawings, the same numerals in different drawings refer to the same or similar elements unless otherwise indicated. The implementations described in the following examples are not intended to represent all implementations consistent with this application. are merely exemplary of systems and methods consistent with some aspects of the present application as recited in the claims.

本发明针对架空导线机器人在高压导线上工作时,所处的特殊环境和工作任务,设计了一种适合于架空导线机器人的作业装置及方法。The present invention designs a working device and method suitable for the overhead wire robot in view of the special environment and work tasks in which the overhead wire robot is working on the high-voltage wire.

其中,如图1所示,本发明的一种架空导线机器人带电作业装置,包括横向移动机构、纵向移动机构、升降机构、旋转关节、伸缩机构和末端机构,具体来说:Among them, as shown in Figure 1, an overhead wire robot live working device of the present invention includes a lateral movement mechanism, a longitudinal movement mechanism, a lifting mechanism, a rotating joint, a telescopic mechanism and an end mechanism, specifically:

如图2所示,横向移动机构,所述横向移动机构包括横移电机、横移滑块、横移丝杆和横移导轨,所述横移电机设置在所述横移导轨内,所述横移丝杆设置在所述横移电机上且所述横移丝杆沿横移导轨的长度方向设置,所述横移滑块左右可移动的设置在所述横移丝杆上;As shown in FIG. 2, the lateral movement mechanism includes a lateral movement motor, a lateral movement slider, a lateral movement screw and a lateral movement guide rail, the lateral movement motor is arranged in the lateral movement guide rail, and the The traverse screw rod is arranged on the traverse motor and the traverse screw rod is arranged along the length direction of the traverse guide rail, and the traverse slider is movably arranged on the traverse screw rod;

纵向移动机构,所述纵向移动机构包括纵移电机、纵移滑块、纵移丝杆和纵移导轨,所述纵移电机设置在所述横移滑块上,所述纵移电机设置在所述纵移导轨内,所述纵移丝杆设置在所述纵移电机上且所述纵移丝杆沿纵移导轨的长度方向设置,所述纵移滑块可前后移动的设置在所述纵移丝杆上,所述纵移导轨固定在所述纵移滑块上;Longitudinal movement mechanism, the longitudinal movement mechanism includes a longitudinal movement motor, a longitudinal movement slider, a longitudinal movement screw rod and a longitudinal movement guide rail, the longitudinal movement motor is arranged on the transverse movement slider, and the longitudinal movement motor is arranged on the In the longitudinal movement guide rail, the longitudinal movement screw rod is arranged on the longitudinal movement motor and the longitudinal movement screw rod is arranged along the length direction of the longitudinal movement guide rail, and the longitudinal movement sliding block can be moved back and forth. on the longitudinal movement screw rod, the longitudinal movement guide rail is fixed on the longitudinal movement slider;

如图3所示,升降机构,升降机构包括升降电机、升降丝杆、升降滑块、滑套、导向柱,所述升降丝杆设置在所述升降电机上,所述升降滑块可竖直移动的设置在所述升降丝杆上,所述滑套设置在所述升降滑块上,所述导向柱可活动的设置在所述滑套内,所述导向柱的底部设置在所述纵向导轨上;As shown in Figure 3, the lifting mechanism includes a lifting motor, a lifting screw, a lifting slider, a sliding sleeve, and a guide column. The lifting screw is arranged on the lifting motor, and the lifting slider can be vertically The movable is arranged on the lifting screw, the sliding sleeve is arranged on the lifting slider, the guide column is movably arranged in the sliding sleeve, and the bottom of the guide column is arranged in the longitudinal direction. on the rail;

旋转关节,旋转关节包括安装架和摆动关节电机,所述安装架呈L形,包括横板和竖板,所述升降电机设置在所述横板的下方,所述摆动关节电机设置在所述横板的上方,所述竖板具有过孔,所述摆动关节电机的轴穿过所述过孔设置;A rotating joint, the rotating joint includes a mounting frame and a swinging joint motor, the mounting frame is L-shaped and includes a horizontal plate and a vertical plate, the lifting motor is arranged below the horizontal plate, and the swinging joint motor is arranged on the Above the horizontal plate, the vertical plate has a through hole, and the shaft of the swing joint motor is arranged through the through hole;

如图4所示,伸缩机构,所述伸缩机构包括伸缩电机、伸缩丝杆、伸缩滑块和伸缩导轨,所述伸缩电机设置在所述伸缩导轨内,所述伸缩丝杆设置在所述伸缩电机上且所述伸缩丝杆沿纵移导轨的长度方向设置,所述伸缩滑块可移动的设置在所述伸缩丝杆上,所述伸缩滑块上具有旋转关节轴孔,所述摆动关节电机的轴通过旋转关节轴孔设置在所述伸缩滑块上;As shown in FIG. 4, the telescopic mechanism includes a telescopic motor, a telescopic screw rod, a telescopic slider and a telescopic guide rail, the telescopic motor is arranged in the telescopic guide rail, and the telescopic screw rod is arranged in the telescopic The motor and the telescopic screw rod are arranged along the length direction of the longitudinal guide rail, the telescopic slider is movably arranged on the telescopic screw rod, the telescopic slider has a shaft hole for a rotating joint, and the swing joint The shaft of the motor is arranged on the telescopic slider through the shaft hole of the rotating joint;

末端机构,所述末端机构为执行机构,用于执行具体任务,且所述末端机构可拆卸设置。The end mechanism, which is an actuator, is used to perform specific tasks, and the end mechanism is detachable.

其中,上述的横向移动机构,可以通过横移电机的转动,横移滑块左右移动,从而可带动连接在横移滑块上的纵向移动机构左右移动;纵向移动机构的纵移电机转动,纵移滑块前后移动,从而带动升降机构前后移动;升降机构的升降电机转动,升降滑块上下移动,从而带动滑套在导向柱上上下移动;升降机构顶部的摆动关节电机转动,可带动伸缩机构旋转;为整个作业装置提供沿架空导线水平垂直方向的平移运动和沿架空导线水平方向的平移运动,该两项平移运动可以保证作业装置适用于单分裂导线、水平二分裂导线、垂直二分裂导线或者四分裂导线的多种作业任务。The above-mentioned lateral movement mechanism can move the lateral movement slider left and right through the rotation of the lateral movement motor, thereby driving the longitudinal movement mechanism connected to the lateral movement slider to move left and right; the longitudinal movement motor of the longitudinal movement mechanism rotates, and the vertical movement The moving slider moves back and forth, thereby driving the lifting mechanism to move forward and backward; the lifting motor of the lifting mechanism rotates, and the lifting slider moves up and down, thereby driving the sliding sleeve to move up and down on the guide column; the swing joint motor on the top of the lifting mechanism rotates, which can drive the telescopic mechanism Rotation; provide translational movement along the horizontal and vertical directions of the overhead wire and translational movement along the horizontal direction of the overhead wire for the entire operation device, these two translational movements can ensure that the operation device is suitable for single-split conductors, horizontal two-split conductors, and vertical two-split conductors Or a variety of job tasks for four-split conductors.

同时,上述的伸缩机构,伸缩电机的转动,伸缩滑块沿丝杆方向移动,从而带动伸缩机构整体沿丝杆方向移动。At the same time, the above-mentioned telescopic mechanism, the rotation of the telescopic motor, the telescopic slider moves in the direction of the screw rod, thereby driving the entire telescopic mechanism to move in the direction of the screw rod.

其中,摆动关节电机设置在升降机构顶部,摆动关节电机的轴通过旋转关节轴孔设置在伸缩机构的伸缩滑块上,用于整个伸缩机构相对于升降机构的旋转运动,该旋转运动能够较大幅度地调整末端机构相对与架空导线的位姿,一定程度上保证了整个作业装置在单分裂导线、垂直二分裂导线、水平二分裂导线以及四分裂导线环境的作业任务需求;伸缩机构上的伸缩滑块用于提供伸缩机构相对于升降机构的平移运动,该平移运动与旋转运动配合能够保证作业装置在不同分裂导线之间任意地切换位置,完成对各项任务。Among them, the swinging joint motor is arranged on the top of the lifting mechanism, and the shaft of the swinging joint motor is arranged on the telescopic sliding block of the telescopic mechanism through the shaft hole of the rotating joint, which is used for the rotational movement of the entire telescopic mechanism relative to the lifting mechanism, and the rotational movement can be relatively large. The position and posture of the end mechanism relative to the overhead wire are adjusted in a wide range, which ensures the operation task requirements of the entire operation device in the environment of single-split wire, vertical two-split wire, horizontal two-split wire and four-split wire environment; The sliding block is used to provide the translational motion of the telescopic mechanism relative to the lifting mechanism. The translational motion and the rotational motion can ensure that the working device can switch positions arbitrarily between different split wires and complete various tasks.

具体来说,架空高压导线周围会有强磁场分布,旋转关节作业臂在靠近高压导线时会不可避免得因切割磁感线运动而产生感应电流,本作业装置在旋转关节基础上增设伸缩臂(伸缩机构),机器人通过伸缩臂靠近高压导线以减小感应电流的产生。Specifically, there will be a strong magnetic field distribution around the overhead high-voltage wire. When the rotating joint working arm is close to the high-voltage wire, an induced current will inevitably be generated due to the movement of the cutting magnetic field line. This working device adds a telescopic arm ( Telescopic mechanism), the robot approaches the high-voltage wire through the telescopic arm to reduce the generation of induced current.

在一实施例中,末端机构可拆卸的设置在伸缩导轨远离所述摆动关节电机的一端;末端机构是指作业装置执行具体任务时所安装的执行机构,图1和图4中为夹爪,可更换,如要用于拧防震锤螺栓,可换为套筒;当然,本发明不限于末端机构为夹爪或者套筒,还可以为其他执行机构,在此不多做赘述。In one embodiment, the end mechanism is detachably arranged at one end of the telescopic guide rail away from the swing joint motor; the end mechanism refers to the actuator installed when the working device performs a specific task, and the gripper is shown in FIG. 1 and FIG. 4 , It can be replaced. If it is to be used for screwing the anti-vibration hammer bolt, it can be replaced with a sleeve; of course, the present invention is not limited to the end mechanism being a gripper or a sleeve, but can also be other actuators, which will not be repeated here.

在一实施例中,当将上述的一种架空导线机器人带电作业装置,应用于架空导线机器人带电作业方法时,本实施例提供的一种架空导线机器人带电作业方法,包括以下步骤:In one embodiment, when the above-mentioned live working device for an overhead wire robot is applied to a live working method for an overhead wire robot, the present embodiment provides a live working method for an overhead wire robot, comprising the following steps:

S01:架空导线机器人利用其上设置的视觉传感器定位架空导线,获取架空导线的位置;S01: The overhead wire robot uses the vision sensor set on it to locate the overhead wire to obtain the position of the overhead wire;

具体步骤为:The specific steps are:

S011:在架空导线机器人上安装两个RGB相机,通过两个RGB相机的双目测距原理定位架空导线与架空导线机器人的相对位置;两个RGB相机的双目测距原理是模拟人眼视差原理,通过对同一目标的两幅不同角度图像的成像差异进行分析,利用三角测量原理,确定目标在物理世界中的三维信息。S011: Install two RGB cameras on the overhead wire robot, and locate the relative position of the overhead wire and the overhead wire robot through the binocular ranging principle of the two RGB cameras; the binocular ranging principle of the two RGB cameras is to simulate human eye parallax By analyzing the imaging differences of two images of the same target at different angles, and using the principle of triangulation, the three-dimensional information of the target in the physical world is determined.

S012:如图5所示,假设o1、o2分别为左右两相机的光心,设空间中有一点P,u1、u2分别为P点在左右两个RGB相机感光器上的成像点到感光器一侧边界的距离,则则根据三角测量原理可得:S012: As shown in Figure 5, suppose that o 1 and o 2 are the optical centers of the left and right cameras, respectively, and a point P is set in the space, and u 1 and u 2 are the images of point P on the left and right RGB camera photoreceptors, respectively. The distance from the point to the boundary of one side of the photoreceptor can be obtained according to the principle of triangulation:

Figure BDA0002887300890000061
Figure BDA0002887300890000061

式中,f为相机的焦距,T为两个相机中心距,zc为P点到相机的垂直距离In the formula, f is the focal length of the camera, T is the center distance between the two cameras, and z c is the vertical distance from point P to the camera

由(1)式推导后可得距离zcThe distance z c can be obtained after deriving from equation (1):

Figure BDA0002887300890000062
Figure BDA0002887300890000062

S02:架空导线机器人根据所述架空导线的位置,采用快速扩展随机树RRT对架空导线机器人上的作业装置进行路径规划;S02: According to the position of the overhead wire, the overhead wire robot uses the rapidly expanding random tree RRT to plan the path of the working device on the overhead wire robot;

机器人在工作时,作业装置易与导线发生碰撞,故需要采用路径规划算法来避免作业臂与导线相碰,本方法采用快速搜索随机树RRT(Rapidly-Exploring RandomTree)算法。When the robot is working, the working device is easy to collide with the wire, so a path planning algorithm needs to be used to avoid the collision between the working arm and the wire. This method adopts the RRT (Rapidly-Exploring RandomTree) algorithm.

快速搜索随机树算法可用于解决复杂约束的高维空间路径规划问题,作为一种路径搜索方法,其主要优点为扩展性强、概率完备性和易实现等,其主要缺点为在复杂地图下计算量大、收敛速度慢。对于架空导线机器人所处环境,其主要障碍物为导线,机器人的工作空间较为简单,所以快速搜索随机树算法能够较好地满足架空导线机器人工作任务的需求。The fast search random tree algorithm can be used to solve the high-dimensional space path planning problem with complex constraints. As a path search method, its main advantages are strong scalability, probabilistic completeness, and easy implementation. Its main disadvantage is that it is calculated under complex maps. The amount is large and the convergence rate is slow. For the environment where the overhead wire robot is located, the main obstacle is the wire, and the working space of the robot is relatively simple, so the fast search random tree algorithm can better meet the needs of the overhead wire robot work task.

快速搜索随机树是通过采用增量方式的随机采样进行路径搜索的算法,该算法通过以一个已知的起始点(起始点为作业装置的当前姿态,即当前坐标)作为根节点,在机器人工作空间中不断利用随机采集的方法采集路径点,之后再以一个固定步长去扩展子节点,从而产生扩展树,直至子节点到达工作目标任务点。The fast search random tree is an algorithm for path search through random sampling in an incremental manner. In the space, the random collection method is used to collect the waypoints continuously, and then the child nodes are expanded with a fixed step size, thereby generating an expanded tree until the child nodes reach the work target task point.

具体步骤为:The specific steps are:

S021:获取输入机器人当前坐标,作为根节点,并将所述根节点发送给架空导线机器人的控制系统;S021: Obtain the current coordinates of the input robot as a root node, and send the root node to the control system of the overhead wire robot;

具体来说,横向移动机构的横移电机、纵向移动机构的纵移电机、升降机构的升降电机、旋转关节的摆动关节电机、伸缩机构的伸缩电机均连接有与之匹配的编码器,各电机的编码器能够获取各电机的活动或者旋转角度从而得到作业装置各机构的当前位置,由各机构位置得到作业装置的当前姿态,当前姿态作为根节点需要发送给架空导线机器人的控制系统。Specifically, the lateral movement motor of the lateral movement mechanism, the longitudinal movement motor of the longitudinal movement mechanism, the lifting motor of the lifting mechanism, the swing joint motor of the rotary joint, and the telescopic motor of the telescopic mechanism are all connected with matching encoders. The encoder can obtain the activity or rotation angle of each motor to obtain the current position of each mechanism of the working device, and obtain the current posture of the working device from the position of each mechanism. The current posture needs to be sent to the control system of the overhead wire robot as the root node.

S022:架空导线机器人的控制系统在作业装置工作空间中自由空间内部产生随机点;S022: The control system of the overhead wire robot generates random points inside the free space in the working space of the working device;

本步骤中,工作空间是指作业装置末端机构运动所能达到的空间点的集合,这些随机点是由机器人的控制系统产生。In this step, the workspace refers to a set of spatial points that can be reached by the movement of the end mechanism of the working device, and these random points are generated by the control system of the robot.

S023:重复迭代遍历由所述随机点构成的随机树所有子节点并搜索与之最近的子节点;S023: Repeatedly iteratively traverses all child nodes of the random tree formed by the random points and searches for the nearest child nodes;

S024:计算所有子节点与当前随机节点的距离,定义距离最短的节点为xnearS024: Calculate the distance between all child nodes and the current random node, and define the node with the shortest distance as x near ;

S025:在xnear与产生的随机点方向上,以一定步长生成新节点;S025: Generate a new node with a certain step size in the direction of x near and the generated random point;

S026:判断新节点与目标节点(作业装置末端机构要达到的点)的距离,若距离小于给定的距离要求,则表示搜索到对应的规划路径,否则以新节点代替根节点继续当前循环(S022~S026),直到找到符合条件的路径。S026: Judging the distance between the new node and the target node (the point to be reached by the end mechanism of the operating device), if the distance is less than the given distance requirement, it means that the corresponding planned path has been searched, otherwise the new node is used instead of the root node to continue the current cycle ( S022~S026), until a path that meets the conditions is found.

S03:如图6所示,架空导线机器人,即机器人平台,根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元补偿作业装置的运动偏移,控制作业装置完成作业,其中,作业装置包括:横向移动机构、纵向移动机构、升降机构、旋转关节、伸缩机构以及末端机构。S03: As shown in Figure 6, the overhead wire robot, that is, the robot platform, moves toward the overhead wire according to the path planning, and uses the inertial measurement unit set on it to compensate the motion offset of the working device, and controls the working device to complete the operation. The device includes: a lateral movement mechanism, a longitudinal movement mechanism, a lifting mechanism, a rotary joint, a telescopic mechanism and an end mechanism.

由于架空导线机器人在巡线过程中将不可避免地受到环境影响,架空导线机器人会产生摇摆运动,此外,由于作业装置的末端机构需要完成多种不同的任务,如夹持导线、检测导线、推动防震锤等,装置的终端可能装有质量较大的末端机构,当作业装置工作时机器人自身重心将产生偏移。此时,如果要实时地多次进行进行路径规划则会大大增加计算量和规划时间,而无法达到实时性的目的,同时主要的路径规划方法中只能对静态环境中的障碍物进行规避,因此,本方法在机器人平台上装有惯性测量单元IMU(InertialMeasurement Unit)进行运动偏移量采集,补偿作业装置末端的运动偏移,控制作业装置完成作业,从而提高架空线路机器人的工作效率。Since the overhead wire robot will inevitably be affected by the environment during the line inspection process, the overhead wire robot will have a rocking motion. In addition, due to the end mechanism of the working device, it needs to complete a variety of different tasks, such as clamping the wire, detecting the wire, pushing the wire Anti-vibration hammers, etc., the terminal of the device may be equipped with an end mechanism with a large mass, and the center of gravity of the robot will be offset when the working device is working. At this time, if the path planning is performed in real time for many times, the calculation amount and planning time will be greatly increased, and the real-time purpose cannot be achieved. At the same time, the main path planning method can only avoid obstacles in the static environment. Therefore, in this method, an inertial measurement unit (IMU) is installed on the robot platform to collect motion offset, compensate the motion offset of the end of the working device, and control the working device to complete the operation, thereby improving the working efficiency of the overhead line robot.

其中,架空线路机器人的摇摆运动主要为绕导线和沿导线的平移运动。Among them, the rocking motion of the overhead line robot is mainly translational motion around and along the wire.

具体步骤为:The specific steps are:

架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元采集机器人的偏移量;The overhead wire robot moves towards the overhead wire according to the path planning, and uses the inertial measurement unit set on it to collect the offset of the robot;

机器人可以给作业装置的横向移动机构、纵向移动机构和升降机构发送信号,由横向移动机构、纵向移动机构和升降机构活动而补偿平行于导线的偏移量。The robot can send signals to the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism of the working device, and the movement of the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism compensates the offset parallel to the wire.

本申请设计了一种适合于架空导线环境的作业方法及装置,首先架空导线机器人利用视觉传感器定位架空导线;为避免作业装置与高压导线相碰,采用快速扩展随机树RRT(Rapidly-Exploring Random Tree)进行路径规划;为提高作业精度,利用惯性测量单元IMU(Inertial Measurement Unit)补偿运动偏移,控制作业装置完成作业。This application designs an operation method and device suitable for the overhead wire environment. First, the overhead wire robot uses a vision sensor to locate the overhead wire; in order to avoid the collision between the working device and the high-voltage wire, a Rapidly-Exploring Random Tree (RRT) is used. ) to carry out path planning; in order to improve the operation accuracy, the inertial measurement unit IMU (Inertial Measurement Unit) is used to compensate the motion offset, and the operation device is controlled to complete the operation.

本实施例的有益效果:The beneficial effects of this embodiment:

(1)本发明提高了架空导线机器人巡检效率;(1) The present invention improves the inspection efficiency of the overhead wire robot;

(2)本发明提高了架空导线机器人作业时的安全性;(2) The present invention improves the safety of the overhead wire robot during operation;

(3)本发明具有良好的适用性。(3) The present invention has good applicability.

本申请提供的实施例之间的相似部分相互参见即可,以上提供的具体实施方式只是本申请总的构思下的几个示例,并不构成本申请保护范围的限定。对于本领域的技术人员而言,在不付出创造性劳动的前提下依据本申请方案所扩展出的任何其他实施方式都属于本申请的保护范围。Similar parts between the embodiments provided in the present application may be referred to each other. The specific embodiments provided above are just a few examples under the general concept of the present application, and do not constitute a limitation on the protection scope of the present application. For those skilled in the art, any other implementations expanded according to the solution of the present application without creative work fall within the protection scope of the present application.

Claims (9)

1.一种架空导线机器人带电作业方法,其特征在于,所述作业方法包括以下步骤:1. an overhead wire robot live working method, is characterized in that, described working method comprises the following steps: S01:架空导线机器人利用其上设置的视觉传感器定位架空导线,获取架空导线的位置;S01: The overhead wire robot uses the vision sensor set on it to locate the overhead wire to obtain the position of the overhead wire; S02:架空导线机器人根据所述架空导线的位置,采用快速扩展随机树RRT对架空导线机器人上的作业装置进行路径规划,具体包括以下步骤:S02: According to the position of the overhead wire, the overhead wire robot uses the rapidly expanding random tree RRT to plan the path of the working device on the overhead wire robot, which specifically includes the following steps: S021:获取输入机器人当前坐标,作为根节点,并将所述根节点发送给架空导线机器人的控制系统;S021: Obtain the current coordinates of the input robot as a root node, and send the root node to the control system of the overhead wire robot; S022:架空导线机器人的控制系统在作业装置工作空间中自由空间内部产生随机点;S022: The control system of the overhead wire robot generates random points inside the free space in the working space of the working device; S023:重复迭代遍历由所述随机点构成的随机树所有子节点并搜索与之最近的子节点;S023: Repeatedly iteratively traverses all child nodes of the random tree formed by the random points and searches for the nearest child nodes; S024:计算所有子节点与当前随机节点的距离,定义距离最短的节点为
Figure RE-379343DEST_PATH_IMAGE001
S024: Calculate the distance between all child nodes and the current random node, and define the node with the shortest distance as
Figure RE-379343DEST_PATH_IMAGE001
;
S025:在
Figure RE-215712DEST_PATH_IMAGE001
与产生的随机点方向上,以一定步长生成新节点;
S025: In
Figure RE-215712DEST_PATH_IMAGE001
Generate a new node with a certain step size in the direction of the generated random point;
S026:判断新节点与目标节点的距离,若距离小于给定的距离要求,则表示搜索到对应的规划路径,否则以新节点代替根节点循环S022~S026,直到找到符合条件的路径;S026: Judging the distance between the new node and the target node, if the distance is less than the given distance requirement, it means that the corresponding planned path has been searched, otherwise the new node is used instead of the root node to cycle through S022 to S026 until a path that meets the conditions is found; S03:架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元补偿作业装置的运动偏移,控制作业装置完成作业,其中,作业装置包括:横向移动机构、纵向移动机构、升降机构、旋转关节、伸缩机构以及末端机构。S03: The overhead wire robot advances towards the overhead wire according to the path planning, and uses the inertial measurement unit set on it to compensate the motion offset of the operation device, and controls the operation device to complete the operation, wherein the operation device includes: a lateral movement mechanism, a longitudinal movement mechanism, Lifting mechanism, rotary joint, telescopic mechanism and end mechanism.
2.根据权利要求1所述的架空导线机器人带电作业方法,其特征在于,架空导线机器人利用其上设置的视觉传感器定位架空导线,获取架空导线的位置,包括:2. The overhead wire robot live working method according to claim 1, wherein the overhead wire robot utilizes the vision sensor provided on it to locate the overhead wire to obtain the position of the overhead wire, comprising: 在架空导线机器人上安装两个RGB相机,通过两个RGB相机的双目测距原理定位架空导线与架空导线机器人的相对位置;Install two RGB cameras on the overhead wire robot, and locate the relative position of the overhead wire and the overhead wire robot through the binocular ranging principle of the two RGB cameras; 假设
Figure RE-988496DEST_PATH_IMAGE002
Figure RE-919412DEST_PATH_IMAGE003
分别为左右两相机的光心,设空间中有一点P,
Figure RE-828462DEST_PATH_IMAGE004
Figure RE-694787DEST_PATH_IMAGE005
分别为P点在左右两个RGB相机感光器上的成像点到感光器一侧边界的距离,则根据三角测量原理可得:
Assumption
Figure RE-988496DEST_PATH_IMAGE002
,
Figure RE-919412DEST_PATH_IMAGE003
are the optical centers of the left and right cameras respectively, suppose there is a point P in the space,
Figure RE-828462DEST_PATH_IMAGE004
,
Figure RE-694787DEST_PATH_IMAGE005
are the distance from the imaging point of point P on the left and right RGB camera photoreceptors to the boundary of one side of the photoreceptor, then according to the principle of triangulation, it can be obtained:
Figure RE-564654DEST_PATH_IMAGE006
(1)
Figure RE-564654DEST_PATH_IMAGE006
(1)
式中,
Figure RE-174627DEST_PATH_IMAGE007
为相机的焦距,
Figure RE-829861DEST_PATH_IMAGE008
为两个相机中心距,
Figure RE-132666DEST_PATH_IMAGE009
为 P 点到相机的垂直距离
In the formula,
Figure RE-174627DEST_PATH_IMAGE007
is the focal length of the camera,
Figure RE-829861DEST_PATH_IMAGE008
is the center distance between the two cameras,
Figure RE-132666DEST_PATH_IMAGE009
is the vertical distance from point P to the camera
由(1)式推导后可得距离
Figure RE-348884DEST_PATH_IMAGE009
Figure RE-637914DEST_PATH_IMAGE010
(2)。
After deriving from (1), the distance can be obtained
Figure RE-348884DEST_PATH_IMAGE009
:
Figure RE-637914DEST_PATH_IMAGE010
(2).
3.根据权利要求1所述的架空导线机器人带电作业方法,其特征在于,架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元补偿作业装置的运动偏移,控制作业装置完成作业,包括:3. The live working method of an overhead wire robot according to claim 1, wherein the overhead wire robot advances toward the overhead wire according to the path planning, and uses the inertial measurement unit provided on it to compensate the motion offset of the operation device to control the operation. The device completes the job, including: 架空导线机器人根据路径规划朝架空导线前进,并利用其上设置的惯性测量单元采集机器人的偏移量;The overhead wire robot moves towards the overhead wire according to the path planning, and uses the inertial measurement unit set on it to collect the offset of the robot; 机器人可以给作业装置的横向移动机构、纵向移动机构和升降机构发送信号,由横向移动机构、纵向移动机构和升降机构活动而补偿平行于导线的偏移量。The robot can send signals to the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism of the working device, and the movement of the lateral movement mechanism, the longitudinal movement mechanism and the lifting mechanism compensates the offset parallel to the wire. 4.一种架空导线机器人带电作业装置,所述装置应用于权利要求1-3所述的方法,其特征在于,所述作业装置包括:4. An overhead wire robot live working device, the device being applied to the method of claims 1-3, wherein the working device comprises: 横向移动机构,所述横向移动机构包括横移电机、横移滑块和横移丝杆,所述横移丝杆设置在所述横移电机上,所述横移滑块左右可移动的设置在所述横移丝杆上;A lateral movement mechanism, the lateral movement mechanism includes a traverse motor, a traverse slider and a traverse screw, the traverse screw is arranged on the traverse motor, and the traverse slider can be moved left and right. on the traverse screw; 纵向移动机构,所述纵向移动机构包括纵移电机、纵移滑块和纵移丝杆,所述纵移电机设置在所述横移滑块上,所述纵移丝杆设置在所述纵移电机上,所述纵移滑块可前后移动的设置在所述纵移丝杆上;Longitudinal movement mechanism, the longitudinal movement mechanism includes a longitudinal movement motor, a longitudinal movement slider and a longitudinal movement screw, the longitudinal movement motor is arranged on the transverse movement slider, and the longitudinal movement screw rod is arranged on the longitudinal movement On the moving motor, the vertical moving slider is arranged on the vertical moving screw so that it can move back and forth; 升降机构,升降机构设置在所述纵移滑块上;a lifting mechanism, the lifting mechanism is arranged on the longitudinal sliding block; 旋转关节,所述旋转关节设置在所述升降机构远离所述纵向滑块的一端;a rotating joint, the rotating joint is arranged at one end of the lifting mechanism away from the longitudinal sliding block; 伸缩机构,所述伸缩机构包括伸缩电机、伸缩丝杆和伸缩滑块,所述伸缩丝杆连接在所述伸缩电机上,所述伸缩滑块可移动的设置在所述伸缩丝杆上,所述伸缩滑块与所述旋转关节连接;A telescopic mechanism, the telescopic mechanism includes a telescopic motor, a telescopic screw rod and a telescopic slider, the telescopic screw rod is connected to the telescopic motor, and the telescopic slider is movably arranged on the telescopic screw rod, so the telescopic slider is connected with the rotary joint; 末端机构,所述末端机构为执行机构,用于执行具体任务,且所述末端机构可拆卸设置。The end mechanism, which is an actuator, is used to perform specific tasks, and the end mechanism is detachable. 5.根据权利要求4所述的架空导线机器人带电作业装置,其特征在于,5. The overhead wire robot live working device according to claim 4, characterized in that, 横向移动机构,还包括横移导轨,所述横移电机设置在所述横移导轨内,所述横移丝杆设置在所述横移电机上且所述横移丝杆沿横移导轨的长度方向设置;The lateral movement mechanism further includes a lateral movement guide rail, the lateral movement motor is arranged in the lateral movement guide rail, the lateral movement screw rod is arranged on the lateral movement motor, and the lateral movement screw rod is arranged along the direction of the lateral movement guide rail. length direction setting; 纵向移动机构,还包括纵移导轨,所述纵移电机设置在所述纵移导轨内,所述纵移丝杆设置在所述纵移电机上且所述纵移丝杆沿纵移导轨的长度方向设置,所述纵移导轨固定在所述纵移滑块上。The longitudinal movement mechanism further includes a longitudinal movement guide rail, the longitudinal movement motor is arranged in the longitudinal movement guide rail, the longitudinal movement screw rod is arranged on the longitudinal movement motor, and the longitudinal movement screw rod is arranged along the longitudinal movement guide rail. The longitudinal movement guide rail is fixed on the longitudinal movement slider. 6.根据权利要求4或5所述的架空导线机器人带电作业装置,其特征在于,所述升降机构包括升降电机、升降丝杆、升降滑块、滑套、导向柱,6. The overhead wire robot live working device according to claim 4 or 5, wherein the lifting mechanism comprises a lifting motor, a lifting screw, a lifting slider, a sliding sleeve, and a guide column, 所述升降丝杆设置在所述升降电机上,所述升降滑块可竖直移动的设置在所述升降丝杆上,所述滑套设置在所述升降滑块上,所述导向柱可活动的设置在所述滑套内,所述导向柱的底部设置在纵移导轨上;The lifting screw is arranged on the lifting motor, the lifting sliding block is vertically movable on the lifting screw, the sliding sleeve is arranged on the lifting sliding block, and the guide column is movable. The movable one is arranged in the sliding sleeve, and the bottom of the guide column is arranged on the longitudinal guide rail; 所述旋转关节设置在所述升降电机的上方。The rotating joint is arranged above the lifting motor. 7.根据权利要求6所述的架空导线机器人带电作业装置,其特征在于,所述旋转关节,包括安装架和摆动关节电机,7 . The live working device of an overhead wire robot according to claim 6 , wherein the rotating joint comprises a mounting frame and a swing joint motor, 8 . 所述安装架呈L形,包括横板和竖板,所述升降电机设置在所述横板的下方,所述摆动关节电机设置在所述横板的上方,所述竖板具有过孔,所述摆动关节电机的轴穿过所述过孔设置;The mounting frame is L-shaped and includes a horizontal plate and a vertical plate, the lifting motor is arranged below the horizontal plate, the swing joint motor is arranged above the horizontal plate, and the vertical plate has a through hole, The shaft of the swing joint motor is arranged through the through hole; 所述摆动关节电机的轴与所述伸缩机构的伸缩滑块相连接带动所述伸缩机构旋转。The shaft of the swing joint motor is connected with the telescopic sliding block of the telescopic mechanism to drive the telescopic mechanism to rotate. 8.根据权利要求7所述的架空导线机器人带电作业装置,其特征在于,伸缩机构,还包括伸缩导轨,所述伸缩电机设置在所述伸缩导轨内,所述伸缩丝杆设置在所述伸缩电机上且所述伸缩丝杆沿纵移导轨的长度方向设置;8 . The live working device of an overhead wire robot according to claim 7 , wherein the telescopic mechanism further comprises a telescopic guide rail, the telescopic motor is arranged in the telescopic guide rail, and the telescopic screw rod is arranged on the telescopic guide rail. 9 . on the motor and the telescopic screw rod is arranged along the length direction of the longitudinal guide rail; 所述伸缩滑块上具有旋转关节轴孔,所述摆动关节电机的轴通过旋转关节轴孔设置在所述伸缩滑块上。The telescopic sliding block is provided with a rotating joint shaft hole, and the shaft of the swing joint motor is arranged on the telescopic sliding block through the rotating joint shaft hole. 9.根据权利要求8所述的架空导线机器人带电作业装置,其特征在于,所述末端机构可拆卸的设置在所述伸缩导轨远离所述摆动关节电机的一端;9 . The live working device for an overhead wire robot according to claim 8 , wherein the end mechanism is detachably arranged at one end of the telescopic guide rail away from the swing joint motor; 9 . 所述末端机构为夹爪和套筒。The end mechanism is a clamping jaw and a sleeve.
CN202110017784.9A 2021-01-07 2021-01-07 Overhead conductor robot live working device and method Active CN112838516B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110017784.9A CN112838516B (en) 2021-01-07 2021-01-07 Overhead conductor robot live working device and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110017784.9A CN112838516B (en) 2021-01-07 2021-01-07 Overhead conductor robot live working device and method

Publications (2)

Publication Number Publication Date
CN112838516A CN112838516A (en) 2021-05-25
CN112838516B true CN112838516B (en) 2022-09-27

Family

ID=75927790

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110017784.9A Active CN112838516B (en) 2021-01-07 2021-01-07 Overhead conductor robot live working device and method

Country Status (1)

Country Link
CN (1) CN112838516B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114407030B (en) * 2021-11-12 2024-07-19 山东大学 Autonomous navigation distribution network live working robot and working method thereof

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101168254A (en) * 2006-10-25 2008-04-30 上海求是机器人有限公司 Swinging arm type transmission line polling robot
CN110673634A (en) * 2019-11-12 2020-01-10 合肥工业大学 A power inspection drone path planning method and a transmission line inspection method

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB190828076A (en) * 1908-12-24 1909-09-09 Claude Kennedy Mills Contact Device on a Travelling Bridge-crane to Convey Current from an Electric Overhead Conductor to an Electric Locomotive Passing under the same, without Interfering with the Working of the Crane.
JP2000228809A (en) * 1999-02-08 2000-08-15 Furukawa Electric Co Ltd:The Apparatus and method for installing spacer for transmission line on multiple conductor overhead transmission line
CN104823731A (en) * 2015-05-27 2015-08-12 武汉大学 Branch pruning robot for overhead high-voltage transmission line live working
CN104917105B (en) * 2015-06-29 2017-08-08 国家电网公司 Aerial high-voltage power transmission line hotline maintenance robot
CN207290103U (en) * 2017-07-03 2018-05-01 安徽建筑大学 A kind of intelligence pickup robot
CN209319770U (en) * 2018-10-24 2019-08-30 国网江苏省电力有限公司徐州供电分公司 An intelligent control system of a dual-arm robot for live work
CN109702707A (en) * 2019-01-04 2019-05-03 中科开创(广州)智能科技发展有限公司 A kind of distribution network live line work robot

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101168254A (en) * 2006-10-25 2008-04-30 上海求是机器人有限公司 Swinging arm type transmission line polling robot
CN110673634A (en) * 2019-11-12 2020-01-10 合肥工业大学 A power inspection drone path planning method and a transmission line inspection method

Also Published As

Publication number Publication date
CN112838516A (en) 2021-05-25

Similar Documents

Publication Publication Date Title
CN102975191B (en) Line-walking robot system for overhead transmission line
CN106493708B (en) A control system for a live working robot based on dual mechanical arms and auxiliary arms
CN108286949B (en) Movable three-dimensional detection robot system
CN106695748A (en) Hot-line robot with double mechanical arms
CN107053188A (en) A kind of hot line robot branch connects gage lap method
CN106786140B (en) A kind of hot line robot strain insulator replacing options
CN109910011B (en) Multi-sensor-based mechanical arm obstacle avoidance method and mechanical arm
CN106826756A (en) A kind of conducting wire mending method based on robot for high-voltage hot-line work
CN106595762B (en) A detection method for tension insulators of live working robots
CN102941570A (en) Patrol robot for power transmission lines
CN106737547A (en) A kind of hot line robot
CN110421557A (en) Environmental perspective perception and the safe early warning of distribution network live line work robot protect system and method
CN102938544B (en) A kind of transmission line active obstacle travelling robot
CN105013733B (en) Transformer substation live washing auxiliary washing robot and method
CN206840057U (en) A kind of hot line robot control system based on double mechanical arms and sub-arm
CN108582031A (en) A kind of hot line robot branch based on force feedback master & slave control connects gage lap method
CN103753586A (en) Method for coarse-fine composite closed-loop control of position of mechanical arm
CN112838516B (en) Overhead conductor robot live working device and method
CN106695883A (en) Method of detecting vacuum circuit breaker of live operation robot
CN206510017U (en) A kind of hot line robot
CN106737862B (en) A data communication system for live working robot
CN106771805A (en) A kind of hot line robot Detecting Methods of MOA
CN106583294A (en) Method for sweeping tension insulator by live working robot
CN106965147A (en) A kind of hot line robot isolation switch detection method
CN206445826U (en) A kind of hot line robot data communication system

Legal Events

Date Code Title Description
PB01 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