An integrated tethered power supply, communication and recovery system and its control method for a quadrupedal robot for tunnel inspection
By using a dual-link communication system and tension closed-loop control, the problems of communication interruption and cable entanglement in quadruped robots in enclosed spaces have been solved, enabling reliable operation and safe recovery in complex environments.
Patent Information
- Application Number
- CN202611465198.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-09-20
- Publication Date
- 2026-11-17
AI Technical Summary
Existing tethered power supply systems for quadruped robots suffer from problems such as wireless communication signal attenuation and electromagnetic interference in enclosed spaces, inability to adapt to nonlinear kinematic characteristics, and lack of ability to identify and safely retrieve complex failure conditions, leading to communication interruptions, cable tangling, and equipment damage.
A dual-link communication system is adopted, including wired communication as a backup transmission channel, combined with tension closed-loop adaptive following and multi-dimensional status monitoring to achieve electromagnetic shielding isolation, dynamic adjustment of the tension of the mooring cable, and constant force forced recovery in the case of disconnection.
It effectively overcomes communication interruptions and electromagnetic interference in enclosed spaces, prevents cable entanglement, accurately identifies abnormal working conditions, and safely recovers the equipment when it loses connection, thus improving the operational reliability and recovery success rate of the quadruped robot.
Smart Images

Figure CN123105404A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of special robots and automated control technology, specifically to an integrated tethered power supply, communication and recovery system and its control method for a tunnel inspection quadruped robot. Background Technology
[0002] With the continuous development of special robot technology, quadruped robots, thanks to their excellent off-road performance and terrain adaptability, have been widely used in inspection and emergency search and rescue operations in enclosed spaces such as tunnels, underground utility tunnels, and mines. To ensure the long-endurance operation capability of quadruped robots in these scenarios, they are typically equipped with tethered power supply systems. However, in complex and extreme enclosed operating environments, existing tethered power supply technologies still face the following core challenges:
[0003] First, enclosed spaces pose significant physical obstructions and multipath interference to wireless communication links. Existing quadruped robots largely rely on onboard wireless communication modules (such as wireless image transmission or 4G / 5G networks) for control commands and status data exchange. Once deep inside tunnels, these systems are highly susceptible to severe signal attenuation and sudden link failures. While some tethered systems attempt to incorporate wired communication, they often lack independent differential signal design and electromagnetic shielding. When laid in parallel with high-voltage DC power cables, they are highly vulnerable to electromagnetic radiation interference from high-power dynamic currents, leading to data loss and communication link collapse, thus failing to establish an effective backup transmission channel.
[0004] Secondly, existing tethered deployment and retrieval mechanisms cannot adapt to the nonlinear kinematic characteristics of quadruped robots. Due to the rugged terrain inside tunnels, quadruped robots experience irregular gait undulations and transient accelerations and decelerations when moving forward, backward, or overcoming obstacles. Existing devices generally employ uniform passive deployment and retrieval or rely on simple mechanical springs to provide constant tension in a cable winding structure, which cannot dynamically adjust the deployment and retrieval speed according to the real-time motion posture of the quadruped robot. This tension lag causes the cable to become excessively slack when the robot decelerates, leading to dragging, tangling, or being stepped on by the legs; conversely, when the robot accelerates or goes downhill, it generates excessive transient pulling forces, disrupting the quadruped robot's precise dynamic balance and posture stability.
[0005] Finally, existing systems generally lack accurate identification and proactive rescue mechanisms for complex failure conditions. In tunnel operations, robots not only face the risk of communication interruptions but may also encounter underlying hardware failures, system power outages, or physical entrapment due to the robot becoming stuck in rock crevices. Existing systems often cannot distinguish between these multi-source, heterogeneous failure states and cannot promptly block the issuance of erroneous commands when equipment malfunctions. More importantly, after the equipment is completely disconnected, existing systems lack the ability for safe physical forced retrieval. If a conventional winch is used for blind, full-speed, rigid dragging, the continuous pulling force will directly cause the robot's joints to break in the opposite direction or the tethering cable to snap, ultimately resulting in the permanent loss of high-value equipment. Summary of the Invention
[0006] To achieve the above objectives, the present invention provides the following technical solution:
[0007] This invention provides an integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot, comprising the following steps: S100, system initialization and dual-link communication establishment: after the device passes the power-on self-test, a dual-channel transmission link of wireless and wired communication is established between the ground main control terminal and the airborne terminal module, with the wired communication serving as the fallback transmission channel;
[0008] S200, Tension Closed-Loop Adaptive Follow-up Rewinding: In normal operation mode, the ground main control terminal controls the servo winding drive module to dynamically adjust the winding speed of the tethered cable based on the real-time collected tension of the tethered cable, so that the tension of the tethered cable is maintained within the preset tension range.
[0009] S300, Multi-dimensional Status Monitoring and Intelligent Disconnection Detection: Real-time monitoring of the quadruped robot's operating status. When the monitored communication heartbeat signal, power supply current or cable tension meets at least one of the preset disconnection detection conditions, the quadruped robot is determined to have entered a disconnection state.
[0010] S400, Emergency Constant Force Forced Recycling: When it is determined that the quadruped robot has entered a disconnected state, switch to emergency recycling mode, control the servo winding drive module to wind up the tether cable with a preset constant tension, and drag the quadruped robot back to the starting position.
[0011] Furthermore, in step S100, during the power-on self-test, the following steps are specifically included:
[0012] Simultaneously or sequentially detect the electrical connectivity of the mooring cable, the zero-point output signal of the tension sensor, the initial motor condition of the servo winding drive module, and the on / off status of the gigabit wired communication link.
[0013] The system is considered to have passed the self-test and entered the standby mode only when all test items meet the preset normal parameter range; if any test item is abnormal, an alarm is output and the servo winding drive module is controlled to be in a physically locked state.
[0014] The step S100, which establishes a dual-channel transmission link and uses wired communication as a fallback transmission channel, specifically includes:
[0015] Under normal operating conditions, the control commands and attitude data of the quadruped robot are transmitted in parallel through both wireless and wired channels.
[0016] The ground control terminal monitors the signal strength of the wireless channel in real time. When the signal attenuation of the wireless channel exceeds the preset threshold or a link is interrupted, it seamlessly switches to a pure wired backup transmission mode through the gigabit differential communication line inside the mooring cable, keeping the interruption delay of control command issuance and data return below the preset time.
[0017] Furthermore, the gigabit differential communication line is surrounded by an independently set electromagnetic shielding layer, and is laid in an alternating and isolated manner with the high-voltage power supply line inside the tethered cable, so as to cancel the electromagnetic interference generated by the high-voltage power supply line when establishing a wired communication channel.
[0018] In step S100, when establishing a wired communication channel, the gigabit wired communication motherboard in the ground main control terminal and the wired communication adapter board in the airborne terminal module use a differential signal handshake protocol to perform link initialization verification, and lock the communication baud rate after the handshake is successful.
[0019] Further, in step S200, based on the real-time collected tension of the tethered cable, the servo winding drive module is controlled to dynamically adjust the winding and unwinding speed of the tethered cable. Specifically, this includes: using a PID closed-loop control algorithm to compare the real-time collected tension of the tethered cable with a preset tension range, and seamlessly switching between the unwinding state, the micro-winding state, and the static tension-maintaining state according to the comparison result; wherein, when the real-time tension is greater than the upper threshold of the preset tension range, the servo winding drive module is controlled to unwind the cable smoothly at a speed proportional to the tension deviation; when the real-time tension is lower than the lower threshold of the preset tension range, the servo winding drive module is controlled to wind the cable at a low speed; when the real-time tension is within the preset tension range, the servo winding drive module is controlled to maintain a static micro-tension state.
[0020] The lower threshold of the preset tension range is 5N, and the upper threshold is 25N; the adaptive adjustment response time of the PID closed-loop control algorithm to tension changes is no more than 20 milliseconds.
[0021] Furthermore, in step S200, the tethered cable is guided by a guide damping wheel and a tension sensing component located at the cable exit end of the reel during the winding and unwinding process; when the winding and unwinding speed is dynamically adjusted, the guide damping wheel provides passive buffering through a preset damping coefficient to counteract the transient tension fluctuations caused by the gait undulations of the quadruped robot.
[0022] The maximum take-up and untake-up speed of the servo take-up drive module is set to 0.5 m / s. During the seamless state switching process, the motor speed of the servo take-up drive module is constrained by an acceleration smoothing curve to avoid sudden changes in cable tension from impacting the posture stability of the quadruped robot.
[0023] Further, in step S300, the multi-dimensional status monitoring and intelligent disconnection determination module collects communication heartbeat packets, power supply parameters, and tension data in real time at a preset frequency; the preset disconnection determination conditions specifically include the following three independent conditions, and when any one of them is met, the quadruped robot is determined to have entered a disconnection state: Condition 1: The heartbeat signals of wired and wireless communication are continuously unresponsive for a first preset time; Condition 2: The ground main control terminal detects that the power supply current transmitted to the airborne terminal module drops by more than a preset proportion, and no operating condition data is received from the quadruped robot; Condition 3: The real-time tension of the tether cable is continuously zero, and the quadruped robot's posture perception module confirms that the quadruped robot's displacement is stationary for more than a second preset time.
[0024] Furthermore, the second preset time is 5 seconds; the data acquisition frequency of the multi-dimensional status monitoring and intelligent disconnection determination module is not less than 100Hz, and the response delay time of the system triggering disconnection status lock and issuing emergency switching command after any disconnection determination condition is met is not greater than 1 second;
[0025] In step S300, after determining that the quadruped robot has entered a disconnected state and triggering a state lock, the system further includes: forcibly terminating the tension closed-loop adaptive following retraction mode in step S200, and automatically cutting off the conventional control command transmission channel in the gigabit differential communication line, retaining only the one-way status monitoring function, in order to prevent the quadruped robot from performing incorrect actions in a trapped or crashed state, which would aggravate damage to the quadruped robot's body or cause cable knots.
[0026] Further, in step S400, controlling the servo winding drive module to wind up the tethered cable with a preset constant tension specifically includes: the servo winding drive module switching to constant torque output mode, and cooperating with the uniform speed buffer structure of the guide damping wheel located at the cable exit end of the winding reel, to smoothly drag and wind up the quadruped robot in the disconnected state with a constant tension of 20N and a preset safe winding speed of no more than 0.3 m / s;
[0027] During the emergency constant force forced recovery process, the control method also includes a secondary protection mechanism to prevent jamming: real-time monitoring of the dynamic tension of the tethered cable during the winding process. If the dynamic tension is detected to increase suddenly within a preset time window and exceed the preset overload protection safety threshold, it is determined that the quadruped robot has physically jammed during the dragging process. At this time, the servo winding drive module is controlled to immediately perform instantaneous force release or pause the winding operation, and simultaneously trigger an audible and visual jamming alarm and wait for manual intervention.
[0028] Furthermore, in step S400, the processing logic for dragging and retrieving the quadruped robot to the starting position specifically includes: synchronously recording the retrieval travel data of the tether cable during the forced retrieval process; when the travel detection module determines that the retrieval travel has reached the starting position on the ground, automatically triggering a stop command and controlling the servo winding drive module to perform a power-off lock; at the same time, the system automatically extracts and retains the running trajectory data and sensor logs within a preset time period before the current disconnection trigger, and issues an interactive prompt indicating that retrieval is complete.
[0029] Throughout the entire lifecycle of the emergency recovery mode, the industrial control display and interaction module of the ground main control terminal displays the remaining winding length and current tension value of the cable in real time graphically; and the ground main control terminal is equipped with the highest priority manual intervention control authority, allowing the operator to forcibly take over and override the automatic winding and unwinding actions of the servo winding drive module by triggering the hard-wired emergency stop switch or manual control lever when receiving a jam alarm or observing an anomaly.
[0030] On the other hand, an integrated tethered power supply and communication recovery system for a quadrupedal tunnel inspection robot includes a dual-link initialization module, which is used to establish a wireless and wired dual-channel transmission link between the ground main control terminal and the airborne terminal module after the device passes the power-on self-test, and uses the wired communication as a backup transmission channel.
[0031] The adaptive following rewind module is used in normal operation mode to control the servo rewind drive module to dynamically adjust the rewind speed of the tethered cable based on the tension of the tethered cable collected in real time by the ground main control terminal, so that the tension of the tethered cable is maintained within a preset tension range.
[0032] The status monitoring and judgment module is used to monitor the operating status of the quadruped robot in real time. When the monitored communication heartbeat signal, power supply current or cable tension meets at least one of the preset disconnection judgment conditions, the quadruped robot is judged to have entered a disconnection state.
[0033] The emergency forced recovery module is used to switch to emergency recovery mode when the quadruped robot is determined to be out of contact. It controls the servo winding drive module to wind up the tether cable with a preset constant tension, and drags the quadruped robot back to the starting position.
[0034] Beneficial effects
[0035] This invention provides a solution that effectively overcomes communication interruption problems caused by electromagnetic interference and signal attenuation in enclosed spaces by constructing a shielded and isolated gigabit wired and wireless dual-channel redundant link. Based on the tension closed-loop PID adaptive following algorithm and the soft and hard coordinated control of the guide damping wheel, it accurately filters out transient tension pulses generated by the gait fluctuations of the quadruped robot, achieving smooth follow-up operation with anti-entanglement and anti-pulling capabilities. At the same time, it integrates a multi-dimensional state cross-verification mechanism of communication heartbeat, electrical parameters and physical tension to accurately identify abnormal working conditions, and initiates a constant force forced recovery program with jamming and force leakage protection function when the equipment loses connection. Thus, while ensuring the safety of the quadruped robot's physical architecture and electrical system, it significantly improves the operational reliability and passive recovery success rate of special inspection equipment in extremely enclosed environments. Attached Figure Description
[0036] Figure 1 This is a flowchart illustrating the overall control method of the present invention.
[0037] Figure 2 The logic flow diagram for the intelligent disconnection detection and emergency recovery of this invention is shown below;
[0038] Figure 3 This is a schematic diagram of the overall system architecture and mechanical structure of the present invention. Detailed Implementation
[0039] To enable those skilled in the art to better understand the present invention, the technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort should fall within the scope of protection of the present invention.
[0040] It should be noted that the terms "first," "second," etc., in the specification, claims, and accompanying drawings of this invention are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It should be understood that such data can be interchanged where appropriate so that the embodiments of the invention described herein can be implemented in orders other than those illustrated or described herein. Furthermore, the terms "comprising" and "having," and any variations thereof, are intended to cover a non-exclusive inclusion; for example, a process, method, system, product, or apparatus that comprises a series of steps or units is not necessarily limited to those steps or units explicitly listed, but includes other steps or units not explicitly listed or inherent to such processes, methods, products, or apparatus.
[0041] The present invention will now be described in further detail with reference to the accompanying drawings:
[0042] Example:
[0043] like Figures 1-3 As shown, an integrated tethered power supply, communication, and retrieval control method for a tunnel inspection quadruped robot is applied to a tethered system comprising a ground-based main control terminal, a tethered cable, and an airborne terminal module. The method includes the following steps:
[0044] S100, System Initialization and Dual-Link Communication Establishment: After the equipment passes the power-on self-test, a dual-channel transmission link of wireless and wired communication is established between the ground main control terminal and the airborne terminal module, with wired communication as the backup transmission channel.
[0045] S200, tension closed-loop adaptive following reel-in and reel-out: In normal operation mode, the ground main control terminal controls the servo reel-in drive module to dynamically adjust the reel-in and reel-out speed based on the real-time collected tension of the tether cable, so that the tension of the tether cable is maintained within the preset tension range.
[0046] S300, Multi-dimensional Status Monitoring and Intelligent Disconnection Detection: Real-time monitoring of the quadruped robot's operating status. When the monitored communication heartbeat signal, power supply current or cable tension meets at least one of the preset disconnection detection conditions, the quadruped robot is determined to have entered a disconnection state.
[0047] S400, Emergency Constant Force Forced Recycling: When the quadruped robot is determined to be out of contact, it switches to emergency recycling mode and controls the servo winding drive module to wind up the tether cable with a preset constant tension, dragging the quadruped robot back to the starting position.
[0048] Furthermore, the specific implementation process of step S100 is as follows:
[0049] During system startup, after the ground control terminal is powered on, the main control chip first triggers a power-on self-test program to perform multi-dimensional concurrent detection of the system's electrical, mechanical, and communication status. In the electrical connectivity test of the tethered cable, the detection module in the ground control terminal injects microsecond-level low-voltage test pulses into the high-voltage power supply line and gigabit differential communication line inside the composite tethered cable. By collecting the current amplitude and voltage waveform feedback from the loop end, it determines whether there are open circuits, short circuits, or impedance abnormalities in the power supply cable and signal cable.
[0050] In the zero-point detection of the tension sensor, the tension sensor controller reads the initial output electrical signal of the tension sensor component under no external pulling force, compares the acquired zero-point bias voltage value with the preset zero-point error allowable range, and verifies whether the zero-point drift of the strain gauge or piezoresistive sensing element exceeds the normal threshold. In the self-test of the servo winding drive module, the ground main control terminal sends a status query command to the servo motor driver through the bus interface. The servo motor driver reads the encoder's initial position feedback, the three-phase winding resistance status, and the overcurrent and overvoltage fault flags inside the drive board to determine the initial hardware operating conditions of the motor. In the self-test of the gigabit wired communication link, the Ethernet physical layer chip (PHY chip) of the ground gigabit wired communication motherboard sends a physical layer link connection pulse (FLP) to the cable to detect the impedance matching and full-duplex connectivity status of the physical layer link.
[0051] When all four test results are within the preset normal parameter range, the main control chip outputs a high-level enable signal to the enable pin of the servo motor driver, and at the same time controls the brake mechanism of the servo winding drive module to release the mechanical lock state. The system determines that the self-test has passed, and the state machine switches from the initialization state to the standby operation mode.
[0052] If the feedback data of any detection item exceeds the preset parameter range, the main control chip keeps the enable pin in a low level state, the servo motor driver maintains physical brake locking, blocks the power output of the drive motor, and drives the sound and light alarm circuit to issue an alarm signal through the GPIO pin of the industrial control display interaction module.
[0053] After passing the self-test, the ground-based main control terminal and the airborne terminal module installed on the back of the quadruped robot begin to establish a dual-channel transmission link. The wired communication channel relies on the transmission medium inside the composite tethered cable.
[0054] To counteract the interference of strong electromagnetic radiation generated by the high-voltage power supply line (outputting 48V DC, rated current 15A) on high-frequency communication signals during dynamic high-power transmission, the composite tethered cable incorporates isolation and shielding designs in its physical structure. The outermost layer of the cable is a polyurethane wear-resistant sheath, with a Kevlar tensile fiber filling layer surrounding the sheath. The high-voltage power supply copper wire and the twisted-pair gigabit communication differential line are symmetrically staggered inside the sheath, with insulating grid material filling the gaps between them to increase the physical spatial distance. The twisted-pair gigabit communication differential line is independently covered by a double-layer electromagnetic shielding structure consisting of an aluminum foil shielding layer and a tinned copper wire braided mesh. The electromagnetic shielding layer is grounded at both the ground main control terminal and the airborne terminal module through a metal overlap structure, achieving single-end or double-end grounding, thus guiding the capacitive and inductive coupling noise caused by the high-frequency ripple of the switching power supply to the system ground wire.
[0055] When establishing a wired communication channel, the gigabit wired communication motherboard in the ground master terminal and the wired communication adapter board in the airborne terminal module execute a differential signal handshake protocol via a twisted-pair gigabit differential communication line. The PHY chip of the gigabit wired communication motherboard first sends an initialization handshake data packet containing a synchronization header, protocol version number, device identifier, and cyclic redundancy check (CRC) code. After receiving and successfully verifying the data packet, the PHY chip of the wired communication adapter board sends back an acknowledgment data packet (ACK) containing the airborne hardware status and receive window size. Through multiple rounds of handshake negotiation, both parties lock in a fixed communication baud rate (1000Mbps) and differential signal level standard, completing the initialization verification of the wired physical layer and data link layer. Simultaneously, the radio frequency module of the ground master terminal and the wireless communication module of the airborne terminal module establish a wireless transmission channel via radio electromagnetic waves, forming a parallel transmission architecture of wireless and gigabit wired dual channels.
[0056] During normal system operation, the wireless and wired channels simultaneously transmit the quadruped robot's control commands, motion posture data, and environmental information collected by sensors. The communication management unit in the ground-based main control terminal and the airborne terminal module monitors the signal quality indicators of the wireless channel in real time, including Received Signal Strength Indicator (RSSI), Signal-to-Noise Ratio (SNR), and packet loss rate. When the quadruped robot delves deep into a tunnel, causing severe attenuation of the wireless signal due to obstruction by the enclosed environment or multipath interference, if the communication management unit detects that the RSSI value of the wireless channel is below a preset strength threshold, or the packet loss rate exceeds a preset percentage threshold within a continuous monitoring period, or the wireless heartbeat packet times out, the communication management unit triggers a link switching logic. This automatically downgrades the wireless channel to a background monitoring link and routes all control command transmissions, telemetry data feedback, and video stream transmissions to a gigabit differential wired communication channel established via a composite tethered cable. During the switching process, the communication management unit uses a data buffer to rearrange frame sequence numbers and control retransmission of transmitted messages, keeping the data transmission interruption delay caused by seamless communication link switching within a preset time threshold, ensuring the continuous transmission of quadruped robot control commands.
[0057] Furthermore, the specific implementation process of step S200 is as follows:
[0058] In a specific embodiment of the present invention, referring to the system control architecture and mechanical transmission structure, the execution process of step S200 includes high-frequency acquisition and signal conversion of tension signals, three-state switching closed-loop control based on PID algorithm, smooth constraint of motor speed and acceleration curves, and soft and hard linkage between guide damping wheel and software algorithm.
[0059] In normal operation mode, the quadruped robot drags a composite tethered cable inside the tunnel. The cable is guided by a tension sensing component and a guide damping wheel at the cable reel exit. The tension sensing component integrates a high-precision resistance strain gauge bridge or tension / compression sensor. The mechanical tension applied to the component by the cable causes a minute change in the strain gauge resistance, resulting in a millivolt-level differential voltage signal. A pre-processing circuit amplifies and low-pass filters the signal before inputting it to an analog-to-digital converter (ADC). The ADC converts the analog signal into digital tension data at a sampling frequency of 100Hz or higher, transmitting it in real-time to the microprocessor and tension sensor controller at the ground control terminal.
[0060] After receiving the digital tension data, the microprocessor of the ground control terminal executes a PID closed-loop adaptive following control algorithm in real time. The microprocessor continuously compares the real-time tension value with the preset tension range. In this embodiment, the lower threshold of the preset tension range is set to 5N, and the upper threshold is set to 25N. The PID control algorithm calculates the target speed command of the servo motor based on the deviation between the real-time tension and the preset range, and controls the system to seamlessly switch between three control modes: wire release state, micro-reeling state, and static tension holding state.
[0061] When the quadruped robot moves forward and tightens the composite tethered cable, causing the real-time tension collected by the tension sensing component to exceed the 25N upper limit threshold, the microprocessor calculates the positive deviation between the real-time tension and the 25N upper limit threshold. In the PID control algorithm, the proportional (P) component amplifies the positive deviation value proportionally to generate a positive feed-out speed reference, the integral (I) component eliminates steady-state tension error, and the derivative (D) component predicts the tension change trend to suppress overshoot. The PID control algorithm outputs a positive feed-out speed command to the servo motor driver, controlling the servo motor to drive the reel to rotate forward, performing smooth feed-out. The feed-out speed maintains a positive correlation with the positive tension deviation, achieving responsive cable release.
[0062] When the quadruped robot stops walking, moves backward, or is on a downhill slope, causing the composite tether cable to slack and its real-time tension to fall below the 5N lower limit threshold, the microprocessor calculates the negative deviation between the real-time tension and the 5N lower limit threshold. The PID control algorithm calculates the reverse winding speed command, controls the servo motor driver to drive the servo motor to rotate in the opposite direction to perform low-speed winding, and winds the slack composite tether cable back onto the reel to prevent the cable from dragging on the ground, getting tangled, or being stepped on by the quadruped robot's feet.
[0063] When the quadruped robot stands still or adjusts its posture within a small range to keep the real-time tension within the preset tension range of 5N to 25N, the motor speed command output by the PID control algorithm is zero. The servo motor driver controls the servo motor to maintain a zero-speed servo state or outputs a small holding torque to keep the reel stationary and maintain the composite tethered cable in a preset micro-tension state.
[0064] During the three state transition processes mentioned above, the PID control algorithm controls the adaptive adjustment response time of tension fluctuations to within 20 milliseconds.
[0065] To prevent mechanical shocks from occurring during seamless state transitions or sudden speed changes in the motors, which could disrupt the quadruped robot's gait balance and posture stability, the ground control terminal uses a motion controller to superimpose an acceleration smoothing constraint algorithm on the speed commands before sending them to the servo motor driver. The servo motor driver limits the maximum cable retraction and extension speed of the servo motor to within 0.5 m / s. During motor start-up, shutdown, and forward / reverse switching, the microprocessor uses an S-shaped acceleration / deceleration curve or a fifth-order polynomial speed smoothing algorithm to constrain the rate of change of speed, limiting the maximum values of the motor's angular acceleration and angular jerk, ensuring a smooth transition of the motor's output torque, and eliminating the pulling effect on the quadruped robot's body caused by sudden changes in cable tension.
[0066] At the mechanical and physical buffering level, during the quadruped robot's walking process, the alternating foot strikes generate periodic high-frequency up-and-down jolts on the back of the robot, causing high-frequency transient tension pulses in the tethered cable. The frequency band of these high-frequency tension pulses exceeds the optimal response bandwidth of the PID software algorithm. A rotating viscoelastic structure or damping plate is installed inside the guide damping wheel at the cable reel's output end, with a preset damping coefficient. When the high-frequency transient tension pulse is transmitted along the tethered cable to the guide damping wheel, the guide damping wheel absorbs the high-frequency vibration energy through the shear impedance of its internal damping medium, performing physical low-pass filtering and passive buffering of the tension pulse, reducing the amplitude of tension noise transmitted to the tension sensing component. The passive buffering effect of the mechanical damping wheel and the active adjustment of the software PID closed-loop algorithm form a hardware-software linkage control architecture, jointly maintaining tension stability.
[0067] Furthermore, the specific implementation process of step S300 is as follows:
[0068] During normal operation, the multi-dimensional status monitoring and intelligent disconnection determination module runs independently in the real-time operating system kernel of the ground main control terminal, concurrently executing data acquisition threads at a preset sampling frequency of no less than 100Hz. The ground main control terminal periodically captures the heartbeat data packet reception status of the wired and wireless communication channels through the underlying interface of the communication motherboard, while reading the digital quantization value of the current sensor at the output end of the power supply module, and simultaneously acquiring the cable tension value output by the tension sensor controller and the three-axis attitude and displacement data of the quadruped robot transmitted back by the airborne terminal.
[0069] The multi-dimensional state monitoring and intelligent disconnection determination module internally incorporates a decision tree algorithm with three logical branches. The first logical branch points to the communication link state calculation. The system sends timestamped handshake probe messages to the quadruped robot bidirectionally and maintains a timer in memory. When neither the wired communication interface nor the wireless radio frequency interface receives a response heartbeat signal from the onboard terminal module within the expected time window, and the continuous unresponsive state accumulates to a first preset time of 300 milliseconds, the microprocessor determines that the first disconnection determination condition is met, i.e., a hard interruption has occurred at the communication physical layer or data link layer.
[0070] The second logical branch addresses the calculation of equipment electrical and hardware / software failure states. The ground-based main control terminal performs first-order derivative calculations on the power supply current waveform transmitted to the airborne terminal module to calculate the rate of change of current. When the amplitude of the power supply current drops sharply, exceeding the preset normal fluctuation ratio, and simultaneously no operational status feedback data sent by the quadruped robot's underlying joint controller or application layer is parsed in the communication data receiving buffer, the microprocessor determines that the second disconnection judgment condition is met, i.e., the quadruped robot has experienced motherboard burnout, power failure, or system-level kernel crash.
[0071] The third logical branch addresses the calculation of the quadruped robot's physical trapped state. In the complex terrain of the tunnel, the microprocessor continuously compares the real-time tension of the cable with the kinematic parameters of the quadruped robot's body. When the system reads that the real-time tension of the tethered cable is continuously zero and in a relaxed state, and simultaneously confirms through the inertial measurement unit (IMU) or odometry in the quadruped robot's onboard attitude perception module that the quadruped robot's center of mass displacement remains stationary, and the above-mentioned double superposition characteristics of zero tension and stationary displacement persist for more than 5 seconds on the time axis for a second preset time, the microprocessor determines that the third disconnection judgment condition is met, that is, the quadruped robot is stuck in a rock crevice or has lost its navigation ability, resulting in it being lost and trapped.
[0072] The multi-dimensional status monitoring and intelligent disconnection determination module uses OR logic gates to converge the output Boolean values of the above three logic branches. Once any of the above three determination conditions is met, the system's internal hardware interrupt controller raises the disconnection flag register within a response delay of no more than 1 second, triggering a global disconnection status lock. After the status lock is triggered, the ground master control terminal broadcasts a high-priority emergency stop signal to all control threads, forcibly terminating the tension closed-loop adaptive following retraction mode being executed in step S200, causing the servo motor to exit the PID control closed loop.
[0073] Simultaneously, the communication management unit directly blocks the downlink transmission ports on both wired and wireless channels from the bottom of the protocol stack, cutting off the regular control command transmission channel and maintaining only the receiving port in a one-way listening mode. Through this dual disconnection at both the hardware and protocol levels, the quadruped robot is prevented from receiving residual motion commands and executing incorrect movement actions when trapped or restarting from a crash, thus avoiding further damage to the quadruped robot's joints due to the interaction of mechanical forces or the formation of cable tangles.
[0074] Furthermore, the specific implementation process of step S400 is as follows:
[0075] When the multi-dimensional status monitoring and intelligent disconnection determination module triggers a disconnection status lock, the microprocessor in the ground main control terminal sends a control mode switching command to the servo winding drive module. Upon receiving the command, the servo motor driver switches the underlying control loop from speed closed-loop mode to constant torque output mode. The microprocessor calculates the target torque value based on the current diameter of the winding reel and sends it to the servo motor driver, controlling the servo motor to output a mechanical torque corresponding to a linear constant tension of 20N.
[0076] The servo motor drives the winding reel to rotate in the opposite direction, and the maximum speed is clamped and limited inside the motion controller, so that the winding speed of the composite tethered cable is strictly limited to a safe speed threshold of no more than 0.3 meters per second.
[0077] During constant tension winding, the guide damping wheel located at the wire exit end of the winding reel smooths out the drag resistance fluctuations caused by changes in ground friction through the uniform buffering effect of the internal damping structure, thus smoothly dragging the quadruped robot that is out of contact.
[0078] During emergency constant-force forced recovery, the ground control terminal simultaneously operates a secondary protection mechanism to prevent jamming. The tension sensor controller continuously monitors the dynamic tension value on the composite tethered cable at a high-frequency sampling rate.
[0079] When the microprocessor determines that the dynamically acquired tension experiences a sudden, step-like increase within a preset millisecond time window, and the absolute tension value after the increase exceeds the preset overload protection safety threshold, the microprocessor determines that the quadruped robot is physically stuck in a rock crevice or uneven terrain. Upon determining the sticking, the microprocessor immediately sends an emergency stop and torque zeroing command to the servo motor driver. The servo motor instantly cuts off its power output to passively release tension or pause the winding action. Simultaneously, the microprocessor triggers an audible and visual alarm via the input / output interface to issue a high-frequency sticking alarm and suspends the automatic control thread, awaiting manual intervention from the operator.
[0080] Throughout the entire lifecycle of the emergency recovery mode, the industrial control display and interaction module of the ground main control terminal renders the remaining length of the composite mooring cable to be wound up and the current dynamic tension value in real time through the graphical user interface.
[0081] Meanwhile, the physical panel of the ground control terminal is equipped with an independent hardwired emergency stop switch and a manual control lever. The electrical signals of the hardwired emergency stop switch and the manual control lever are directly connected to the underlying hardware interrupt pin of the servo motor driver, possessing the highest absolute control authority beyond the microprocessor software logic. When the operator receives a jamming alarm or observes abnormal tension data through the industrial control display interaction module, pressing the hardwired emergency stop switch or moving the manual control lever can directly generate the highest priority interrupt signal, forcibly overriding and blocking the automatic winding and unwinding commands of the servo winding drive module, and allowing the operator to manually control the micro-rotation of the winding reel to release the quadruped robot from its physical jamming state.
[0082] During the continuous dragging and retrieval operation, the absolute encoder coaxially mounted at the tail of the servo motor synchronously records the number of rotations of the reel. The stroke detection module uses the number of rotations and the current reel diameter to calculate the cumulative retrieval stroke data of the composite tethered cable in real time. When the difference between the calculated cumulative retrieval stroke data and the total length recorded in the previous cable laying is zero, indicating that the retrieval stroke has reached the starting position on the ground, the microprocessor automatically sends a stop command to the servo motor driver. The servo motor driver cuts off the three-phase current of the motor and simultaneously triggers the mechanical brake mechanism to perform a power-off physical lock. After the power-off lock is completed, the ground main control terminal extracts the system sensor logs, quadruped robot trajectory coordinate data, and underlying control board telemetry data from the data buffer within a specific time period before the triggering of this disconnection state. The above data is written to a solid-state drive or non-volatile storage medium for permanent storage. Finally, a prompt message indicating that the retrieval task has been completed is output through the audio interface and display interface of the industrial control display interaction module.
[0083] The above embodiments are only used to illustrate the technical solutions of the present invention, and are not intended to limit it. Although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art should understand that modifications can still be made to the technical solutions described in the foregoing embodiments, or equivalent substitutions can be made to some of the technical features. Such modifications or substitutions will not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims
1. An integrated tethered power supply, communication, and retrieval control method for a quadrupedal robot used in tunnel inspection, applied to a tethered system comprising a ground-based main control terminal, tethered cables, and an airborne terminal module, characterized in that... Includes the following steps: S100, System initialization and dual-link communication establishment: After the device passes the power-on self-test, a dual-channel transmission link of wireless and wired communication is established between the ground main control terminal and the airborne terminal module, with the wired communication serving as the backup transmission channel. S200, Tension Closed-Loop Adaptive Follow-up Rewinding: In normal operation mode, the ground main control terminal controls the servo winding drive module to dynamically adjust the winding speed of the tethered cable based on the real-time collected tension of the tethered cable, so that the tension of the tethered cable is maintained within the preset tension range. S300, Multi-dimensional Status Monitoring and Intelligent Disconnection Detection: Real-time monitoring of the quadruped robot's operating status. When the monitored communication heartbeat signal, power supply current or cable tension meets at least one of the preset disconnection detection conditions, the quadruped robot is determined to have entered a disconnection state. S400, Emergency Constant Force Forced Recycling: When it is determined that the quadruped robot has entered a disconnected state, switch to emergency recycling mode, control the servo winding drive module to wind up the tether cable with a preset constant tension, and drag the quadruped robot back to the starting position.
2. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 1, characterized in that, In step S100, during the power-on self-test, the specific steps include: Simultaneously or sequentially detect the electrical connectivity of the mooring cable, the zero-point output signal of the tension sensor, the initial motor condition of the servo winding drive module, and the on / off status of the gigabit wired communication link. The system is considered to have passed the self-test and entered the standby mode only when all test items meet the preset normal parameter range; if any test item is abnormal, an alarm is output and the servo winding drive module is controlled to be in a physically locked state. The step S100, which establishes a dual-channel transmission link and uses wired communication as a fallback transmission channel, specifically includes: Under normal operating conditions, the control commands and attitude data of the quadruped robot are transmitted in parallel through both wireless and wired channels. The ground control terminal monitors the signal strength of the wireless channel in real time. When the signal attenuation of the wireless channel exceeds the preset threshold or a link is interrupted, it seamlessly switches to a pure wired backup transmission mode through the gigabit differential communication line inside the mooring cable, keeping the interruption delay of control command issuance and data return below the preset time.
3. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 2, characterized in that, The gigabit differential communication line is surrounded by an independently set electromagnetic shielding layer, and is laid in an alternating and isolated manner with the high-voltage power supply line inside the tethered cable, so as to cancel the electromagnetic interference generated by the high-voltage power supply line when establishing a wired communication channel. In step S100, when establishing a wired communication channel, the gigabit wired communication motherboard in the ground main control terminal and the wired communication adapter board in the airborne terminal module use a differential signal handshake protocol to perform link initialization verification, and lock the communication baud rate after the handshake is successful.
4. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 3, characterized in that, In step S200, based on the real-time collected tension of the tethered cable, the servo winding drive module is controlled to dynamically adjust the winding and unwinding speed of the tethered cable. Specifically, this includes: using a PID closed-loop control algorithm to compare the real-time collected tension of the tethered cable with a preset tension range, and seamlessly switching between the unwinding state, the micro-winding state, and the static tension-maintaining state according to the comparison result; wherein, when the real-time tension is greater than the upper threshold of the preset tension range, the servo winding drive module is controlled to unwind the cable smoothly at a speed proportional to the tension deviation; when the real-time tension is lower than the lower threshold of the preset tension range, the servo winding drive module is controlled to wind the cable at a low speed; when the real-time tension is within the preset tension range, the servo winding drive module is controlled to maintain a static micro-tension state. The lower threshold of the preset tension range is 5N, and the upper threshold is 25N; the adaptive adjustment response time of the PID closed-loop control algorithm to tension changes is no more than 20 milliseconds.
5. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 4, characterized in that, In step S200, the tethered cable is guided by a guide damping wheel and a tension sensing component located at the cable exit end of the reel during the winding and unwinding process; when the winding and unwinding speed is dynamically adjusted, the guide damping wheel provides passive buffering through a preset damping coefficient to counteract the transient tension fluctuations caused by the gait undulations of the quadruped robot. The maximum take-up and untake-up speed of the servo take-up drive module is set to 0.5 m / s. During the seamless state switching process, the motor speed of the servo take-up drive module is constrained by an acceleration smoothing curve to avoid sudden changes in cable tension from impacting the posture stability of the quadruped robot.
6. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 5, characterized in that, In step S300, the multi-dimensional status monitoring and intelligent disconnection determination module collects communication heartbeat packets, power supply parameters, and tension data in real time at a preset frequency. The preset disconnection determination conditions specifically include the following three independent conditions. When any one of them is met, the quadruped robot is determined to be in a disconnection state: Condition 1: The heartbeat signals of wired and wireless communication are continuously unresponsive for a first preset time; Condition 2: The ground main control terminal detects that the power supply current transmitted to the airborne terminal module drops by more than a preset proportion, and no operating condition data is received from the quadruped robot; Condition 3: The real-time tension of the tether cable is continuously zero, and the quadruped robot's posture perception module confirms that the quadruped robot's displacement is stationary for more than a second preset time.
7. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 6, characterized in that, The second preset time is 5 seconds; the data acquisition frequency of the multi-dimensional status monitoring and intelligent disconnection determination module is not less than 100Hz, and the response delay time of the system triggering disconnection status lock and issuing emergency switching command after any disconnection determination condition is met is not greater than 1 second; In step S300, after determining that the quadruped robot has entered a disconnected state and triggering a state lock, the system further includes: forcibly terminating the tension closed-loop adaptive following retraction mode in step S200, and automatically cutting off the conventional control command transmission channel in the gigabit differential communication line, retaining only the one-way status monitoring function, in order to prevent the quadruped robot from performing incorrect actions in a trapped or crashed state, which would aggravate damage to the quadruped robot's body or cause cable knots.
8. The integrated tethered power supply, communication, and recovery control method for a quadrupedal tunnel inspection robot according to claim 7, characterized in that, In step S400, controlling the servo winding drive module to wind up the tethered cable with a preset constant tension specifically includes: the servo winding drive module switching to constant torque output mode, and cooperating with the uniform speed buffer structure of the guide damping wheel located at the cable exit end of the winding reel, to smoothly drag and wind up the quadruped robot in a disconnected state with a constant tension of 20N and a preset safe winding speed of no more than 0.3 m / s; During the emergency constant force forced recovery process, the control method also includes a secondary protection mechanism to prevent jamming: real-time monitoring of the dynamic tension of the tethered cable during the winding process. If the dynamic tension is detected to increase suddenly within a preset time window and exceed the preset overload protection safety threshold, it is determined that the quadruped robot has physically jammed during the dragging process. At this time, the servo winding drive module is controlled to immediately perform instantaneous force release or pause the winding operation, and simultaneously trigger an audible and visual jamming alarm and wait for manual intervention.
9. The integrated tethered power supply, communication, and recovery control method for a tunnel inspection quadruped robot according to claim 8, characterized in that, In step S400, the processing logic for dragging and retrieving the quadruped robot to the starting position specifically includes: synchronously recording the retrieval travel data of the tether cable during the forced retrieval process; when the travel detection module determines that the retrieval travel has reached the starting position on the ground, automatically triggering a stop command and controlling the servo winding drive module to perform a power-off lock; at the same time, the system automatically extracts and retains the running trajectory data and sensor logs within a preset time period before the current disconnection trigger, and issues an interactive prompt indicating that the retrieval is complete. Throughout the entire lifecycle of the emergency recovery mode, the industrial control display and interaction module of the ground main control terminal displays the remaining winding length and current tension value of the cable in real time graphically; and the ground main control terminal is equipped with the highest priority manual intervention control authority, allowing the operator to forcibly take over and override the automatic winding and unwinding actions of the servo winding drive module by triggering the hard-wired emergency stop switch or manual control lever when receiving a jam alarm or observing an anomaly.
10. An integrated tethered power supply, communication, and retrieval system for a quadrupedal tunnel inspection robot, characterized in that: It includes a dual-link initialization module, which is used to establish a dual-channel transmission link of wireless and wired communication between the ground main control terminal and the airborne terminal module after the equipment passes the power-on self-test, and uses the wired communication as a backup transmission channel. The adaptive following rewind module is used in normal operation mode to control the servo rewind drive module to dynamically adjust the rewind speed of the tethered cable based on the tension of the tethered cable collected in real time by the ground main control terminal, so that the tension of the tethered cable is maintained within a preset tension range. The status monitoring and judgment module is used to monitor the operating status of the quadruped robot in real time. When the monitored communication heartbeat signal, power supply current or cable tension meets at least one of the preset disconnection judgment conditions, the quadruped robot is judged to have entered a disconnection state. The emergency forced recovery module is used to switch to emergency recovery mode when the quadruped robot is determined to be out of contact. It controls the servo winding drive module to wind up the tether cable with a preset constant tension, and drags the quadruped robot back to the starting position.
