Cable pipe penetrating guiding robot
By designing a cable pipe-through guide robot, the adaptive mechanism of the big arm and forearm is used to solve the problems of low efficiency and low success rate caused by pipeline terrain limitations during the cable pipe-through process, achieving high efficiency and low damage cable crossing effect.
Patent Information
- Application Number
- CN202410980094.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-29
AI Technical Summary
During the pipe-through process of existing cables, the traction is difficult due to the height drop, curved corners and obstacles in the pipe, which is inefficient and has a low success rate.
A cable pipe guide robot is designed, using the joint work of the main arm and the forearm. The control component controls the swing and adjusts the height of the main arm. The roller of the forearm and the inner wall of the cable pipe is fitted and rolled to achieve different pipeline environments. Adaptively, ensuring smooth cable crossing.
Improves the operating efficiency of cables through cable piping, reduces friction and damage, and improves success rate. It is suitable for narrow spaces and complex cable piping environments.
Smart Images

Figure CN119050902A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of substation maintenance work, and in particular to a cable pipe threading guiding robot. Background Art
[0002] During the maintenance of substations, when electrical equipment needs to be added or replaced, the secondary cables need to be re-laid accordingly. For example, when replacing an old isolating switch, the new secondary cables need to be reintroduced from the cable trench through the pipeline into the mechanism box. However, the cable pipeline is often not an ideal straight pipeline, and usually has a certain height difference, or has curved corners, or is blocked by foreign objects, which also makes the process of secondary cables passing through the pipeline more difficult.
[0003] The existing cable pipe threading method requires the cooperation of multiple people. The cable must be sent into the pipe in advance, and two to three people are reserved to push the cable at one end of the pipe. In this process, it is necessary to overcome various obstacles such as drops, corners, and obstacles in the cable pipe. After the cable passes through the pipe, two to three people are required to cooperate at the other end of the pipe to drag the cable before the cable laying can be finally completed. The whole process is time-consuming and labor-intensive, with low work efficiency. At the same time, it is limited by the terrain restrictions in the cable pipe, which can easily lead to traction failures and a low traction success rate. Summary of the invention
[0004] In view of the shortcomings of the above-mentioned prior art, the present invention provides a cable pipe threading guiding robot, which solves the technical problem that the cable pipe threading in the prior art cannot overcome the limitations of the terrain inside the pipeline, resulting in low cable traction work efficiency and low success rate.
[0005] The present invention provides a cable pipe guiding robot, comprising a robot body, wherein the robot body comprises a fuselage, a driving part, a large arm part and a small arm part; the driving part is arranged at the bottom of the fuselage; the first end of the large arm part is rotatably connected to the fuselage, the second end of the large arm part is elastically rotatably connected to the first end of the small arm part, and a roller is rotatably connected to the second end of the small arm part; a control component is arranged in the fuselage, and the control component is respectively connected to the large arm part and the driving part, and the control component is used to drive the driving part to move, and control the large arm part to swing so that the roller keeps rolling in contact with the inner wall of the cable pipe.
[0006] Optionally, the driving unit includes two driving components symmetrically installed at both ends of the bottom of the fuselage; the driving component includes a driving wheel, a first driving motor and two driving wheel brackets symmetrically installed on both sides of the fuselage; the first end of the driving wheel bracket is fixedly connected to the fuselage, and a first support shaft is fixedly connected between the two driving wheel brackets on both sides of the fuselage; the first driving motor is fixedly connected to the inside of the driving wheel, and the motor shaft of the first driving motor is connected to the second end of the driving wheel bracket; the control component is connected to the first driving motor, and is used to drive the first driving motor to rotate around the motor shaft to drive the driving wheel to rotate.
[0007] Optionally, the driving wheel comprises a plurality of arc-shaped plates; the plurality of arc-shaped plates are evenly distributed along the circumference of the driving wheel, a gap is left between two adjacent arc-shaped plates, and a plurality of circular holes are formed on the arc-shaped plates.
[0008] Optionally, the boom portion includes two boom assemblies symmetrically mounted at both ends of the fuselage; the boom assembly includes a first connecting shaft, a second drive motor and two boom arm bodies symmetrically mounted on both sides of the fuselage; the first end of the boom arm body is rotatably connected to the fuselage, a second support shaft is connected between the two boom arm bodies located on both sides of the fuselage, the first connecting shaft is fixedly connected between the second ends of the two boom arm bodies located on both sides of the fuselage, and the small arm portion is elastically rotatably connected to the first connecting shaft; the second drive motor is arranged in the fuselage, the second drive motor is drive-connected to the boom arm body, the control assembly is connected to the second drive motor, and the control assembly is used to drive the second drive motor to rotate to drive the boom arm body to swing.
[0009] Optionally, the forearm portion includes a second connecting shaft, a coil spring, a connecting piece and two identical forearm arm bodies; the first end of the forearm arm body is vertically connected to the connecting piece so that the two forearm arm bodies are arranged in parallel; each of the forearm arm bodies is sequentially provided with a first connecting hole and a second connecting hole in the vertical direction, and the two forearm arm bodies are rotatably connected to the first connecting shaft through the first connecting hole, the coil spring is sleeved on the first connecting shaft and elastically connected between the two forearm arm bodies; the second connecting shaft is fixedly connected between the two second connecting holes, and the roller is sleeved on the second connecting shaft and rotatably connected to the second connecting shaft.
[0010] Optionally, the control component includes a power supply module, a DC conversion module, a motor drive chip and a main control chip; the power supply module is connected to the DC conversion module, the DC conversion module is respectively connected to the main control chip and the motor drive chip, and the main control chip is connected to the motor drive chip; the motor drive chip is respectively connected to the drive motor of the drive part and the drive motor of the upper arm part.
[0011] Optionally, the power module includes a plurality of battery cells connected in series.
[0012] Optionally, a camera assembly is provided on one end of the fuselage, and the camera assembly is connected to the main control chip. The camera assembly collects image information in the cable duct based on the control of the main control chip, and sends the image information to the main control chip.
[0013] Optionally, a data processing unit is provided on the main control chip, and the data processing unit is configured with a machine learning model library;
[0014] The data processing unit is used to receive the image information, and select a preset convolutional neural network model from the machine learning model library to process the image information to obtain the operating status information of the robot body.
[0015] Optionally, the cable pipe guiding robot further comprises a mobile terminal, and the mobile terminal is configured with a human-machine interaction platform;
[0016] The main control chip is also provided with a Bluetooth communication module, and the main control chip is connected to the mobile terminal through the Bluetooth communication module, and sends the running status information of the robot body to the mobile terminal;
[0017] The mobile terminal displays the operating status information of the robot body through the human-computer interaction platform, and based on the control instructions received by the human-computer interaction platform, sends control instructions to the main control chip through the Bluetooth communication module, so that the main control chip drives the motor drive chip to drive the drive part and the upper arm part to move based on the control instructions.
[0018] The cable conduit guiding robot provided by the present invention, when encountering changes in the diameter of the cable conduit, corners or obstacles during its movement, the control component controls the swing of the upper arm to adjust the height, and at the same time the lower arm is squeezed by the inner wall of the cable conduit and pressed down, so that the control component can continue to drive the driving part forward, and after the robot passes the obstacle, the upper arm is controlled to restore the original height, and the lower arm is restored to its original state under the action of the elastic structure, and the roller moves to roll in contact with the inner wall of the cable conduit. The above-mentioned cable conduit guiding robot uses the upper arm and the lower arm mounted on the fuselage to work together to achieve self-adaptation to changes in different pipeline working environments, ensuring that the cable will not get stuck or break during the conduit threading process; and the fuselage structure is compact, suitable for operation in narrow cable conduit spaces; the control component can adjust the swing of the upper arm according to the robot's movement, thereby keeping the roller in close contact with the inner wall of the conduit, effectively reducing the possibility of friction and damage of the cable during the conduit threading process, and improving the efficiency of guiding the cable through the cable conduit.
[0019] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention can be realized and obtained by the structures particularly pointed out in the written description, claims, and drawings.
[0020] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] The accompanying drawings are used to provide a further understanding of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the present invention and do not constitute a limitation of the present invention. In the accompanying drawings:
[0022] Figure 1 A schematic diagram of the overall structure of a cable pipe guiding robot according to an embodiment of the present application;
[0023] Figure 2 An exploded diagram of the structure of a cable pipe guiding robot according to an embodiment of the present application;
[0024] Figure 3 A schematic diagram of the structure of a driving wheel in a cable pipe guiding robot according to an embodiment of the present application;
[0025] Figure 4 A connection diagram of control components in a cable pipe guiding robot according to an embodiment of the present application;
[0026] Figure 5 A schematic diagram of a process for realizing image recognition and automatic control in a cable pipe guiding robot according to an embodiment of the present application;
[0027] Figure 6 A display interface of a human-computer interaction platform on a mobile terminal in a cable pipe guiding robot according to an embodiment of the present application.
[0028] In the figure:
[0029] 1. Body; 101. Camera assembly;
[0030] 2. Driving unit; 201. Driving wheel bracket; 202. First driving motor; 203. Driving wheel; 2031. Arc plate; 204. First supporting shaft;
[0031] 3. Big arm; 301. Big arm body; 302. Second drive motor; 303. First connecting shaft; 304. Second supporting shaft;
[0032] 4. forearm portion; 401. forearm body; 402. second connecting shaft; 403. coil spring;
[0033] 5. Roller. DETAILED DESCRIPTION
[0034] In the description of the present invention, it should be understood that the terms "center", "longitudinal", "lateral", "length", "width", "thickness", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", "clockwise", "counterclockwise" and the like indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as limiting the present invention.
[0035] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "plurality" is two or more, unless otherwise clearly and specifically defined.
[0036] In the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected", "connected", "fixed" and the like should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be an indirect connection through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0037] The present invention provides a cable pipe guiding robot, such as Figure 1 As shown, the robot body includes a fuselage 1, a driving part 2, an upper arm part 3 and a lower arm part 4, wherein the driving part 2 is arranged at the bottom of the fuselage 1, the first end of the upper arm part 3 is rotationally connected to the fuselage 1, the second end of the upper arm part 3 is elastically rotationally connected to the first end of the lower arm part 4, and the second end of the lower arm part 4 is rotationally connected with a roller 5, and a control component is arranged in the fuselage 1, and the control component is respectively connected to the upper arm part 3 and the driving part 2, and the control component is used to drive the driving part 2 to move, and control the upper arm part 3 to swing so that the roller 5 keeps rolling in contact with the inner wall of the cable duct.
[0038] The cable conduit guiding robot provided by the present invention, when encountering changes in the diameter of the cable conduit, corners or obstacles during the movement, the control component controls the swing of the upper arm 3 to adjust the height, and at the same time, the lower arm 4 is squeezed by the inner wall of the cable conduit and pressed down, so that the control component can continue to drive the driving part 2 forward, and after the robot passes the obstacle, the upper arm 3 is controlled to restore the original height, and the lower arm 4 is restored to its original state under the action of the elastic structure, and the roller 5 moves to roll in contact with the inner wall of the cable conduit. The above-mentioned cable conduit guiding robot uses the upper arm 3 and the lower arm 4 mounted on the fuselage 1 to cooperate with each other to achieve self-adaptation to changes in different pipeline working environments, ensuring that the cable will not get stuck or break during the conduit; and the fuselage 1 has a compact structure and is suitable for operation in a narrow cable conduit space; the control component can adjust the swing of the upper arm 3 according to the movement of the robot, thereby keeping the roller 5 in close contact with the inner wall of the conduit, effectively reducing the possibility of friction and damage of the cable during the conduit, and improving the efficiency of guiding the cable through the cable conduit.
[0039] Further, such as Figure 2 As shown, the driving unit 2 includes two driving components symmetrically installed at the two ends of the bottom of the fuselage 1, wherein the driving component includes a driving wheel 203, a first driving motor 202 and two driving wheel brackets 201 symmetrically installed on both sides of the fuselage 1, the first end of the driving wheel bracket 201 is fixedly connected to the fuselage 1, a first support shaft 204 is fixedly connected between the two driving wheel brackets 201 located on both sides of the fuselage 1, the first driving motor 202 is fixedly connected to the inside of the driving wheel 203, the motor shaft of the first driving motor 202 is connected to the second end of the driving wheel bracket 201, and the control component is connected to the first driving motor 202, and is used to drive the first driving motor 202 to rotate around the motor shaft to drive the driving wheel 203 to rotate.
[0040] In this embodiment, by arranging two symmetrical drive components at both ends of the bottom of the fuselage 1, the driving efficiency and stability of the robot are improved, more stable driving force transmission is achieved, and the uneven load or overload problem that may occur when using a single drive component is avoided. The robot always moves forward or backward along the straight line formed by the two drive components in the pipeline; the drive component specifically includes a drive wheel 203, a first drive motor 202 and a drive wheel bracket 201. This structure can effectively improve the rotation efficiency and accuracy of the drive wheel 203, thereby ensuring the movement stability and accuracy of the robot during the pipe threading process; at the same time, a first support shaft 204 is fixedly connected between the two drive wheel brackets 201, which effectively increases the structural strength of the component and reduces the vibration and deformation of the robot during movement; the control component is connected to the first drive motor 202, which can realize automatic control of the drive motor and improve the overall performance and reliability of the robot. Among them, the first drive motor 202 can use a DC motor with model 12GAN20-100. Setting the first drive motor 202 in the drive wheel 203 can effectively reduce the space occupied by the robot in the horizontal direction, simplify the structure of the robot, and also protect the first drive motor 202.
[0041] Furthermore, the driving wheel 203 includes a plurality of arc-shaped plates 2031 , which are evenly distributed along the circumference of the driving wheel 203 , with a gap between two adjacent arc-shaped plates 2031 , and a plurality of circular holes are formed on the arc-shaped plates 2031 .
[0042] In this embodiment, the specific structure of the driving wheel 203 is as follows: Figure 3 As shown, a first driving motor 202 is arranged inside the driving wheel 203 to drive the driving wheel 203 to rotate, and a plurality of arc plates 2031 are evenly arranged on the outer wall of the driving wheel 203, which increases the contact area between the driving wheel 203 and the inner wall of the pipe, increases the friction coefficient of the driving wheel 203 to improve the friction force, so that the driving wheel 203 has a stronger gripping ability, ensures the stability of the robot during the pipe threading process, and enables the robot to adapt to a smoother cable pipe environment; a gap is left between two adjacent arc plates 2031 to reduce the friction resistance generated by the direct contact between the driving wheel 203 and the inner wall of the pipe, thereby reducing the load of the first driving motor 202 and reducing energy consumption; a plurality of circular holes opened on the arc plates 2031 help to reduce the weight of the driving wheel 203, reduce the overall load of the robot, and are conducive to ventilation and heat dissipation, avoid overheating of the internal first driving motor 202, effectively increase the service life of the driving wheel 203, reduce maintenance costs, and improve the reliability and stability of the robot.
[0043] Specifically, in the above embodiment, Figure 2As shown, the upper arm part 3 includes two upper arm components symmetrically installed at both ends of the fuselage 1, and the upper arm component includes a first connecting shaft 303, a second driving motor 302 and two upper arm bodies 301 symmetrically installed on both sides of the fuselage 1. The first end of the upper arm body 301 is rotationally connected to the fuselage 1, and a second supporting shaft 304 is connected between the two upper arm bodies 301 located on both sides of the fuselage 1. The first connecting shaft 303 is fixedly connected between the second ends of the two upper arm bodies 301 located on both sides of the fuselage 1. The small arm part 4 is elastically rotationally connected to the first connecting shaft 303, and the second driving motor 302 is arranged in the fuselage 1. The second driving motor 302 is drivingly connected to the upper arm body 301, and the control component is connected to the second driving motor 302. The control component is used to drive the second driving motor 302 to rotate to drive the upper arm body 301 to swing.
[0044] In this embodiment, two boom assemblies symmetrically installed at both ends of the fuselage 1 are used to achieve balance control and flexible swinging of the robot, thereby improving the operational flexibility and stability of the robot; a second support shaft 304 is connected to the middle of the boom body 301, which can increase the structural strength of the boom part 3, reduce the vibration and deformation of the boom assembly during the swinging process, and ensure the movement stability of the robot; the second drive motor 302 is arranged in the fuselage 1, and is connected to the boom body 301 by driving. The second drive motor 302 is driven by the control component to work and then drive the boom body 301 to swing, so that precise control and adjustment of the robot movement can be achieved, and the operational efficiency and reliability of the robot are improved. Specifically, when the robot is operating normally, the control component raises the height of the boom body 301, so that the small arm part 4 drives the roller 5 to roll in contact with the upper surface of the inner wall of the cable pipeline, thereby ensuring the stable operation of the robot. When the robot encounters a pipeline obstacle, the control component controls the boom body 301 to descend, thereby driving the small arm part 4 to descend, so that the robot as a whole can still move forward in the pipeline. The control method of the boom assembly is flexible and precise.
[0045] Further, such as Figure 2 As shown, the forearm portion 4 includes a second connecting shaft 402, a coil spring 403, a connecting piece and two identical forearm arm bodies 401, wherein the first end of the forearm arm body 401 is vertically connected to the connecting piece so that the two forearm arm bodies 401 are arranged in parallel, and a first connecting hole and a second connecting hole are sequentially opened on each forearm arm body 401 in the vertical direction, and the two forearm arm bodies 401 are rotatably connected to the first connecting shaft 303 through the first connecting hole, the coil spring 403 is sleeved on the first connecting shaft 303, and is elastically connected between the two forearm arm bodies 401, the second connecting shaft 402 is fixedly connected between the two second connecting holes, and the roller 5 is sleeved on the second connecting shaft 402 and is rotatably connected to the second connecting shaft 402.
[0046] In this embodiment, the two small arm bodies 401 are arranged in parallel to ensure that the movement of the two small arm bodies 401 is relatively stable during the operation of the robot, which reduces the swinging and shaking of the robot and improves the accuracy of the operation; the small arm body 401 is rotatably connected to the first connecting shaft 303 on the large arm body 301 through the first connecting hole, and the coil spring 403 elastically connected between the two small arm bodies 401 and sleeved on the first connecting shaft 303 is used to elastically rotatably connect the small arm body 401 with the first connecting shaft 303, thereby realizing the elastic rotation between the small arm body 401 and the large arm assembly Dynamic connection. When the robot is operating normally, the forearm 4 drives the roller 5 to roll in contact with the inner wall of the cable pipe. When the robot encounters a pipe obstacle, the control component controls the upper arm component to descend. At the same time, the roller 5 is pressed down by the pressure of the inner wall of the pipe. The roller 5 drives the forearm arm body 401 to rotate, and is limited by the elastic rotation connection between the forearm arm body 401 and the upper arm assembly, so that the roller 5 still rolls in contact with the inner wall of the pipe. The coil spring 403 realizes the buffering and shock absorption of the forearm arm body 401, thereby realizing the flexible rotation and adjustment of the forearm arm body 401, thereby improving the applicability and versatility of the robot.
[0047] Specifically, in the above embodiment, Figure 4 As shown, the control component includes a power module, a DC conversion module, a motor drive chip and a main control chip. The power module is connected to the DC conversion module, the DC conversion module is respectively connected to the main control chip and the motor drive chip, the main control chip is connected to the motor drive chip, and the motor drive chip is respectively connected to the drive motor of the drive part 2 and the drive motor of the upper arm part 3.
[0048] In this embodiment, the ESP32 chip is selected as the main control chip. The ESP32 chip has the characteristics of low cost, low power consumption, high performance, and is suitable for the development of the Internet of Things and embedded systems. It can also be programmed and debugged based on the Arduino IDE development platform, including the control program of the motor driver chip to realize the control of the movement of the drive part 2 and the arm part 3; at the same time, the present application selects the L298N chip as the driver chip for driving the motor in the drive part 2 and the arm part 3. The L298N chip can drive two motors at the same time. The L298N chip usually includes a power input terminal, a motor output terminal, a control signal input terminal, and an enable control terminal. The power input terminal is used to connect to the power supply voltage, and the output terminal is connected to the motor to be driven. In this application, the control signal input terminal of the L298N chip receives the control signal from the main control chip ESP32. By changing the control signal, the forward rotation, reverse rotation and stop of the motor can be controlled; the enable control terminal is used to dynamically adjust the working state of the circuit to achieve more flexible control.
[0049] Specifically, in the above embodiment, the power module includes a plurality of battery cells connected in series.
[0050] In this embodiment, multiple battery cells connected in series can increase the total output voltage of the power module, and by adjusting the number of battery cells, the output voltage of the power module can be flexibly adjusted to adapt to different application requirements, which has strong flexibility; the power module battery capacity provided in this application reaches 6000mAh and can be recharged repeatedly. The power supply time of the battery after a single charge should reach 4 hours, which can cope with the complex working requirements in the cable duct.
[0051] Furthermore, a camera assembly 101 is provided on one end of the fuselage 1, and the camera assembly 101 is connected to the main control chip. The camera assembly 101 collects image information in the cable duct based on the control of the main control chip, and sends the image information to the main control chip.
[0052] In this embodiment, a camera assembly 101 is provided at one end of the body 1 in the forward direction. The camera assembly 101 can specifically use a camera or a sensor array to collect images inside the cable duct. Usually, in an industrial environment, a high-resolution and high-speed camera is used to adapt to various lighting conditions and fast-moving objects. At the same time, the main control chip can also control camera parameters such as exposure time, gain, frame rate, etc. through a programming interface (such as OpenCV, Python, etc.), thereby ensuring that a clear and high-contrast image is obtained.
[0053] Furthermore, a data processing unit is provided on the main control chip, and the data processing unit is configured with a machine learning model library; the data processing unit is used to receive image information, and select a preset convolutional neural network model in the machine learning model library to process the image information to obtain the operating status information of the robot body.
[0054] In this embodiment, the data processing unit is configured with a machine learning model library, specifically a Tensorflow Lite machine learning model library, and then a pre-trained model suitable for the cable duct scenario is selected from the TensorFlow machine learning model library, and the pre-trained model is converted into a format suitable for embedded devices using TensorFlow Lite Converter, which can effectively reduce memory usage and computing resources, and then the TensorFlow Lite interpreter is used for real-time reasoning. In this application, a convolutional neural network model is specifically used to pre-process the collected images, including scaling, cropping, normalization, etc., to meet the model input requirements. After that, the convolution layer is responsible for extracting features from the image, the pooling layer reduces the dimension, and the fully connected layer is used for classification or regression tasks. Finally, the collected image information is input into the model to obtain a prediction result. Among them, the step of processing the image using the convolutional neural network model can also be completed on other devices, such as accessing the mobile phone through the Keras API (mobile phone coding interface) to reduce latency and bandwidth requirements.
[0055] Furthermore, the cable pipe guiding robot also includes a mobile terminal, which is equipped with a human-computer interaction platform; a Bluetooth communication module is also provided on the main control chip, and the main control chip is connected to the mobile terminal through the Bluetooth communication module, and sends the operating status information of the robot body to the mobile terminal; the mobile terminal displays the operating status information of the robot body through the human-computer interaction platform, and based on the control instructions received from the human-computer interaction platform, sends control instructions to the main control chip through the Bluetooth communication module, so that the main control chip drives the driving part 2 and the upper arm part 3 to move based on the control instructions.
[0056] In this embodiment, the user can control the robot body through a mobile terminal, and realize the function of communicating with the mobile terminal based on the Bluetooth communication module on the ESP32 chip. The mobile terminal is preferably a smart phone, and a human-computer interaction platform can be built on the smart phone. By creating a mobile phone application, the interaction with the ESP32 main control chip is realized. The Bluetooth communication module of the ESP32 main control chip is enabled through a specific AT command (Attention command, a command set used to control modems and other serial communication devices), and the Bluetooth broadcast is turned on through the AT+BLEADVSTART command (Bluetooth LowEnergy Advertising) so that the smart phone can scan and find the ESP32 main control chip. The user turns on the Bluetooth function of the smart phone, successfully pairs with the ESP32 main control chip, and then establishes a communication connection with the robot. By sending control instructions to the ESP32 main control chip, the motion control of the robot is realized, and the control method is flexible and simple; the driving part 2 and the large arm part 3 are driven by the driving motor, so that the robot has the ability to adapt to changes in the inner diameter of the pipeline and climb over obstacles.
[0057] Based on the above content, the main control chip in the robot body and the mobile terminal are combined to realize the whole process of image information collection, data processing and automatic control in the cable pipeline. Figure 5 shown.
[0058] This application can also develop a human-computer interaction platform in a Web environment based on the visual programming development tool Android studio platform. The human-computer interaction platform specifically includes a variety of manual control functions, such as Figure 6The display interface of the human-machine interaction platform is shown, including starting / disconnecting Bluetooth communication with the ESP32 main control chip, turning on / off the camera assembly, controlling the drive unit 2 to move forward / backward / brake, controlling the forward support / reverse support / stop and standby of the big arm 3; at the same time, the pipeline environment recognition algorithm is integrated to realize the automatic control of the robot big arm 3 and the drive unit 2. The user can view the situation in the cable pipeline in real time through the human-machine interaction interface. Under normal circumstances, the robot judges the changes in the pipeline environment according to the image recognition algorithm and automatically controls the movement of the big arm 3 and the drive unit 2. When the environment of the cable pipeline is too complex and the robot cannot pass automatically, the user can use the manual control function to issue action instructions on the smartphone application to help the robot complete actions such as moving and avoiding obstacles.
[0059] The present application provides a robot wired dragging solution. Except for the robot body, all other functional components are external and do not follow the robot into the cable duct working environment, so as to reduce the space occupancy and body burden of the robot body structure, while also solving the problem of signal shielding in underground cable ducts.
[0060] Using the cable conduit guiding robot provided in this application, experiments were carried out in multiple smart substations, and the success rate of cable conduit threading was increased from 76.9% to 100%; the average operation time for single cable threading was reduced from 31.8 minutes to 16.8 minutes; and the average number of people required was reduced from 6 to 2.
[0061] Obviously, those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalents, the present invention is also intended to include these modifications and variations.
Claims
1. A cable pipe guiding robot, characterized in that: The robot comprises a robot body, wherein the robot body comprises a body (1), a driving part (2), a large arm part (3) and a small arm part (4); The driving unit (2) is arranged at the bottom of the body (1); The first end of the large arm portion (3) is rotatably connected to the body (1), the second end of the large arm portion (3) is elastically rotatably connected to the first end of the small arm portion (4), and the second end of the small arm portion (4) is rotatably connected to a roller (5); A control component is provided in the body (1), and the control component is connected to the upper arm (3) and the driving part (2) respectively. The control component is used to drive the driving part (2) to move and control the upper arm (3) to swing so that the roller (5) keeps rolling in contact with the inner wall of the cable duct.
2. The cable pipe guiding robot according to claim 1, characterized in that: The driving part (2) comprises two driving components which are symmetrically mounted at two ends of the bottom of the fuselage (1); The driving assembly comprises a driving wheel (203), a first driving motor (202), and two driving wheel brackets (201) symmetrically mounted on both sides of the fuselage (1); The first end of the driving wheel bracket (201) is fixedly connected to the fuselage (1), and a first support shaft (204) is fixedly connected between the two driving wheel brackets (201) located on both sides of the fuselage (1); The first drive motor (202) is fixedly connected to the inside of the drive wheel (203), and the motor shaft of the first drive motor (202) is connected to the second end of the drive wheel bracket (201); The control component is connected to the first drive motor (202) and is used to drive the first drive motor (202) to rotate around the motor shaft, thereby driving the drive wheel (203) to rotate.
3. The cable pipe guiding robot according to claim 2, characterized in that: The driving wheel (203) comprises a plurality of arc-shaped plates (2031); The plurality of arc-shaped plates (2031) are evenly distributed along the circumference of the driving wheel (203), a gap is left between two adjacent arc-shaped plates (2031), and the arc-shaped plates (2031) are provided with a plurality of circular holes.
4. The cable pipe guiding robot according to claim 1, characterized in that: The large arm part (3) comprises two large arm components symmetrically mounted at two ends of the fuselage (1); The boom assembly comprises a first connecting shaft (303), a second driving motor (302) and two boom bodies (301) symmetrically mounted on both sides of the fuselage (1); The first end of the upper boom body (301) is rotatably connected to the fuselage (1), a second support shaft (304) is connected between the two upper boom bodies (301) located on both sides of the fuselage (1), the first connecting shaft (303) is fixedly connected between the second ends of the two upper boom bodies (301) located on both sides of the fuselage (1), and the lower arm portion (4) is elastically rotatably connected to the first connecting shaft (303); The second drive motor (302) is arranged in the fuselage (1), the second drive motor (302) is drivingly connected to the upper arm body (301), the control component is connected to the second drive motor (302), and the control component is used to drive the second drive motor (302) to rotate so as to drive the upper arm body (301) to swing.
5. The cable pipe guiding robot according to claim 4, characterized in that: The small arm portion (4) comprises a second connecting shaft (402), a coil spring (403), a connecting piece and two identical small arm bodies (401); The first end of the forearm arm body (401) is vertically connected to the connecting member so that the two forearm arm bodies (401) are arranged in parallel; A first connection hole and a second connection hole are sequentially opened on each of the forearm arm bodies (401) in the vertical direction, and the two forearm arm bodies (401) are rotatably connected to the first connection shaft (303) through the first connection holes. The coil spring (403) is sleeved on the first connection shaft (303) and elastically connected between the two forearm arm bodies (401); The second connecting shaft (402) is fixedly connected between the two second connecting holes, and the roller (5) is sleeved on the second connecting shaft (402) and is rotatably connected to the second connecting shaft (402).
6. The cable pipe guiding robot according to claim 1, characterized in that: The control component includes a power module, a DC conversion module, a motor drive chip and a main control chip; The power supply module is connected to the DC conversion module, the DC conversion module is respectively connected to the main control chip and the motor drive chip, and the main control chip is connected to the motor drive chip; The motor drive chip is respectively connected to the drive motor of the drive part (2) and the drive motor of the upper arm part (3).
7. The cable pipe guiding robot according to claim 6, characterized in that: The power module includes a plurality of battery cells connected in series.
8. The cable pipe guiding robot according to claim 6, characterized in that: A camera assembly (101) is provided at one end of the body (1), the camera assembly (101) being connected to the main control chip; the camera assembly (101) collects image information in the cable duct based on the control of the main control chip, and sends the image information to the main control chip.
9. The cable pipe guiding robot according to claim 8, characterized in that: The main control chip is provided with a data processing unit, and the data processing unit is configured with a machine learning model library; The data processing unit is used to receive the image information, and select a preset convolutional neural network model from the machine learning model library to process the image information to obtain the operating status information of the robot body.
10. The cable pipe guiding robot according to claim 9, characterized in that: The cable pipe guiding robot further comprises a mobile terminal, and the mobile terminal is equipped with a human-machine interaction platform; The main control chip is also provided with a Bluetooth communication module, and the main control chip is connected to the mobile terminal through the Bluetooth communication module, and sends the running status information of the robot body to the mobile terminal; The mobile terminal displays the operating status information of the robot body through the human-machine interaction platform, and based on the control instructions received by the human-machine interaction platform, sends control instructions to the main control chip through the Bluetooth communication module, so that the main control chip drives the motor drive chip based on the control instructions to drive the drive part (2) and the large arm part (3) to move.
