Nothing Special   »   [go: up one dir, main page]

CN112894850B - Control system and control method of pole-climbing robot - Google Patents

Control system and control method of pole-climbing robot Download PDF

Info

Publication number
CN112894850B
CN112894850B CN202110108517.2A CN202110108517A CN112894850B CN 112894850 B CN112894850 B CN 112894850B CN 202110108517 A CN202110108517 A CN 202110108517A CN 112894850 B CN112894850 B CN 112894850B
Authority
CN
China
Prior art keywords
arm
pole
push rod
trunk
weight
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
CN202110108517.2A
Other languages
Chinese (zh)
Other versions
CN112894850A (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 State Grid Anhui Electric Power Co Ltd
Original Assignee
Electric Power Research Institute of State Grid Anhui Electric Power 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 State Grid Anhui Electric Power Co Ltd filed Critical Electric Power Research Institute of State Grid Anhui Electric Power Co Ltd
Priority to CN202110108517.2A priority Critical patent/CN112894850B/en
Publication of CN112894850A publication Critical patent/CN112894850A/en
Application granted granted Critical
Publication of CN112894850B publication Critical patent/CN112894850B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666Avoiding collision or forbidden zones
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1689Teleoperation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme 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
    • B25J9/1697Vision controlled systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

The invention discloses a pole-climbing robot control system and a control method thereof. According to the invention, the electric power overhaul operation is replaced by controlling the pole-climbing robot, so that the full-automatic pole-climbing overhaul operation can be realized, or under a more complex working condition, the manual remote control operation can greatly reduce the labor intensity of workers and the construction danger coefficient.

Description

Control system and control method of pole-climbing robot
Technical Field
The invention relates to the technical field of robot control systems, in particular to a pole-climbing robot control system and a control method thereof.
Background
The robot system is an integral body formed by the robot, the working objects and the environment, wherein the robot system comprises a mechanical system, a driving system, a control system and a perception system, the robot is an automatic machine, and the robot has intelligent capabilities similar to people or living things, such as perception capability, planning capability, action capability and coordination capability, and is an automatic machine with high flexibility.
With the continuous development of modern society, the number of urban power transmission lines is gradually increased, in theory, the power transmission lines are less influenced by external environment factors, and the safe operation reliability is higher, but in practice, the wires on the power transmission lines and insulators inevitably have the influence of external factors in a long-term external open environment, for example, dirt such as dust and bird droppings are attached after a period of operation, and the problems can finally cause the rise of the failure rate of the power transmission lines, so that the power failure accident frequently occurs, and therefore, the power transmission lines need to be overhauled.
Firstly, the inspection and maintenance of the domestic transmission line are mostly completed manually, and as the outdoor operation is performed, the maintainer needs to bear the trouble of blowing, drying and rain while climbing, the working condition is hard, and the working strength is high;
secondly, when electric power overhauls, often need live working, the manual work has great potential safety hazard with electrified equipment short distance contact, because the improper operation or not obey the safety regulation or because of unexpected circumstances takes place, very easily takes place great incident.
Disclosure of Invention
In order to solve the above-mentioned problems in the prior art, a control system of a pole-climbing robot and a control method thereof are provided.
In order to achieve the above purpose, the present invention adopts the following technical scheme:
the control system of the pole-climbing robot comprises the pole-climbing robot, wherein the pole-climbing robot is connected with wireless remote control equipment;
the pole-climbing robot comprises a pole-climbing robot body, a weight-holding arm and a working tool;
the pole-climbing robot body comprises a left side actuating mechanism, a right side actuating mechanism and a trunk actuating mechanism;
the robot controller is arranged on the trunk action mechanism, and the binocular camera and the laser radar sensor are respectively arranged at the upper end part and the lower end part of the pole-climbing robot body;
the robot controller is used for receiving the operation environment data and sending the operation environment data to the binocular camera and the laser radar sensor on the robot controller;
the left side action mechanism comprises a left arm upper push rod mechanism, a left arm lower driving wheel lifting mechanism and a left trunk shoulder joint mechanism;
the left arm upper push rod mechanism is provided with a left arm upper push rod loose rod in-place sensor and a left arm upper push rod holding rod in-place sensor;
the left arm lower push rod mechanism is provided with a left arm lower push rod loose rod in-place sensor and a left arm lower push rod holding rod in-place sensor;
the left trunk shoulder joint mechanism is provided with a left trunk shoulder joint outward-rotation in-place sensor and a left trunk joint mechanism inward-rotation in-place sensor;
the right side action mechanism comprises a right arm upper push rod mechanism, a right arm lower driving wheel lifting mechanism and a right trunk shoulder joint mechanism;
the right arm upper push rod mechanism is provided with a right arm upper push rod loose rod in-place sensor and a right arm upper push rod holding rod in-place sensor;
the right arm lower push rod mechanism is provided with a right arm lower push rod loose rod in-place sensor and a right arm lower push rod holding rod in-place sensor;
the right trunk shoulder joint mechanism is provided with a right trunk shoulder joint outward-rotation in-place sensor and a right trunk joint mechanism inward-rotation in-place sensor;
the weight-holding arm comprises a weight-holding arm rotating shaft, a weight-holding upper and lower shaft and a weight-holding arm tool shaft, wherein the weight-holding upper and lower shaft is arranged on the weight-holding arm rotating shaft, the weight-holding arm tool shaft is arranged on the weight-holding upper and lower shaft, and the working tool is arranged on the weight-holding arm tool shaft;
the weight-bearing arm rotating shaft is provided with a weight-bearing arm rotating shaft original point sensor, the weight-bearing upper and lower shafts are provided with weight-bearing upper and lower shaft original point sensors, and the weight-bearing arm tool shaft is provided with a weight-bearing arm tool shaft original point sensor;
the trunk actuating mechanism is provided with a trunk lifting in-place sensor and a trunk descending sensor;
the robot controller is connected with the wireless remote control equipment and used for realizing the connection between the pole-climbing robot and the robot controller.
As a further description of the above technical solution:
the robot controller comprises a controller, a controller output module, a controller input module, a controller communication interface and a controller wireless communication interface;
the controller output module is correspondingly connected with the left arm upper push rod mechanism, the left arm lower driving wheel lifting mechanism, the left trunk shoulder joint mechanism, the right arm upper push rod mechanism, the right arm lower driving wheel lifting mechanism, the right trunk shoulder joint mechanism, the trunk action mechanism, the weight holding arm and the working tool;
the controller input modules are respectively and correspondingly connected with a left arm upper push rod loose lever in-place sensor, a left arm upper push rod holding lever in-place sensor, a left arm lower push rod loose lever in-place sensor, a left arm lower push rod holding lever in-place sensor, a left trunk shoulder joint out-of-position sensor, a left trunk joint inner rotation in-place sensor, a right arm upper push rod loose lever in-place sensor, a right arm upper push rod holding lever in-place sensor, a right arm lower push rod loose lever in-place sensor, a right arm lower push rod holding lever in-place sensor, a right trunk shoulder joint out-of-position sensor, a right trunk inner rotation in-place sensor, a trunk ascending in-place sensor, a trunk descending-in-place sensor, a weight holding arm rotating shaft origin sensor, a weight holding upper and lower shaft origin sensor and a weight holding arm tool axis origin sensor;
the controller communication interface is connected with the binocular camera and the laser radar sensor;
the wireless communication interface of the controller is connected with the wireless remote control equipment.
As a further description of the above technical solution:
the robot controller comprises an automatic mode and a manual mode, the automatic mode comprises a pole climbing process, the manual mode comprises a pole climbing process and a working process, and the working process and the manual mode after the automatic mode is finished are controlled by the wireless remote control device.
As a further description of the above technical solution:
a control method of a pole-climbing robot control system comprises an automatic mode and a manual mode, wherein the pole-climbing process of the automatic mode comprises the following specific steps:
sz1, a robot controller sends out a rod loosening and holding action starting instruction of a rod climbing robot, the left arm and the right arm need to act alternately according to an action flow, and when the robot controller sends out an instruction to be the left arm starting instruction, the action flow of the left arm is started;
sz2, the upper push rod mechanism of the left arm and the lower push rod mechanism of the left arm act simultaneously, and when signals of the in-place sensor of the upper push rod of the left arm and the in-place sensor of the lower push rod of the right arm are triggered, the action of loosening the rod is completed;
sz3, the left arm upper push rod mechanism and the left arm lower push rod mechanism are both loose in place, the left arm lower driving wheel lifting mechanism performs retracting action, after the left arm lower driving wheel lifting mechanism is retracted, the left trunk shoulder joint mechanism outwards-rotating action is started, and after the left trunk shoulder joint mechanism outwards-rotating in-place sensor signal is triggered, the left trunk shoulder joint mechanism outwards-rotating action is completed;
sz4, after the outward rotation of the left trunk shoulder joint mechanism is completed, the trunk action mechanism decides whether to ascend or descend according to the instruction;
when the robot controller requires to ascend, when the trunk ascends in-place sensor signal is triggered, the trunk actuating mechanism is indicated to ascend;
when the robot controller requires descending, when the trunk descends to the proper position and the sensor signal is triggered, the trunk action mechanism is indicated to complete the descending action;
sz5, step Sz2 to step Sz4 are left arm loosening processes, and after left arm loosening is completed, a left arm holding process is performed;
sz6, the internal rotation action of the left trunk joint mechanism is started, when the internal rotation in-place sensor signal of the left trunk shoulder joint is triggered, the internal rotation of the left trunk joint mechanism is in place, and the action is completed;
sz7, after the left arm lower driving wheel lifting mechanism is lowered in place, the left arm upper push rod mechanism and the left arm lower push rod mechanism act simultaneously, and when signals of the left arm upper push rod holding rod in-place sensor and the left arm lower push rod holding rod in-place sensor are triggered, the holding rod action is completed;
sz8, when the robot controller sends a command to start the right arm, the action process of the right arm is identical to the action process of the left arm.
As a further description of the above technical solution:
in step Sz4, after the outward rotation of the left trunk and shoulder joint mechanism is completed, when the trunk actuating mechanism decides whether to ascend or descend, the obstacle detection is performed in advance, and when the obstacle is encountered, the obstacle avoidance mode is performed, and the specific flow steps of the obstacle avoidance mode are as follows:
sb1, presetting a safe distance of a pole climbing robot pole climbing in a robot controller;
sb2, after the laser radar sensor detects an obstacle, the laser radar sensor sends data to the robot controller, and the robot controller calculates the distance between the obstacle and the pole-climbing robot through calculation;
sb3, if the distance is greater than the safety distance, the pole climbing robot continues to execute pole climbing action, and if the distance is less than the safety distance, the robot controller re-plans a reasonable path to avoid the obstacle.
As a further description of the above technical solution:
in the automatic mode, the pole-climbing robot always needs to rely on the binocular camera and the laser radar sensor to perform sensing construction on surrounding working environments, so that the pole-climbing robot can recognize cables in the environments and obstacles in the pole-climbing process, and the specific environment sensing process is as follows:
sg1, collecting laser radar data of a working environment by a laser radar sensor, extracting data of a sensing interval after median filtering treatment, and carrying out cluster analysis on the data of the sensing interval;
sg2, further performing eigenvalue analysis after cluster analysis, comparing the existing database, determining correct data, converting the correct data into a coordinate system of a binocular camera, and facilitating subsequent data fusion;
sg3, acquiring data of a working environment by a binocular camera sensor, acquiring RGB data of an image, and then carrying out graying treatment;
sg 4. the data information after the graying treatment and the information data obtained by the laser radar sensor are fused under the same coordinate system, a sensing interval after the data fusion is extracted, the characteristic value of the working environment is inquired in the existing database, and the data characteristic value identification is carried out on the sensing interval after the data fusion;
sg5, calculating information of the target object according to the characteristic value of the target data in the identified fusion data, and finally giving coordinate data of the target object to the robot controller to help guide the pole-climbing robot to complete the appointed function.
As a further description of the above technical solution:
a control method of a pole-climbing robot control system comprises the following specific steps of:
the action process of the Sh1 and the pole-climbing robot is consistent with an automatic mode, and the difference is that:
each action executed by the pole-climbing robot is controlled by the wireless remote control equipment, and the pole-climbing robot is controlled by the wireless remote control equipment to avoid obstacles when encountering obstacles in the crawling process, so that the pole-climbing robot completes the pole-climbing process;
when the Sh2 and the rotation shaft of the weight-holding arm need to return to the original point, the rotation shaft of the weight-holding arm is remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the rotation original point sensor signal of the weight-holding arm is triggered, the rotation shaft of the weight-holding arm is stopped, and the zeroing action is completed;
when the Sh3, the upper and lower axes of the weight-bearing arm need to return to the original point, the upper and lower axes of the weight-bearing arm are remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the original point sensor signals of the upper and lower axes of the weight-bearing arm are triggered, the upper and lower axes of the weight-bearing arm are stopped, and the zeroing action is completed;
when the Sh4 and the weight-holding arm tool shaft need to return to the original point, the wireless remote control equipment is used for remotely controlling the weight-holding arm tool shaft to move towards the original point direction, and when the original point sensor signal of the weight-holding arm tool shaft is triggered, the weight-holding arm tool shaft is stopped, and the zeroing action is completed.
As a further description of the above technical solution:
the operation after the end of the automatic mode corresponds to steps Sh2 to Sh4 in the manual mode.
In summary, due to the adoption of the technical scheme, the beneficial effects of the invention are as follows:
the electric power overhauling operation is replaced by controlling the pole-climbing robot, so that the full-automatic pole-climbing overhauling operation can be realized, or under more complex working conditions, the labor intensity of workers can be greatly reduced, and the construction danger coefficient can be reduced by manual remote control operation.
Drawings
Fig. 1 shows a connection schematic diagram of a control system of a pole-climbing robot control system and a control method thereof according to an embodiment of the present invention;
fig. 2 is a schematic diagram of a rod loosening action flow of a rod climbing robot according to the rod climbing robot control system and the control method thereof according to the embodiment of the invention;
fig. 3 is a schematic diagram of a grip of a climbing robot according to an embodiment of the present invention;
fig. 4 is a schematic view of an obstacle avoidance flow in an automatic mode of a pole-climbing robot according to an embodiment of the present invention;
fig. 5 shows a schematic flow diagram of an environment sensing function when a pole-climbing robot moves in a pole-climbing robot control system and a control method thereof according to an embodiment of the invention.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
Example 1
Referring to fig. 1-5, the present invention provides a technical solution: a pole-climbing robot control system comprises a pole-climbing robot, wherein a wireless remote control device is connected to the pole-climbing robot;
the pole-climbing robot comprises a pole-climbing robot body, a weight-holding arm and a working tool;
the pole-climbing robot body comprises a left side action mechanism, a right side action mechanism and a trunk action mechanism;
the robot controller is arranged on the trunk action mechanism, and the binocular camera and the laser radar sensor are respectively arranged at the upper end part and the lower end part of the pole-climbing robot body;
the robot controller is used for receiving the operation environment data and sending the operation environment data to the binocular camera and the laser radar sensor on the robot controller;
the left side action mechanism comprises a left arm upper push rod mechanism, a left arm lower driving wheel lifting mechanism and a left trunk shoulder joint mechanism;
the left arm upper push rod mechanism is provided with a left arm upper push rod loose rod in-place sensor and a left arm upper push rod holding rod in-place sensor;
the left arm lower push rod mechanism is provided with a left arm lower push rod loose rod in-place sensor and a left arm lower push rod holding rod in-place sensor;
the left trunk shoulder joint mechanism is provided with a left trunk shoulder joint outward-rotation in-place sensor and a left trunk joint mechanism inward-rotation in-place sensor;
the right side action mechanism comprises a right arm upper push rod mechanism, a right arm lower driving wheel lifting mechanism and a right trunk shoulder joint mechanism;
the right arm upper push rod mechanism is provided with a right arm upper push rod loose rod in-place sensor and a right arm upper push rod holding rod in-place sensor;
the right arm lower push rod mechanism is provided with a right arm lower push rod loose rod in-place sensor and a right arm lower push rod holding rod in-place sensor;
the right trunk shoulder joint mechanism is provided with a right trunk shoulder joint outward-rotation in-place sensor and a right trunk joint mechanism inward-rotation in-place sensor;
the weight-bearing arm comprises a weight-bearing arm rotating shaft, a weight-bearing upper and lower shaft and a weight-bearing arm tool shaft, wherein the weight-bearing upper and lower shaft is arranged on the weight-bearing arm rotating shaft, the weight-bearing arm tool shaft is arranged on the weight-bearing upper and lower shaft, and the working tool is arranged on the weight-bearing arm tool shaft;
the weight-bearing arm rotating shaft is provided with a weight-bearing arm rotating shaft original point sensor, the weight-bearing upper and lower shafts are provided with weight-bearing upper and lower shaft original point sensors, and the weight-bearing arm tool shaft is provided with a weight-bearing arm tool shaft original point sensor;
the trunk actuating mechanism is provided with a trunk lifting in-place sensor and a trunk descending sensor;
the robot controller is connected with the wireless remote control equipment and used for realizing the connection between the pole-climbing robot and the robot controller.
Referring to fig. 1, the robot controller includes a controller, a controller output module, a controller input module, a controller communication interface, and a controller wireless communication interface;
the controller output module is correspondingly connected with the left arm upper push rod mechanism, the left arm lower driving wheel lifting mechanism, the left trunk shoulder joint mechanism, the right arm upper push rod mechanism, the right arm lower driving wheel lifting mechanism, the right trunk shoulder joint mechanism, the trunk action mechanism, the weight holding arm and the working tool;
the controller input modules are respectively and correspondingly connected with a left arm upper push rod loose lever in-place sensor, a left arm upper push rod holding lever in-place sensor, a left arm lower push rod loose lever in-place sensor, a left arm lower push rod holding lever in-place sensor, a left trunk shoulder joint out-of-position sensor, a left trunk joint inner rotation in-place sensor, a right arm upper push rod loose lever in-place sensor, a right arm upper push rod holding lever in-place sensor, a right arm lower push rod loose lever in-place sensor, a right arm lower push rod holding lever in-place sensor, a right trunk shoulder joint out-of-position sensor, a right trunk down-of-position sensor, a weight holding arm rotating shaft original point sensor, a weight holding upper and lower shaft original point sensor and a weight holding arm tool shaft original point sensor;
the controller communication interface is connected with the binocular camera and the laser radar sensor;
the controller wireless communication interface is connected with the wireless remote control device.
Referring to fig. 2 and 3, the robot controller includes an automatic mode including a pole climbing process and a manual mode including a pole climbing process and a working process, and the working process after the automatic mode is finished and the manual mode are controlled by the wireless remote control device.
Referring to fig. 2 and 3, a control method of a pole-climbing robot control system includes an automatic mode and a manual mode, wherein a pole-climbing process in the automatic mode specifically includes the following steps:
sz1, a robot controller sends out a rod loosening and holding action starting instruction of a rod climbing robot, the left arm and the right arm need to act alternately according to an action flow, and when the robot controller sends out an instruction to be the left arm starting instruction, the action flow of the left arm is started;
sz2, the upper push rod mechanism of the left arm and the lower push rod mechanism of the left arm act simultaneously, and when signals of the in-place sensor of the upper push rod of the left arm and the in-place sensor of the lower push rod of the right arm are triggered, the action of loosening the rod is completed;
sz3, the left arm upper push rod mechanism and the left arm lower push rod mechanism are both loose in place, the left arm lower driving wheel lifting mechanism performs retracting action, after the left arm lower driving wheel lifting mechanism is retracted, the left trunk shoulder joint mechanism outwards-rotating action is started, and after the left trunk shoulder joint mechanism outwards-rotating in-place sensor signal is triggered, the left trunk shoulder joint mechanism outwards-rotating action is completed;
sz4, after the outward rotation of the left trunk shoulder joint mechanism is completed, the trunk action mechanism decides whether to ascend or descend according to the instruction;
when the robot controller requires to ascend, when the trunk ascends in-place sensor signal is triggered, the trunk actuating mechanism is indicated to ascend;
when the robot controller requires descending, when the trunk descends to the proper position and the sensor signal is triggered, the trunk action mechanism is indicated to complete the descending action;
sz5, step Sz2 to step Sz4 are left arm loosening processes, and after left arm loosening is completed, a left arm holding process is performed;
sz6, the internal rotation action of the left trunk joint mechanism is started, when the internal rotation in-place sensor signal of the left trunk shoulder joint is triggered, the internal rotation of the left trunk joint mechanism is in place, and the action is completed;
sz7, after the left arm lower driving wheel lifting mechanism is lowered in place, the left arm upper push rod mechanism and the left arm lower push rod mechanism act simultaneously, and when signals of the left arm upper push rod holding rod in-place sensor and the left arm lower push rod holding rod in-place sensor are triggered, the holding rod action is completed;
sz8, when the robot controller sends a command to start the right arm, the action process of the right arm is identical to the action process of the left arm.
Referring to fig. 4, in step Sz4, after the outward rotation of the left trunk shoulder joint mechanism is completed, the trunk actuating mechanism determines whether to ascend or descend, and when encountering an obstacle, the obstacle avoidance mode is performed, and the specific flow steps of the obstacle avoidance mode are as follows:
sb1, presetting a safe distance of a pole climbing robot pole climbing in a robot controller;
sb2, after the laser radar sensor detects an obstacle, the laser radar sensor sends data to the robot controller, and the robot controller calculates the distance between the obstacle and the pole-climbing robot through calculation;
sb3, if the distance is greater than the safety distance, the pole climbing robot continues to execute pole climbing action, and if the distance is less than the safety distance, the robot controller re-plans a reasonable path to avoid the obstacle.
Referring to fig. 5, in the automatic mode, the pole-climbing robot always needs to rely on the binocular camera and the lidar sensor to perform sensing construction on surrounding working environments, so that the pole-climbing robot can identify cables in the environments and obstacles in the pole-climbing process, and the specific environment sensing process is as follows:
sg1, collecting laser radar data of a working environment by a laser radar sensor, extracting data of a sensing interval after median filtering treatment, and carrying out cluster analysis on the data of the sensing interval;
wherein, cluster analysis is: analyzing which are irrelevant things in the working environment and which are important things in the working environment;
sg2, further performing eigenvalue analysis after cluster analysis, comparing the existing database, determining correct data, converting the correct data into a coordinate system of a binocular camera, and facilitating subsequent data fusion;
sg3, the binocular camera sensor acquires image data of a working environment, RGB data of the image are acquired, and then graying treatment is carried out;
sg 4. the data information after the graying treatment and the information data obtained by the laser radar sensor are fused under the same coordinate system, a sensing interval after the data fusion is extracted, the characteristic value of the working environment is inquired in the existing database, and the data characteristic value identification is carried out on the sensing interval after the data fusion;
sg5, calculating information of the target object according to the characteristic value of the target data in the identified fusion data, and finally giving coordinate data of the target object to the robot controller to help guide the pole-climbing robot to complete the appointed function.
Referring to fig. 1-3, a control method of a pole-climbing robot control system is characterized by comprising the following specific steps of:
the action process of the Sh1 and the pole-climbing robot is consistent with an automatic mode, and the difference is that:
each action executed by the pole-climbing robot is controlled by the wireless remote control equipment, and the pole-climbing robot is controlled by the wireless remote control equipment to avoid obstacles when encountering obstacles in the crawling process, so that the pole-climbing robot completes the pole-climbing process;
when the Sh2 and the rotation shaft of the weight-holding arm need to return to the original point, the rotation shaft of the weight-holding arm is remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the rotation original point sensor signal of the weight-holding arm is triggered, the rotation shaft of the weight-holding arm is stopped, and the zeroing action is completed;
when the Sh3, the upper and lower axes of the weight-bearing arm need to return to the original point, the upper and lower axes of the weight-bearing arm are remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the original point sensor signals of the upper and lower axes of the weight-bearing arm are triggered, the upper and lower axes of the weight-bearing arm are stopped, and the zeroing action is completed;
when the Sh4 and the weight-holding arm tool shaft need to return to the original point, the wireless remote control equipment is used for remotely controlling the weight-holding arm tool shaft to move towards the original point direction, and when the original point sensor signal of the weight-holding arm tool shaft is triggered, the weight-holding arm tool shaft is stopped, and the zeroing action is completed.
The operation after the end of the automatic mode corresponds to the steps Sh2 to Sh4 in the manual mode.
The foregoing is only a preferred embodiment of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art, who is within the scope of the present invention, should make equivalent substitutions or modifications according to the technical scheme of the present invention and the inventive concept thereof, and should be covered by the scope of the present invention.

Claims (8)

1. The utility model provides a pole-climbing robot control system, includes pole-climbing robot, be connected with wireless remote control equipment on the pole-climbing robot, its characterized in that:
the pole-climbing robot comprises a pole-climbing robot body, a weight-holding arm and a working tool;
the pole-climbing robot body comprises a left side actuating mechanism, a right side actuating mechanism and a trunk actuating mechanism;
the robot controller is arranged on the trunk action mechanism, and the binocular camera and the laser radar sensor are respectively arranged at the upper end part and the lower end part of the pole-climbing robot body;
the robot controller is used for receiving the operation environment data and sending the operation environment data to the binocular camera and the laser radar sensor on the robot controller;
the left side action mechanism comprises a left arm upper push rod mechanism, a left arm lower driving wheel lifting mechanism and a left trunk shoulder joint mechanism;
the left arm upper push rod mechanism is provided with a left arm upper push rod loose rod in-place sensor and a left arm upper push rod holding rod in-place sensor;
the left arm lower push rod mechanism is provided with a left arm lower push rod loose rod in-place sensor and a left arm lower push rod holding rod in-place sensor;
the left trunk shoulder joint mechanism is provided with a left trunk shoulder joint outward-rotation in-place sensor and a left trunk joint mechanism inward-rotation in-place sensor;
the right side action mechanism comprises a right arm upper push rod mechanism, a right arm lower driving wheel lifting mechanism and a right trunk shoulder joint mechanism;
the right arm upper push rod mechanism is provided with a right arm upper push rod loose rod in-place sensor and a right arm upper push rod holding rod in-place sensor;
the right arm lower push rod mechanism is provided with a right arm lower push rod loose rod in-place sensor and a right arm lower push rod holding rod in-place sensor;
the right trunk shoulder joint mechanism is provided with a right trunk shoulder joint outward-rotation in-place sensor and a right trunk joint mechanism inward-rotation in-place sensor;
the weight-holding arm comprises a weight-holding arm rotating shaft, a weight-holding upper and lower shaft and a weight-holding arm tool shaft, wherein the weight-holding upper and lower shaft is arranged on the weight-holding arm rotating shaft, the weight-holding arm tool shaft is arranged on the weight-holding upper and lower shaft, and the working tool is arranged on the weight-holding arm tool shaft;
the weight-bearing arm rotating shaft is provided with a weight-bearing arm rotating shaft original point sensor, the weight-bearing upper and lower shafts are provided with weight-bearing upper and lower shaft original point sensors, and the weight-bearing arm tool shaft is provided with a weight-bearing arm tool shaft original point sensor;
the trunk actuating mechanism is provided with a trunk lifting in-place sensor and a trunk descending sensor;
the robot controller is connected with the wireless remote control equipment and used for realizing the connection between the pole-climbing robot and the robot controller.
2. The pole-climbing robot control system of claim 1, wherein the robot controller comprises a controller, a controller output module, a controller input module, a controller communication interface, a controller wireless communication interface;
the controller output module is correspondingly connected with the left arm upper push rod mechanism, the left arm lower driving wheel lifting mechanism, the left trunk shoulder joint mechanism, the right arm upper push rod mechanism, the right arm lower driving wheel lifting mechanism, the right trunk shoulder joint mechanism, the trunk action mechanism, the weight holding arm and the working tool;
the controller input modules are respectively and correspondingly connected with a left arm upper push rod loose lever in-place sensor, a left arm upper push rod holding lever in-place sensor, a left arm lower push rod loose lever in-place sensor, a left arm lower push rod holding lever in-place sensor, a left trunk shoulder joint out-of-position sensor, a left trunk joint inner rotation in-place sensor, a right arm upper push rod loose lever in-place sensor, a right arm upper push rod holding lever in-place sensor, a right arm lower push rod loose lever in-place sensor, a right arm lower push rod holding lever in-place sensor, a right trunk shoulder joint out-of-position sensor, a right trunk inner rotation in-place sensor, a trunk ascending in-place sensor, a trunk descending-in-place sensor, a weight holding arm rotating shaft origin sensor, a weight holding upper and lower shaft origin sensor and a weight holding arm tool axis origin sensor;
the controller communication interface is connected with the binocular camera and the laser radar sensor;
the wireless communication interface of the controller is connected with the wireless remote control equipment.
3. The pole-climbing robot control system according to claim 2, wherein the robot controller includes an automatic mode including a pole-climbing process and a manual mode including a pole-climbing process and a work process, and the work process after the end of the automatic mode and the manual mode are controlled by the wireless remote control device.
4. A control method of a pole-climbing robot control system according to any one of claims 1-3, characterized by comprising an automatic mode and a manual mode, wherein the pole-climbing procedure of the automatic mode comprises the following specific steps:
sz1, a robot controller sends out a rod loosening and holding action starting instruction of a rod climbing robot, the left arm and the right arm need to act alternately according to an action flow, and when the robot controller sends out an instruction to be the left arm starting instruction, the action flow of the left arm is started;
sz2, the upper push rod mechanism of the left arm and the lower push rod mechanism of the left arm act simultaneously, and when signals of the in-place sensor of the upper push rod of the left arm and the in-place sensor of the lower push rod of the right arm are triggered, the action of loosening the rod is completed;
sz3, the left arm upper push rod mechanism and the left arm lower push rod mechanism are both loose in place, the left arm lower driving wheel lifting mechanism performs retracting action, after the left arm lower driving wheel lifting mechanism is retracted, the left trunk shoulder joint mechanism outwards-rotating action is started, and after the left trunk shoulder joint mechanism outwards-rotating in-place sensor signal is triggered, the left trunk shoulder joint mechanism outwards-rotating action is completed;
sz4, after the outward rotation of the left trunk shoulder joint mechanism is completed, the trunk action mechanism decides whether to ascend or descend according to the instruction;
when the robot controller requires to ascend, when the trunk ascends in-place sensor signal is triggered, the trunk actuating mechanism is indicated to ascend;
when the robot controller requires descending, when the trunk descends to the proper position and the sensor signal is triggered, the trunk action mechanism is indicated to complete the descending action;
sz5, step Sz2 to step Sz4 are left arm loosening processes, and after left arm loosening is completed, a left arm holding process is performed;
sz6, the internal rotation action of the left trunk joint mechanism is started, when the internal rotation in-place sensor signal of the left trunk shoulder joint is triggered, the internal rotation of the left trunk joint mechanism is in place, and the action is completed;
sz7, after the left arm lower driving wheel lifting mechanism is lowered in place, the left arm upper push rod mechanism and the left arm lower push rod mechanism act simultaneously, and when signals of the left arm upper push rod holding rod in-place sensor and the left arm lower push rod holding rod in-place sensor are triggered, the holding rod action is completed;
sz8, when the robot controller sends a command to start the right arm, the action process of the right arm is identical to the action process of the left arm.
5. The control method of a pole-climbing robot control system according to claim 4, wherein in step Sz4, after the outward rotation of the left trunk shoulder joint mechanism is completed, the trunk actuating mechanism decides whether to ascend or descend, and when encountering an obstacle, an obstacle avoidance mode is performed, and the specific flow steps of the obstacle avoidance mode are as follows:
sb1, presetting a safe distance of a pole climbing robot pole climbing in a robot controller;
sb2, after the laser radar sensor detects an obstacle, the laser radar sensor sends data to the robot controller, and the robot controller calculates the distance between the obstacle and the pole-climbing robot through calculation;
sb3, if the distance is greater than the safety distance, the pole climbing robot continues to execute pole climbing action, and if the distance is less than the safety distance, the robot controller re-plans a reasonable path to avoid the obstacle.
6. The control method of a pole-climbing robot control system according to claim 5, wherein in the automatic mode, the pole-climbing robot always needs to rely on a binocular camera and a laser radar sensor to perform sensing construction on surrounding working environments, so that the pole-climbing robot can recognize cables in the environments and obstacles in the pole-climbing process, and the specific environment sensing process is as follows:
sg1, collecting laser radar data of a working environment by a laser radar sensor, extracting sensing interval data after median filtering treatment, and carrying out cluster analysis on the sensing interval data;
sg2, further performing eigenvalue analysis after cluster analysis, comparing the existing database, determining correct data, converting the correct data into a coordinate system of a binocular camera, and facilitating subsequent data fusion;
sg3, the binocular camera sensor acquires image data of a working environment, RGB data of the image are acquired, and then graying treatment is carried out;
sg 4. the data information after the graying treatment and the information data obtained by the laser radar sensor are fused under the same coordinate system, a sensing interval after the data fusion is extracted, the characteristic value of the working environment is inquired in the existing database, and the data characteristic value identification is carried out on the sensing interval after the data fusion;
sg5, calculating information of the target object according to the characteristic value of the target data in the identified fusion data, and finally giving coordinate data of the target object to the robot controller to help guide the pole-climbing robot to complete the appointed function.
7. The control method of a pole-climbing robot control system according to claim 4, wherein the manual mode comprises the following specific steps:
the action process of the Sh1 and the pole-climbing robot is consistent with an automatic mode, and the difference is that:
each action executed by the pole-climbing robot is controlled by the wireless remote control equipment, and the pole-climbing robot is controlled by the wireless remote control equipment to avoid obstacles when encountering obstacles in the crawling process, so that the pole-climbing robot completes the pole-climbing process;
when the Sh2 and the rotation shaft of the weight-holding arm need to return to the original point, the rotation shaft of the weight-holding arm is remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the rotation original point sensor signal of the weight-holding arm is triggered, the rotation shaft of the weight-holding arm is stopped, and the zeroing action is completed;
when the Sh3, the upper and lower axes of the weight-bearing arm need to return to the original point, the upper and lower axes of the weight-bearing arm are remotely controlled by the wireless remote control equipment to move towards the original point direction, and when the original point sensor signals of the upper and lower axes of the weight-bearing arm are triggered, the upper and lower axes of the weight-bearing arm are stopped, and the zeroing action is completed;
when the Sh4 and the weight-holding arm tool shaft need to return to the original point, the wireless remote control equipment is used for remotely controlling the weight-holding arm tool shaft to move towards the original point direction, and when the original point sensor signal of the weight-holding arm tool shaft is triggered, the weight-holding arm tool shaft is stopped, and the zeroing action is completed.
8. The control method of a pole-climbing robot control system according to claim 7, wherein the operation process after the end of the automatic mode coincides with steps Sh2 to Sh4 in the manual mode.
CN202110108517.2A 2021-01-27 2021-01-27 Control system and control method of pole-climbing robot Active CN112894850B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110108517.2A CN112894850B (en) 2021-01-27 2021-01-27 Control system and control method of pole-climbing robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110108517.2A CN112894850B (en) 2021-01-27 2021-01-27 Control system and control method of pole-climbing robot

Publications (2)

Publication Number Publication Date
CN112894850A CN112894850A (en) 2021-06-04
CN112894850B true CN112894850B (en) 2023-11-17

Family

ID=76120540

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110108517.2A Active CN112894850B (en) 2021-01-27 2021-01-27 Control system and control method of pole-climbing robot

Country Status (1)

Country Link
CN (1) CN112894850B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112894850B (en) * 2021-01-27 2023-11-17 国网安徽省电力有限公司电力科学研究院 Control system and control method of pole-climbing robot

Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4937759A (en) * 1986-02-18 1990-06-26 Robotics Research Corporation Industrial robot with controller
US4975856A (en) * 1986-02-18 1990-12-04 Robotics Research Corporation Motion controller for redundant or nonredundant linkages
CN101327589A (en) * 2008-07-10 2008-12-24 上海交通大学 Control system and method for instruction input and configuration of remote-operation planar redundant manipulator
JP2009113190A (en) * 2007-11-09 2009-05-28 Toyota Motor Corp Autonomous working robot and method of controlling operation of autonomous working robot
WO2011017668A2 (en) * 2009-08-06 2011-02-10 The Regents Of The University Of California Multimodal dynamic robotic systems
US8406989B1 (en) * 2009-02-13 2013-03-26 Hrl Laboratories, Llc Method for adaptive obstacle avoidance for articulated redundant robot arm
WO2018108098A1 (en) * 2016-12-14 2018-06-21 国网江苏省电力公司常州供电公司 Autonomous operation method for live working robot based on multi-sensor information fusion
CN109199838A (en) * 2018-10-19 2019-01-15 黄颖琦 A kind of automatic hammering robot system
CN109571404A (en) * 2018-12-12 2019-04-05 杭州申昊科技股份有限公司 A kind of barrier getting over mechanism, obstacle detouring intelligent inspection robot and its substation's obstacle-detouring method
CN110101511A (en) * 2019-06-17 2019-08-09 青岛安捷医疗科技有限公司 The intelligent supplementary controlled system of personnel's transfer car(buggy)
CN110539316A (en) * 2019-08-02 2019-12-06 国网安徽省电力有限公司电力科学研究院 Ground potential operation method, live working robot for distribution network overhead line and manipulator
CN111360787A (en) * 2020-03-19 2020-07-03 上海交通大学 Seven-degree-of-freedom serial-parallel hybrid mechanical arm and robot
CN211193912U (en) * 2019-08-02 2020-08-07 国网安徽省电力有限公司电力科学研究院 Join in marriage net overhead line live working robot and holding rod manipulator
CN211187867U (en) * 2019-11-29 2020-08-07 淮南师范学院 Double-form intelligent nursing type wheelchair
WO2020249057A1 (en) * 2019-06-11 2020-12-17 杨铭域 Bicycle for riding in crawling posture
CN112894850A (en) * 2021-01-27 2021-06-04 国网安徽省电力有限公司电力科学研究院 Pole-climbing robot control system and control method thereof

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7645215B2 (en) * 2005-08-11 2010-01-12 Gordon Joel D Exercise device
US20200039076A1 (en) * 2016-03-04 2020-02-06 Ge Global Sourcing Llc Robotic system and method for control and manipulation

Patent Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4937759A (en) * 1986-02-18 1990-06-26 Robotics Research Corporation Industrial robot with controller
US4975856A (en) * 1986-02-18 1990-12-04 Robotics Research Corporation Motion controller for redundant or nonredundant linkages
JP2009113190A (en) * 2007-11-09 2009-05-28 Toyota Motor Corp Autonomous working robot and method of controlling operation of autonomous working robot
CN101327589A (en) * 2008-07-10 2008-12-24 上海交通大学 Control system and method for instruction input and configuration of remote-operation planar redundant manipulator
US8406989B1 (en) * 2009-02-13 2013-03-26 Hrl Laboratories, Llc Method for adaptive obstacle avoidance for articulated redundant robot arm
WO2011017668A2 (en) * 2009-08-06 2011-02-10 The Regents Of The University Of California Multimodal dynamic robotic systems
WO2018108098A1 (en) * 2016-12-14 2018-06-21 国网江苏省电力公司常州供电公司 Autonomous operation method for live working robot based on multi-sensor information fusion
CN109199838A (en) * 2018-10-19 2019-01-15 黄颖琦 A kind of automatic hammering robot system
CN109571404A (en) * 2018-12-12 2019-04-05 杭州申昊科技股份有限公司 A kind of barrier getting over mechanism, obstacle detouring intelligent inspection robot and its substation's obstacle-detouring method
WO2020249057A1 (en) * 2019-06-11 2020-12-17 杨铭域 Bicycle for riding in crawling posture
CN110101511A (en) * 2019-06-17 2019-08-09 青岛安捷医疗科技有限公司 The intelligent supplementary controlled system of personnel's transfer car(buggy)
CN110539316A (en) * 2019-08-02 2019-12-06 国网安徽省电力有限公司电力科学研究院 Ground potential operation method, live working robot for distribution network overhead line and manipulator
CN211193912U (en) * 2019-08-02 2020-08-07 国网安徽省电力有限公司电力科学研究院 Join in marriage net overhead line live working robot and holding rod manipulator
CN211187867U (en) * 2019-11-29 2020-08-07 淮南师范学院 Double-form intelligent nursing type wheelchair
CN111360787A (en) * 2020-03-19 2020-07-03 上海交通大学 Seven-degree-of-freedom serial-parallel hybrid mechanical arm and robot
CN112894850A (en) * 2021-01-27 2021-06-04 国网安徽省电力有限公司电力科学研究院 Pole-climbing robot control system and control method thereof

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
基于单片机的拟人爬杆机器人设计实现;藕艳萍;史建国;张捷;孟瑞;工业技术创新;第7卷(第005期);全文 *
多功能攀爬机器人攀爬机构和变形机构的设计;岳一领;冯鹏超;张东旭;邱志伟;马文泽;闫献国;;太原理工大学学报(第06期);全文 *
杆状物攀爬机器人关键技术综述;张连滨;葛浙东;刘传泽;曹正彬;周玉成;;计算机测量与控制(第01期);全文 *
电力铁塔攀爬机器人系统研究;庄红军;李军;王威;周海;吴瑀;候永洪;莫刚;鲁彩江;;自动化与仪器仪表(第04期);全文 *
负重爬树机器人设计及有限元分析;张连滨;鲁守银;曹正彬;刘传泽;周玉成;;制造业自动化(第07期);全文 *

Also Published As

Publication number Publication date
CN112894850A (en) 2021-06-04

Similar Documents

Publication Publication Date Title
CN109240311B (en) Outdoor electric power field construction operation supervision method based on intelligent robot
CN109683609B (en) Intelligent power inspection system and method
CN107765145B (en) Automatic partial discharge detection device, system and method
CN108789416B (en) System and method for controlling flexible live working of double mechanical arms
CN112894850B (en) Control system and control method of pole-climbing robot
CN112327851B (en) Map calibration method and system based on point cloud, robot and cloud platform
CN108190749A (en) A kind of remote control apparatus of tower crane, control method and intelligent tower crane
CN110978004A (en) Autonomous distribution network live working robot, system and method
CN110682291B (en) Robot teleoperation system based on VR and teleoperation method thereof
CN211761557U (en) Comprehensive pipe rack inspection robot
CN211104017U (en) Transformer substation inspection robot
CN110640763A (en) Comprehensive pipe rack inspection robot
CN103713259A (en) A middling pressure whole set switch equipment self-diagnosis system and method based on the Internet of Things
CN110618688A (en) Inspection robot system and control method thereof
CN107378955A (en) A kind of distribution robot for overhauling motion arm AUTONOMOUS TASK method based on multi-sensor information fusion
CN106826873A (en) A kind of transmission line polling robot visual servo grabs line control method
CN104889092A (en) Water washing robot sighting system based on ultrasonic distance measurement and image identification, and method thereof
CN104834293A (en) Substation water flushing robot visual targeting system and method
CN104858168A (en) Water washing robot aiming system and method based on laser ranging and image recognition
CN111708356A (en) Automatic path planning system and method for crane
CN111399518A (en) Multi-sensor-based cooperative robot obstacle avoidance system and control method thereof
CN203117762U (en) Transformer substation comprehensive parameter detection device based on patrolling robot
CN111823232A (en) Safety detection method for inspection robot
CN111590576A (en) Disaster relief robot in nuclear radiation environment
CN215812458U (en) Port crane health detection system based on unmanned aerial vehicle

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