Robot hand and operation method thereof

By designing support and clamping components for the robotic arm, the problems of monitoring instruments failing to settle and unstable attitude in planetary exploration wells were solved, achieving stable grounding of the instruments and improving signal reception capabilities, thus adapting to various planetary surface soil conditions.

CN119045046AActive Publication Date: 2024-11-29INSTITUTE OF GEOLOGY AND GEOPHYSICS CHINESE ACADEMY OF SCIENCES
View PDF 20 Cites 0 Cited by

Patent Information

Application Number
CN202411229040.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-03
Publication Date
2024-11-29
Estimated Expiration
2044-09-03

AI Technical Summary

Technical Problem

During planetary exploration, when seismometers are deployed in wells, protrusions or unevenness in the well walls can cause monitoring instruments to fail to settle or become unstable, affecting the consistency of observation data.

Method used

Design a robotic arm including a base, a support assembly, and a clamping assembly. The support rod and the clamping rod are driven to extend and retract using a support motor and a clamping motor, respectively pressing against the well wall and the monitoring instruments, and adjusting the posture to ensure a stable seat.

Benefits of technology

It effectively solves the problem of well wall protrusions blocking the monitoring instrument from settling, ensuring that the instrument is firmly grounded, avoiding instability, improving signal reception capability, and adapting to planetary surfaces with different soil properties and particle sizes.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119045046A_ABST
    Figure CN119045046A_ABST
Patent Text Reader

Abstract

The invention relates to a robot arm and an operation method thereof.The robot arm is used for pressing and arranging a monitoring instrument at the bottom of a detection well arranged on a planet, the robot arm comprises a base, a supporting assembly and a pressing assembly, and the base is used for being tightly attached to the monitoring instrument; the supporting assembly is arranged on the base and comprises a supporting motor and a supporting rod, the supporting motor is in transmission connection with the supporting rod, the supporting motor is used for driving the supporting rod to stretch out and draw back in the axial direction of the supporting rod, and the supporting rod is used for abutting against the well wall of a detection well to provide supporting force for the robot arm; the pressing assembly is arranged on the base and comprises a pressing motor and a pressing rod, the pressing motor is in transmission connection with the pressing rod, the pressing motor is used for driving the pressing rod to stretch out and draw back in the axial direction of the pressing rod, and the pressing rod is used for abutting against the monitoring instrument so as to jack the base from the surface of the monitoring instrument and achieve posture adjustment of the robot arm. The pressing rod is further used for pressing and adjusting the posture of the monitoring instrument.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of planetary exploration technology, and in particular to a robot arm and an operating method thereof. Background Art

[0002] In recent years, my country's deep space exploration has made rapid progress and has made unprecedented progress in all fields. The exploration of the internal structure of terrestrial planets has also been gradually put on the agenda. The exploration of the internal structure of planets mainly relies on seismic signals collected by seismometers, and the performance parameters of seismometers are greatly affected by the surface environment temperature. Considering that my country already has the idea of ​​drilling wells on the surface of the moon, it is expected that in the future, when deploying seismometers on the surface of planets, it will be possible to use wells to implement the deployment of seismometers in wells, thereby taking advantage of the low temperature and constant temperature conditions below the surface, which will help improve the temperature stability of the observation environment of the seismometer, obtain high-quality observation data, and promote major scientific output.

[0003] When laying seismometers in wells, the properties and particle size of the soil on the surface of each planet are still unclear, and large particles in the soil will block or affect the seismometer from landing on the bottom of the well, and even affect the coupling between the seismometer and the ground at the bottom of the well. Therefore, at this stage, it is necessary to try to ensure that the instrument can land on the bottom and remain compacted during unmanned deployment at the bottom of the well to avoid unstable instrument posture and affect the consistency of observation data. Summary of the invention

[0004] Based on this, it is necessary to provide a robot arm and an operating method thereof to solve the problem of failure of the monitoring instrument to seat on the bottom of the well due to protrusions of stones on the wall of the detection well or unevenness of the well bottom.

[0005] A robot arm is used to compact and arrange a monitoring instrument at the bottom of a detection well arranged on a planet, the robot arm comprising:

[0006] A base, used to be in close contact with the monitoring instrument;

[0007] A support assembly is arranged on the base, the support assembly includes a support motor and a support rod, the support motor is in transmission connection with the support rod, the support motor is used to drive the support rod to extend and retract along its own axial direction, and the support rod is used to press against the well wall of the detection well to provide support force for the robot arm; and

[0008] A clamping assembly is arranged on the base, and the clamping assembly includes a clamping motor and a clamping rod. The clamping motor is transmission-connected to the clamping rod, and the clamping motor is used to drive the clamping rod to extend and retract along its own axial direction. The clamping rod is used to push against the monitoring instrument to lift the base from the surface of the monitoring instrument and realize the posture adjustment of the robot arm. The clamping rod is also used to clamp and adjust the posture of the monitoring instrument.

[0009] In one embodiment, the supporting assembly and the clamping assembly each include a plurality of them, wherein the plurality of the supporting assemblies are spaced apart on the base, and the plurality of the clamping assemblies are spaced apart on the base.

[0010] In one embodiment, the robot arm also includes a first sensor and / or a second sensor, the first sensor is arranged on the support rod, and the first sensor is used to detect the resistance force of the support rod on the wall of the detection well, and the second sensor is arranged on the clamping rod, and the second sensor is used to detect the resistance force of the clamping rod on the monitoring instrument.

[0011] In one embodiment, the robot arm further includes a control panel, which is disposed on the base and electrically connected to the support motor and the clamping motor.

[0012] In one embodiment, the robot arm further includes a third sensor, which is disposed on the control panel and is used to detect posture information of the robot arm.

[0013] In one embodiment, the base is a box structure, the cross-section of the base is annular, the base has a central through hole, the central through hole is used for the passage of power supply and communication cables of the monitoring instrument, the base includes a base and a box cover that are relatively arranged, the base and the box cover are coaxially arranged, the base and the box cover are both provided with the central through hole, and the supporting motor and the clamping motor are both arranged on the base.

[0014] In one embodiment, the support motor is fixed to the base via a coupling cone, the clamping rod can pass through the central through hole of the base and the box cover, and the clamping rod is arranged adjacent to the hole wall of the central through hole of the base and the box cover.

[0015] A method for operating the above-mentioned robot arm comprises the following steps:

[0016] S1. The robot arm and the monitoring instrument are placed close together, and the robot arm follows the monitoring instrument to fall in the detection well set on the planet;

[0017] S2. After the robot arm follows the monitoring instrument and stops falling in the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axial direction, so that the clamping rod abuts against the monitoring instrument to lift the base from the surface of the monitoring instrument, and adjusts the posture of the robot arm to be horizontal;

[0018] S3. After the posture of the robot arm is adjusted to be horizontal, the support motor is controlled to drive the support rod to extend and retract along its own axial direction, so that the support rod is pressed against the wall of the detection well to provide support force for the robot arm;

[0019] S4. After the support rod is pressed against the wall of the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axial direction, so that the clamping rod presses against the monitoring instrument to adjust the posture of the monitoring instrument to be horizontal, and the monitoring instrument is pressed and arranged at the bottom of the detection well.

[0020] In one embodiment, the robot arm includes three clamping assemblies, which are arranged on the base at intervals; the robot arm also includes a control board, which is arranged on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a third sensor, which is arranged on the control board, and the number of the third sensors is two, and the two third sensors are used to detect the pitch angle and roll angle of the robot arm respectively;

[0021] The step S2 of adjusting the posture of the robot hand to be horizontal includes:

[0022] S211. Determine the step angle of the clamping motor, and set the step length of the clamping rod corresponding to the step angle of the selected clamping motor to l step ;

[0023] S212. Set the length of each clamping rod to be extended synchronously to L, and the number of steps output by the clamping motor is:

[0024] n C =L / l step

[0025] S213. According to the specifications of the clamping motor and the control board, configure the frequency and duty cycle to generate a pulse waveform of the clamping motor;

[0026] S214. Set the pitch angle of the robot hand output by the third sensor A1 to α1, and the roll angle of the robot hand output by the third sensor A2 to α2;

[0027] If |α1|>2°, the number of steps output by the clamping motor C1 is:

[0028] n C1 =R*sinα1 / l step

[0029] The number of steps output by the clamping motor C2 and the clamping motor C3 are:

[0030] n C2 =-R*cos60°*sinα1 / lstep ,

[0031] n C3 =n C2

[0032] Wherein, R is the distance between the clamping rod and the center of the robot hand;

[0033] If |α2|>2°, the number of steps output by the clamping motor C1 is 0;

[0034] The number of steps output by the clamping motor C2 and the clamping motor C3 are:

[0035] n C2 =R*cos30°*sinα2 / l step ,

[0036] n C3 =-n C2

[0037] If |α1|≤2° and |α2|≤2°, the robot arm is judged to be in a horizontal position.

[0038] In one embodiment, the robot arm includes two support assemblies, which are spaced apart on the base; the robot arm also includes a control panel, which is disposed on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a first sensor, which is disposed on the support rod, and is used to detect the push force of the support rod on the well wall of the detection well, and the number of the first sensors is two, and the two first sensors correspond to the two support rods respectively;

[0039] The step S3 of controlling the support motor to drive the support rod to extend and retract along its own axial direction so that the support rod is pressed against the wall of the detection well to provide support force for the robot arm comprises:

[0040] S31. Determine the step angle of the support motor and set the step angle of the selected support motor to l step ;

[0041] S32. According to the specifications of the support motor and the control board, configure the frequency and duty cycle to generate a pulse waveform for supporting the motor;

[0042] S33. The two support motors S1 and S2 drive the two support rods SR1 and SR2 to extend outward respectively, and monitor the top force value V of the support rod SR1 output by the first sensor SS1 at the same time. SS1 , the push force value V of the support rod SR2 output by the first sensor SS2 SS2 ;

[0043] S34. According to engineering experience and the selection of pressure sensors, when the support rod is pressed against the well wall, the maximum value of the output of the first sensor SS1 and SS2 is V MAX , set |V SS1 -V SS2 The threshold value of | is V SS ;

[0044] If V SS1 -V SS2 ≥V SS , then stop driving the support rod SR1 to extend outward, and continue to drive the support rod SR2 to extend outward until -V SS <V SS1 -V SS2 <V SS ;

[0045] If V SS1 -V SS2 ≤-V SS , then stop driving the support rod SR2 to extend outward, and continue to drive the support rod SR1 to extend outward until -V SS <V SS1 -V SS2 <V SS ;

[0046] When V SS1 ≥V MAX And V SS2 ≥V MAX , stop driving the support rods SR1 and SR2 to extend outward. At this time, it is determined that the support rods SR1 and SR2 are both pressed against the well wall.

[0047] In one embodiment, the step S4 of controlling the clamping motor to drive the clamping rod to extend and retract along its own axial direction so that the clamping rod abuts against the monitoring instrument to adjust the posture of the monitoring instrument to be horizontal, and clamping and arranging the monitoring instrument at the bottom of the detection well includes:

[0048] S41. Use the sliding mode control algorithm to control the compaction motors C1, C2, and C3 to drive the corresponding compaction rods CR1, CR2, and CR3 respectively, and push the monitoring instrument downward to bypass the obstruction of the well wall protrusion and continue to fall to the bottom of the well, or compact the monitoring instrument with the soil at the bottom of the well, and adjust the depth of the compaction rod according to the pitch angle, roll angle, and azimuth angle output by the three fourth sensors Y1, Y2, and Y3 of the monitoring instrument, so as to adjust the posture of the monitoring instrument to be horizontal;

[0049] S42. After the clamping process is completed, the clamping motors C1, C2, and C3 are controlled to drive the corresponding clamping rods CR1, CR2, and CR3 to retract to achieve separation from the monitoring instrument;

[0050] The sliding mode control algorithm is described by the following first-order dynamic equation:

[0051]

[0052] where the design parameter β > 0 and the system state x ∈ R 1 , both q and p are odd numbers, and q < p < 2q. Solving from the above equation:

[0053]

[0054] Set the time from the initial state x(0) ≠ 0 to x = 0 as t s , t s can be determined by the following equation:

[0055]

[0056] where the origin is a terminal attractor, and the system state x will converge to zero within a finite time t s ;

[0057] The Jacobian determinant of the dynamic equation near the equilibrium point x = 0 is:

[0058]

[0059] Regarding J as the eigenvalue λ of the first-order approximation matrix, then there is:

[0060] J → -∞ when x → 0 +

[0061] At the equilibrium point, the eigenvalue λ tends to negative infinity, and here |J| < ∞ is not satisfied, that is, the Lipschitz condition to ensure the uniqueness and existence of the solution of the differential equation at the origin is not satisfied, and J is singular at the point x = 0. When the Lipschitz condition is not satisfied, the system state reaches the equilibrium point in a finite time.

[0062] When the robot hand provided by the present invention is used, first, the robot hand and the monitoring instrument are closely attached, and the robot hand follows the monitoring instrument and descends in the exploration well; after the descending action of the robot hand following the monitoring instrument in the exploration well stops, control the pressing motor to drive the pressing rod to axially expand and contract along its own axis, so that the pressing rod abuts against the monitoring instrument to lift the base from the surface of the monitoring instrument, and adjust the posture of the robot hand to horizontal; after the posture of the robot hand is adjusted to horizontal, control the supporting motor to drive the supporting rod to axially expand and contract along its own axis, so that the supporting rod abuts tightly against the well wall of the exploration well to provide a supporting force for the robot hand; after the supporting rod abuts tightly against the well wall of the exploration well, control the pressing motor to drive the pressing rod to axially expand and contract along its own axis, so that the pressing rod abuts against the monitoring instrument to adjust the posture of the monitoring instrument to horizontal, and press and arrange the monitoring instrument at the bottom of the exploration well;

[0063] Therefore, the robot arm of the present invention can solve the problems of failure in setting up the platform and overturning of the monitoring instrument due to protrusions (such as stones) on the wall of the detection well blocking the monitoring instrument from sitting on the bottom, by pressing and seating the monitoring instrument. Even if the detection well is located on a hard rock base, the grounding and stability of the monitoring instrument can be ensured, and it can adapt to all working conditions in the well. At the same time, by pressing and seating the monitoring instrument on the bottom, the robot arm can effectively prevent the monitoring instrument from rotating or swinging at will during the planetary monitoring process, improve the stability of the installation posture of the monitoring instrument, and thus ensure the smooth implementation of the monitoring instrument's detection task. The robot arm of the present invention can also adapt to the soil properties of various planetary surfaces, and can work normally in soil conditions with different particle sizes and viscosities, ensuring that the monitoring instrument is tightly grounded, which is beneficial to improving the signal receiving capability of the monitoring instrument. BRIEF DESCRIPTION OF THE DRAWINGS

[0064] Figure 1 A schematic diagram of a combination of a robot arm and a monitoring instrument provided by an embodiment of the present invention;

[0065] Figure 2 A schematic diagram of the structure of a robot arm provided by an embodiment of the present invention;

[0066] Figure 3 A cross-sectional view of a robot hand provided by an embodiment of the present invention;

[0067] Figure 4 A schematic diagram of the partial structure of a robot arm provided in an embodiment of the present invention. DETAILED DESCRIPTION

[0068] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. The preferred embodiments of the present invention are given in the drawings. However, the present invention can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the understanding of the disclosure of the present invention more thorough and comprehensive.

[0069] It should be noted that when an element is said to be "fixed to" another element, it can be directly on the other element or there can be an intermediate element. When an element is determined to be "connected to" another element, it can be directly connected to the other element or there can be an intermediate element at the same time.

[0070] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present invention. The terms used in the specification of the present invention herein are only for the purpose of describing specific embodiments and are not intended to limit the present invention.

[0071] refer to Figure 1 The present application provides a robot arm 100, which is used to compact and deploy a monitoring instrument 200 at the bottom of a detection well disposed on a planet. Specifically, the monitoring instrument 200 may be a seismograph or other similar instruments similar to a seismograph.

[0072] refer to Figure 2 The robot 100 includes a base 110, a support assembly 120 and a pressing assembly 130. The base 110 is used to be in close contact with the monitoring instrument 200; the support assembly 120 is arranged on the base 110, and the support assembly 120 includes a support motor 121 and a support rod 122. The support motor 121 is connected to the support rod 122 in a transmission manner. The support motor 121 is used to drive the support rod 122 to extend and retract along its own axial direction. The support rod 122 is used to press against the wall of the detection well to provide support for the robot 100. Support force; the clamping assembly 130 is arranged on the base 110, and the clamping assembly 130 includes a clamping motor 131 and a clamping rod 132. The clamping motor 131 is connected to the clamping rod 132 in a transmission manner. The clamping motor 131 is used to drive the clamping rod 132 to extend and retract along its own axial direction. The clamping rod 132 is used to push against the monitoring instrument 200 to lift the base 110 from the surface of the monitoring instrument 200 and realize the posture adjustment of the robot arm 100. The clamping rod 132 is also used to clamp and adjust the posture of the monitoring instrument 200.

[0073] When the robot 100 provided by the present invention is used, the robot 100 and the monitoring instrument 200 are first placed in close contact, and the robot 100 follows the monitoring instrument 200 to fall in the detection well; after the robot 100 follows the monitoring instrument 200 to fall in the detection well and stops, the clamping motor 131 is controlled to drive the clamping rod 132 to extend and retract along its own axial direction, so that the clamping rod 132 presses against the monitoring instrument 200 to lift the base 110 from the surface of the monitoring instrument 200, and adjusts the posture of the robot 100 to be horizontal; when the robot 100 stops falling in the detection well, the clamping motor 131 is controlled to drive the clamping rod 132 to extend and retract along its own axial direction, so that the clamping rod 132 presses against the monitoring instrument 200 to lift the base 110 from the surface of the monitoring instrument 200, and adjusts the posture of the robot 100 to be horizontal; After the posture of the hand 100 is adjusted to be horizontal, the support motor 121 is controlled to drive the support rod 122 to extend and retract along its own axial direction, so that the support rod 122 is pressed against the wall of the detection well to provide support force for the robot hand 100; after the support rod 122 is pressed against the wall of the detection well, the clamping motor 131 is controlled to drive the clamping rod 132 to extend and retract along its own axial direction, so that the clamping rod 132 is pressed against the monitoring instrument 200 to adjust the posture of the monitoring instrument 200 to be horizontal, and the monitoring instrument 200 is pressed and arranged at the bottom of the detection well;

[0074] Therefore, the robot arm 100 of the present invention can solve the problems of failure of deployment and overturning of the monitoring instrument 200 due to the protrusions (such as stones) on the wall of the detection well blocking the monitoring instrument 200 from sitting on the bottom, even if the location of the detection well is a hard rock base, it can ensure the grounding and stability of the monitoring instrument 200 and adapt to all working conditions in the well; at the same time, by pressing the monitoring instrument 200 with the robot arm 100, it can effectively prevent the monitoring instrument 200 from rotating or swinging randomly during the planetary monitoring process, improve the stability of the installation posture of the monitoring instrument 200, thereby ensuring the smooth implementation of the detection task of the monitoring instrument 200, and the robot arm 100 of the present invention can also adapt to the soil properties of various planetary surfaces, and can work normally in soil conditions with different particle sizes and viscosities, ensuring that the monitoring instrument 200 is tightly grounded, which is beneficial to improving the signal receiving capability of the monitoring instrument 200.

[0075] refer to Figure 2 and Figure 3 The base 110 can be a box structure. The cross-section of the base 110 is annular. The base 110 has a central through hole 113. The central through hole 113 is used for the installation of power supply and communication cables of the monitoring instrument 200. Specifically, the base 110 includes a base 111 and a box cover 112 that are relatively arranged. The base 111 and the box cover 112 are coaxially arranged. The base 111 and the box cover 112 are both provided with a central through hole 113. The support motor 121 and the clamping motor 131 are both arranged on the base 111. The support motor 121 is fixed to the base 111 through a coupling cone 123. The clamping rod 132 can pass through the central through hole 113 of the base 111 and the box cover 112, and the clamping rod 132 is arranged adjacent to the hole wall of the central through hole 113 of the base 111 and the box cover 112.

[0076] In order to improve the bottom-seating and clamping performance of the robot arm 100 , the support assembly 120 and the clamping assembly 130 each include a plurality of support assemblies 120 and a plurality of clamping assemblies 130 , wherein the plurality of support assemblies 120 are disposed at intervals on the base 110 , and the plurality of clamping assemblies 130 are disposed at intervals on the base 110 .

[0077] refer to Figure 4 Preferably, the supporting components 120 include two, the pressing components 130 include three, the two supporting components 120 are arranged at intervals on the base 110, and the three pressing components 130 are arranged at intervals on the base 110. Specifically, the two supporting components 120 are symmetrically arranged on both sides of the base 110 along the radial direction of the base 110, and the three pressing components 130 are evenly spaced around the center of the base 110.

[0078] Furthermore, the robot arm 100 also includes a first sensor, which is arranged on the support rod 122. Specifically, the first sensor is embedded in one end of the support rod 122 (specifically, the end of the support rod 122 that presses against the wall of the detection well). The first sensor is used to detect the pressing force of the support rod 122 on the wall of the detection well, so that the operator can reasonably adjust the extension and retraction amount of the support rod 122 according to the detection result of the first sensor to avoid the problem of the support rod 122 extending too long or too short.

[0079] Furthermore, the robot arm 100 also includes a second sensor, which is arranged on the clamping rod 132. Specifically, the second sensor is embedded in one end of the clamping rod 132 (specifically, the end of the clamping rod 132 that presses against the monitoring instrument 200). The second sensor is used to detect the pressing force of the clamping rod 132 on the monitoring instrument 200. In this way, the operator can reasonably adjust the extension and retraction amount of the clamping rod 132 according to the detection result of the second sensor to avoid the problem of the clamping rod 132 extending too long or too short.

[0080] refer to Figure 2 Furthermore, the robot 100 further includes a control panel 140, which is disposed on the base 110 and is electrically connected to the support motor 121 and the clamping motor 131. The control panel 140 is used to control the support motor 121 and the clamping motor 131 to drive the support rod 122 and the clamping rod 132 to move in a telescopic manner. Specifically, the control panel 140 is the core processor of the robot 100, and is also used to read the posture information of the robot 100 and the posture information of the monitoring instrument 200, and to control the support motor 121 and the clamping motor 131 to drive the support rod 122 and the clamping rod 132 to move in a telescopic manner, thereby completing the bottom-seating and clamping function of the monitoring instrument 200.

[0081] Specifically, the control board 140 is arranged on the base 111 through the first support column 150, the control board 140 is located between the base 111 and the box cover 112, and the box cover 112 is connected to the control board 140 through the second support column 160. Specifically, the control board 140, the base 111 and the box cover 112 are arranged in parallel, the first support column 150 and the second support column 160 are arranged coaxially, and the length of the first support column 150 is greater than the length of the second support column 160, that is, the distance between the base 111 and the control board 140 is greater than the distance between the box cover 112 and the control board 140.

[0082] The support motor 121 controls the rotation of its power output shaft through the pulse waveform fed back by the control board 140, and the power output shaft is connected to the support rod 122, thereby controlling the extension and retraction amount of the support rod 122, completing the support function of the robot arm 100 on the well wall.

[0083] The support assembly 120 further includes a first driver, which is electrically connected to the support motor 121 and the control board 140. Specifically, the pulse waveform generated by the control board 140 is demodulated by the first driver and output to the support motor 121 through the connection interface. Further, the support assembly 120 further includes a first encoder, which is electrically connected to the support motor 121. The first encoder is used to monitor the accurate position of the support motor 121 and provide feedback of the actual position of the support motor 121, thereby adjusting the control signal to ensure that the support motor 121 operates as expected.

[0084] Furthermore, the clamping motor 131 controls the rotation of its power output shaft through the pulse waveform fed back by the control board 140 , and the power output shaft is connected to the clamping rod 132 to control the extension and retraction amount of the clamping rod 132 , thereby completing the bottoming and clamping functions of the monitoring instrument 200 .

[0085] The clamping assembly 130 further includes a second driver, which is electrically connected to the clamping motor 131 and the control board 140. Specifically, the pulse waveform generated by the control board 140 is demodulated by the second driver and then output to the clamping motor 131 through the connection interface. Furthermore, the clamping assembly 130 further includes a second encoder, which is electrically connected to the clamping motor 131. The second encoder is used to monitor the exact position of the clamping motor 131 and provide feedback on the actual position of the clamping motor 131, thereby adjusting the control signal to ensure that the clamping motor 131 operates as expected.

[0086] The robot 100 also includes a third sensor, which is disposed on the control board 140 and is used to detect posture information of the robot 100 . Specifically, the third sensor includes two third sensors, which are respectively used to detect the pitch angle and roll angle of the robot 100 .

[0087] Furthermore, a fourth sensor is also provided on the monitoring instrument 200, and the fourth sensor is used to detect the posture information of the monitoring instrument 200. Specifically, the fourth sensor includes three sensors, and the three fourth sensors are used to detect the vertical inclination angles (i.e., pitch angle, roll angle, and azimuth angle) of the monitoring instrument 200, respectively, in the horizontal east-west direction, and horizontal north-south direction.

[0088] refer to Figure 2 The robot 100 also includes a wiring tube 170, which is arranged on the box cover 112. The wiring tube 170 is used for the wiring of power supply and communication cables of the robot 100. In order to prevent the power supply and communication cables from being entangled with other parts of the robot 100 when they fall, the wiring tube 170 is bent, and the interface of the wiring tube 170 faces the outside of the base 110.

[0089] The present application also provides a method for operating a robot arm, comprising the following steps:

[0090] S1. Place the robot arm and the monitoring instrument close together, and make the robot arm follow the monitoring instrument to fall into the detection well set on the planet;

[0091] S2. After the manipulator follows the monitoring instrument and stops falling in the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axis, so that the clamping rod abuts against the monitoring instrument to lift the base from the surface of the monitoring instrument, and adjusts the posture of the manipulator to be horizontal;

[0092] S3. When the robot is adjusted to a horizontal position, the support motor is controlled to drive the support rod to extend and retract along its own axis so that the support rod is pressed against the wall of the detection well to provide support for the robot;

[0093] S4. After the support rod is pressed against the wall of the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axial direction, so that the clamping rod presses against the monitoring instrument to adjust the posture of the monitoring instrument to be horizontal, and the monitoring instrument is pressed and arranged at the bottom of the detection well.

[0094] Further, step S2 of controlling the clamping motor to drive the clamping rod to extend and retract along its own axial direction so that the clamping rod abuts against the monitoring instrument to lift the base from the surface of the monitoring instrument and adjust the posture of the robot arm to be horizontal includes:

[0095] Step S21, when the robot arm stops falling in the detection well following the monitoring instrument, the control board 140 controls the three clamping motors C1, C2, and C3 to synchronously drive the corresponding clamping rods CR1, CR2, and CR3 to extend and retract along their own axes, so that each clamping rod can synchronously press against the monitoring instrument to lift the base from the surface of the monitoring instrument, reserving operating space for subsequent actions. At the same time, the control board 140 adjusts the height of the robot arm lifted by the clamping rods according to the pitch angle and roll angle of the robot arm detected by the two third sensors A1 and A2 of the robot arm, thereby adjusting the posture of the robot arm to be horizontal (that is, the inclination angle of the robot arm is adjusted to the minimum within the movable range).

[0096] In this embodiment, the robot arm includes three clamping assemblies, which are arranged on the base at intervals; the robot arm also includes a control board, which is arranged on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a third sensor, which is arranged on the control board. The number of the third sensors is two, and the two third sensors are used to detect the pitch angle and roll angle of the robot arm respectively;

[0097] The step S2 of adjusting the posture of the robot hand to be horizontal includes:

[0098] S211. Determine the step angle of the clamping motor and set the step length of the clamping rod corresponding to the step angle of the selected clamping motor to l step ;

[0099] S212. Set the length of each clamping rod to be extended synchronously to L, and the number of steps output by the clamping motor is:

[0100] n C =L / l step

[0101] S213. According to the specifications of the clamping motor and the control board, configure the frequency and duty cycle to generate a pulse waveform of the clamping motor; optionally, the pulse waveform can be a PWM waveform.

[0102] S214. Set the pitch angle of the robot hand output by the third sensor A1 to α1, and the roll angle of the robot hand output by the third sensor A2 to α2;

[0103] If |α1|>2°, the number of steps output by the clamping motor C1 is:

[0104] n C1 =R*sinα1 / l step

[0105] The number of steps output by the clamping motor C2 and the clamping motor C3 are:

[0106] n C2 =-R*cos60°*sinα1 / l step ,

[0107] n C3 =n C2

[0108] Wherein, R is the distance between the clamping rod and the center of the robot hand;

[0109] If |α2|>2°, the number of steps output by the clamping motor C1 is 0;

[0110] The number of steps output by the clamping motor C2 and the clamping motor C3 are:

[0111] n C2 =R*cos30°*sinα2 / l step ,

[0112] n C3 =-n C2

[0113] If |α1|≤2° and |α2|≤2°, the robot arm is judged to be in a horizontal position.

[0114] In one embodiment, the step length l of the pressing rod step =0.5mm, the length of each clamping rod extending synchronously is L=50mm; the number of steps output by the clamping motor is:

[0115]

[0116] According to the specifications of the clamping motor and the control board, the frequency is configured to be 5 Hz and the duty cycle is 50% to generate the pulse waveform PWM of the clamping motor;

[0117] The pitch angle α1 of the robot arm output by the third sensor A1 is set to 5°, the roll angle α2 of the robot arm output by the third sensor A2 is set to 1°, and R is set to 300;

[0118] At this time, |α1|>2°, and the number of steps output by the clamping motor C1 is:

[0119]

[0120] The number of steps output by the clamping motor C2 and the clamping motor C3 are:

[0121]

[0122] n C3 =n C2 =26

[0123] At this time, |α2|≤2°, and it is determined that the Y-axis direction of the robot is horizontal.

[0124] Further, the robot arm includes two support assemblies, which are spaced apart and arranged on the base; the robot arm also includes a control panel, which is arranged on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a first sensor, which is arranged on the support rod, and the first sensor is used to detect the push force of the support rod on the well wall of the detection well, and the number of the first sensors is two, and the two first sensors correspond to the two support rods one by one respectively;

[0125] Step S3 of controlling the support motor to drive the support rod to extend and retract along its own axial direction so that the support rod is pressed against the wall of the detection well to provide support force for the robot arm includes:

[0126] S31. Determine the step angle of the support motor and set the step angle of the selected support motor to l step ;

[0127] S32. According to the specifications of the supporting motor and the control board, configure the frequency and duty cycle to generate a pulse waveform for the supporting motor; optionally, the pulse waveform may be a PWM waveform.

[0128] S33. The two support motors S1 and S2 drive the two support rods SR1 and SR2 to extend outward respectively, and monitor the top force value V of the support rod SR1 output by the first sensor SS1 at the same time. SS1 , the push force value V of the support rod SR2 output by the first sensor SS2SS2 ;

[0129] S34. According to engineering experience and the selection of pressure sensors, when the support rod is pressed against the well wall, the maximum value of the output of the first sensor SS1 and SS2 is V MAX , set |V SS1 -V SS2 The threshold value of | is V SS ;

[0130] If V SS1 -V SS2 ≥V SS , then stop driving the support rod SR1 to extend outward, and continue to drive the support rod SR2 to extend outward until -V SS <V SS1 -V SS2 <V SS ;

[0131] If V SS1 -V SS2 ≤-V SS , then stop driving the support rod SR2 to extend outward, and continue to drive the support rod SR1 to extend outward until -V SS <V SS1 -V SS2 <V SS ;

[0132] When V SS1 ≥V MAX And V SS2 ≥V MAX , stop driving the support rods SR1 and SR2 to extend outward. At this time, it is determined that the support rods SR1 and SR2 are both pressed against the well wall.

[0133] In one embodiment, the maximum value V output by the first sensors SS1 and SS2 is set MAX =5V, set |V SS1 -V SS2 The threshold value V SS =0.5V;

[0134] If V SS1 -V SS2 ≥0.5, stop driving the support rod SR1 to extend outward, and continue to drive the support rod SR2 to extend outward until -0.5 <V SS1 -V SS2 <0.5;

[0135] When V SS1 ≥5V and V SS2 ≥5V, stop driving the support rods SR1 and SR2 to extend outward. At this time, it is determined that the support rods SR1 and SR2 are both pressed against the well wall.

[0136] Further, the step S4 of controlling the pressing motor to drive the pressing rod to axially expand and contract along its own axis, so that the pressing rod abuts against the monitoring instrument to adjust the attitude of the monitoring instrument to horizontal and pressing and arranging the monitoring instrument at the bottom of the detection well includes:

[0137] S41. Adopt a sliding mode control algorithm to control the pressing motors C1, C2, and C3 to drive the corresponding pressing rods CR1, CR2, and CR3 respectively, push the monitoring instrument downward to bypass the obstruction of the wellbore bulge and continue to fall to the bottom of the well, or couple the monitoring instrument with the bottom soil tightly, and adjust the pressing depth of the pressing rod according to the pitch angle, roll angle, and azimuth angle output by the three fourth sensors Y1, Y2, and Y3 of the monitoring instrument, so as to adjust the attitude of the monitoring instrument to horizontal (that is, adjust the inclination angle of the monitoring instrument to the minimum within the movable range);

[0138] The sliding mode control algorithm is described by the following first-order dynamic equation:

[0139]

[0140] In the formula, the design parameter β>0, the system state x∈R 1 , both q and p are odd numbers, and q<p<2q. Solved from the above formula:

[0141]

[0142] Set the time from the initial state x(0)≠0 to x = 0 as t s , t s Can be determined by the following formula:

[0143]

[0144] Among them, the origin is a terminal attractor, and the system state x will converge to zero within a finite time t s ;

[0145] The Jacobian determinant of the dynamic equation near the equilibrium point x = 0 is:

[0146]

[0147] Regard J as the eigenvalue λ of the first-order approximation matrix, then there is:

[0148] J→-∞ when x→0 +

[0149] At the equilibrium point, the eigenvalue λ tends to negative infinity, where |J|<∞ is not satisfied, that is, the Lipschitz condition that guarantees the uniqueness and existence of the solution of the differential equation at the origin is not satisfied, and J is singular at x=0. When the Lipschitz condition is not satisfied, the system state reaches the equilibrium point in a finite time;

[0150] S42. After the clamping process is completed, the clamping motors C1, C2, and C3 are controlled to drive the corresponding clamping rods CR1, CR2, and CR3 to retract respectively, so as to separate from the monitoring instrument.

[0151] Optionally, step S4 includes:

[0152] S411. Set the target pitch angle and roll angle of the monitoring instrument to zero, that is, set the attitude of the monitoring instrument to horizontal;

[0153] TARGET_PITCH_ANGLE 0.0,

[0154] TARGET_ROLL_ANGLE 0.0

[0155] S412. Setting the proportional parameters of the sliding mode control algorithm to control the response speed and stability of the sliding mode controller;

[0156] #define K1 0.1

[0157] #define K2 0.1

[0158] #define K3 0.2

[0159] S413. Define a sliding mode function to convert the error into the direction of the control input;

[0160] double s_function(double error){

[0161] return error>=0?1:-1;

[0162] }

[0163] The sliding mode function returns 1 or -1 according to the positive or negative value of the input parameter (i.e. error);

[0164] S414. Define the control function of the clamping motor;

[0165] void stepper_control(double length1,double length2,double length3){

[0166] set_stepper1_position(length1);

[0167] set_stepper2_position(length2);

[0168] set_stepper3_position(length3);

[0169] }

[0170] S415 defines monitoring of three second sensors CS1, CS2, CS3;

[0171]

[0172] S416. In the main function of the sliding mode control algorithm, the pitch angle and roll angle output by the two fourth sensors Y1 and Y2 of the monitoring instrument are read;

[0173] int main(){

[0174] pitch_angle=Y1;

[0175] roll_angle = Y2;

[0176] S417. Calculate the error between the actual attitude angle of the monitoring instrument and the target attitude angle;

[0177] while(1){

[0178] double pitch_error=TARGET_PITCH_ANGLE-pitch_angle;

[0179] double roll_error=TARGET_ROLL_ANGLE-roll_angle;

[0180] S418. Apply the sliding mode control algorithm to calculate the control amount according to the attitude angle error and the control parameter, where the negative sign indicates the control direction;

[0181] double u1=-K1*s_function(pitch_error);

[0182] double u2=-K2*s_function(roll_error);

[0183] double u3=-K3*s_function(pitch_error);

[0184] S419. Send the calculated control amount to the clamping motors C1, C2, and C3 to control the telescopic lengths of the corresponding clamping rods CR1, CR2, and CR3;

[0185] stepper_control(u1,u2,u3);

[0186] S420. Check whether the pressure values ​​output by the three second sensors CS1, CS2, and CS3 exceed the threshold;

[0187] if (check_pressure_sensors()) {

[0188] break;

[0189] }

[0190] S421. If the pressure value output by one of the second sensors exceeds the threshold, the pitch angle and roll angle of the robot are updated, and step S412 is re-executed;

[0191] pitch_angle+=u1;

[0192] roll_angle+=u2;

[0193] S422. When the error of the attitude angle of the monitoring instrument is less than the preset threshold, the process ends and exits the loop. At this time, it is determined that the attitude of the monitoring instrument is horizontal;

[0194] if(fabs(pitch_error)<0.01&&fabs(roll_error)<0.01){

[0195] break;

[0196] }

[0197] S423. Control the three clamping rods CR1, CR2, CR3 to extend outward synchronously, and monitor the pressure output values ​​of the three second sensors CS1, CS2, CS3 pressure_sensor1, pressure_sensor2, pressure_sensor3;

[0198] S424. When the pressure output values ​​of the three second sensors CS1, CS2, and CS3 are greater than or equal to the pressure threshold, the three clamping motors C1, C2, and C3 stop working, and the robot clamps the monitoring instrument and arranges it at the bottom of the detection well;

[0199] pressure_sensor1>=PRESSURE_THRESHOLD||

[0200] pressure_sensor2>=PRESSURE_THRESHOLD||

[0201] pressure_sensor3>=PRESSURE_THRESHOLD;

[0202] S425. After the clamping process is completed, the clamping motors C1, C2, and C3 are controlled to drive the corresponding clamping rods CR1, CR2, and CR3 to retract respectively to achieve separation from the monitoring instrument, and the bottoming and clamping operations of the monitoring instrument are completed.

[0203] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be determined to be within the scope of this specification.

[0204] The above embodiments only express the preferred implementation modes of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for those of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.

Claims

1. A robot arm, used to compact and deploy monitoring instruments at the bottom of a detection well set on a planet, characterized in that: The robot arm comprises: A base, used to be in close contact with the monitoring instrument; A support assembly is arranged on the base, the support assembly includes a support motor and a support rod, the support motor is in transmission connection with the support rod, the support motor is used to drive the support rod to extend and retract along its own axial direction, and the support rod is used to press against the well wall of the detection well to provide support force for the robot arm; and A clamping assembly is arranged on the base, and the clamping assembly includes a clamping motor and a clamping rod. The clamping motor is transmission-connected to the clamping rod, and the clamping motor is used to drive the clamping rod to extend and retract along its own axial direction. The clamping rod is used to push against the monitoring instrument to lift the base from the surface of the monitoring instrument and realize the posture adjustment of the robot arm. The clamping rod is also used to clamp and adjust the posture of the monitoring instrument.

2. The robot arm according to claim 1, characterized in that: The supporting assembly and the pressing assembly each include a plurality of them, wherein the plurality of the supporting assemblies are arranged at intervals on the base, and the plurality of the pressing assemblies are arranged at intervals on the base.

3. The robot arm according to claim 1, characterized in that: The robotic arm also includes a first sensor and / or a second sensor. The first sensor is arranged on the support rod, and the first sensor is used to detect the resistance force of the support rod on the wall of the detection well. The second sensor is arranged on the clamping rod, and the second sensor is used to detect the resistance force of the clamping rod on the monitoring instrument.

4. The robot arm according to claim 1, characterized in that: The robot arm further includes a control panel, which is disposed on the base and is electrically connected to the supporting motor and the pressing motor.

5. The robot arm according to claim 1, characterized in that: The robot arm further includes a third sensor, which is disposed on the control panel and is used to detect posture information of the robot arm.

6. The robot arm according to claim 1, characterized in that: The base is a box structure, the cross-section of the base is annular, the base has a central through hole, the central through hole is used for the passage of the power supply and communication cables of the monitoring instrument, the base includes a base and a box cover arranged opposite to each other, the base and the box cover are coaxially arranged, the base and the box cover are both provided with the central through hole, and the supporting motor and the clamping motor are both arranged on the base.

7. The robot arm according to claim 6, characterized in that: The supporting motor is fixed on the base through a coupling cone, the clamping rod can pass through the central through hole of the base and the box cover, and the clamping rod is arranged adjacent to the hole wall of the central through hole of the base and the box cover.

8. A method for operating a robot arm according to any one of claims 1 to 7, characterized in that: The following steps are involved: S1. The robot arm and the monitoring instrument are placed close together, and the robot arm follows the monitoring instrument to fall in the detection well set on the planet; S2. After the robot arm follows the monitoring instrument and stops falling in the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axial direction, so that the clamping rod abuts against the monitoring instrument to lift the base from the surface of the monitoring instrument, and adjusts the posture of the robot arm to be horizontal; S3. After the posture of the robot arm is adjusted to be horizontal, the support motor is controlled to drive the support rod to extend and retract along its own axial direction, so that the support rod is pressed against the wall of the detection well to provide support force for the robot arm; S4. After the support rod is pressed against the wall of the detection well, the clamping motor is controlled to drive the clamping rod to extend and retract along its own axial direction, so that the clamping rod presses against the monitoring instrument to adjust the posture of the monitoring instrument to be horizontal, and the monitoring instrument is pressed and arranged at the bottom of the detection well.

9. The method for operating a robot arm according to claim 8, characterized in that: The robot arm includes three clamping assemblies, which are arranged at intervals on the base; the robot arm also includes a control board, which is arranged on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a third sensor, which is arranged on the control board. There are two third sensors, and the two third sensors are used to detect the pitch angle and roll angle of the robot arm respectively; The step S2 of adjusting the posture of the robot hand to be horizontal includes: S211. Determine the step angle of the clamping motor, and set the step length of the clamping rod corresponding to the step angle of the selected clamping motor to l step ; S212. Set the length of each clamping rod to be extended synchronously to L, and the number of steps output by the clamping motor is: n C =L / l step S213. According to the specifications of the clamping motor and the control board, configure the frequency and duty cycle to generate a pulse waveform of the clamping motor; S214. Set the pitch angle of the robot hand output by the third sensor A1 to α1, and the roll angle of the robot hand output by the third sensor A2 to α2; If |α1|>2°, the number of steps output by the clamping motor C1 is: n C1 =R*sinα1 / l step The number of steps output by the clamping motor C2 and the clamping motor C3 are: n C2 =-R*cos60°*sinα1 / l step , n C3 =n C2 Wherein, R is the distance between the clamping rod and the center of the robot hand; If |α2|>2°, the number of steps output by the clamping motor C1 is 0; The number of steps output by the clamping motor C2 and the clamping motor C3 are: n C2 =R*cos30°*sinα2 / l step , n C3 =-n C2 If |α1|≤2° and |α2|≤2°, the robot arm is judged to be in a horizontal position.

10. The method for operating a robot arm according to claim 8, characterized in that: The robot arm includes two support assemblies, which are arranged on the base at intervals; the robot arm also includes a control panel, which is arranged on the base and electrically connected to the support motor and the clamping motor; the robot arm also includes a first sensor, which is arranged on the support rod, and is used to detect the push force of the support rod on the well wall of the detection well, and the number of the first sensors is two, and the two first sensors correspond to the two support rods one by one respectively; The step S3 of controlling the support motor to drive the support rod to extend and retract along its own axial direction so that the support rod is pressed against the wall of the detection well to provide support force for the robot arm comprises: S31. Determine the step angle of the support motor and set the step angle of the selected support motor to l step ; S32. According to the specifications of the support motor and the control board, configure the frequency and duty cycle to generate a pulse waveform for supporting the motor; S33. The two support motors S1 and S2 drive the two support rods SR1 and SR2 to extend outward respectively, and monitor the top force value V of the support rod SR1 output by the first sensor SS1 at the same time. SS1 , the push force value V of the support rod SR2 output by the first sensor SS2 SS2 ; S34. According to engineering experience and the selection of pressure sensors, when the support rod is pressed against the well wall, the maximum value of the output of the first sensor SS1 and SS2 is V MAX , set |V SS1 -V SS2 The threshold value of | is V SS ; If V SS1 -V SS2 ≥V SS , then stop driving the support rod SR1 to extend outward, and continue to drive the support rod SR2 to extend outward until -V SS <V SS1 -V SS2 <V Ss ; If V SS1 -V SS2 ≤-V SS , then stop driving the support rod SR2 to extend outward, and continue to drive the support rod SR1 to extend outward until -V SS <V SS1 -V SS2 <V SS ; When V SS1 ≥V MAX And V SS2 ≥V MAX , stop driving the support rods SR1 and SR2 to extend outward. At this time, it is determined that the support rods SR1 and SR2 are both pressed against the well wall.

11. The method for operating a robot arm according to claim 8, characterized in that: The step S4 of controlling the clamping motor to drive the clamping rod to extend and retract along its own axial direction so that the clamping rod abuts against the monitoring instrument to adjust the posture of the monitoring instrument to be horizontal, and compressing and arranging the monitoring instrument at the bottom of the detection well includes: S41. Use the sliding mode control algorithm to control the compaction motors C1, C2, and C3 to drive the corresponding compaction rods CR1, CR2, and CR3 respectively, and push the monitoring instrument downward to bypass the obstruction of the well wall protrusion and continue to fall to the bottom of the well, or compact the monitoring instrument with the soil at the bottom of the well, and adjust the depth of the compaction rod according to the pitch angle, roll angle, and azimuth angle output by the three fourth sensors Y1, Y2, and Y3 of the monitoring instrument, so as to adjust the posture of the monitoring instrument to be horizontal; The synovial control algorithm is described by the following first-order dynamic equation: where the design parameter β > 0 and the system state x ∈ R 1 , both q and p are odd numbers, and q < p < 2q. Solving from the above equation gives: Assume that the time from the initial state x(0)≠0 to x=0 is t s ,t s It can be determined by the following formula: The origin is a terminal attractor, and the system state x will be in a finite time t s The inner converges to zero; The Jacobian determinant of the dynamic equation near the equilibrium point x = 0 is: Consider J as the eigenvalue λ of the first-order approximate matrix, then we have: J→-∞when x→0 + At the equilibrium point, the eigenvalue λ tends to negative infinity, where |J|<∞ is not satisfied, that is, the Lipschitz condition that guarantees the uniqueness and existence of the solution of the differential equation at the origin is not satisfied, and J is singular at x=0. When the Lipschitz condition is not satisfied, the system state reaches the equilibrium point in a finite time. S42. After the clamping process is completed, the clamping motors C1, C2, and C3 are controlled to drive the corresponding clamping rods CR1, CR2, and CR3 to retract respectively, so as to separate from the monitoring instrument.

Citation Information

Patent Citations

  • Flexible deep well rescuer

    CN109794012A

  • Intelligent platform for hoisting, installing and dismantling mining equipment and control system and method

    CN110759244A

  • Coal mine underground explosion-proof type gyro inclinometer and using method thereof

    CN111502635A

  • Telescopic exploring electrode device for well logging

    CN112782772A

  • Coupling system of coal mine tunneling equipment, geologic model and roadway design model

    CN114120785A