Drill rod conveying system suitable for full-section drilling and control method of drill rod conveying system

Abstract

The invention belongs to the field of mining drilling machines, and relates to a drill rod conveying system suitable for full-section drilling and a control method thereof.The system comprises a main mechanical arm, an auxiliary mechanical arm, a transfer mechanism, a drill rod conveying sensor set and a rotation positioning sensor set; the main manipulator comprises a main rotating joint, a main telescopic joint and a main clamping jaw assembly; the auxiliary manipulator comprises a lifting joint, an auxiliary rotating joint, an auxiliary telescopic joint and an auxiliary clamping jaw which are connected in sequence; the transfer mechanism comprises a drill rod transfer device, a rack and a rotary platform, and the drill rod transfer device is arranged between the rack and the rotary platform through an asynchronous rotating device; the drill rod conveying sensor group comprises a detection sensor, a judgment sensor and a rotation sensor; and the rotary positioning sensor group comprises a transporter tilt angle sensor, a rack location sensor and a synchronous sensor. Efficient automation from sensing to control in the drill rod conveying process is achieved, and powerful guarantee is provided for safety and efficiency in the complex operation environment.

Description

Technical Field

[0001] The invention belongs to the field of mining drilling rigs and relates to a drill rod conveying system suitable for full-section drilling and a control method thereof. Background Art

[0002] In the context of the intelligent coal mining strategy, drilling rig automation has become a key enabler for achieving reduced- and even unmanned underground operations. Traditional manual operation, limited by the complex underground environment and fatigue, fails to meet the dual requirements of efficient mining and inherent safety in modern coal mines. Automation technology automates the drilling process and auxiliary operations, significantly reducing labor intensity and improving safety. It also overcomes the efficiency bottleneck of manual operation, making it an inevitable choice for technological upgrades in the coal industry.

[0003] The drill rod conveying system is one of the core systems of the automatic drilling rig. At present, the drill rod conveying system is generally composed of a main manipulator, an auxiliary manipulator and a transporter. The auxiliary manipulator generally refers to the drill rod conveying manipulator, which is responsible for taking the drill rod out of the drill rod box and placing it into the transporter; the main manipulator is the key executive component of the drill rod conveying system, responsible for delivering the drill rod from the transporter and other devices to the drilling rig mainframe for drilling operations; the transporter is the transition component between the two manipulators, which realizes the alignment and transfer of the drill rod with the main manipulator or the frame. The drill rod conveying system of the existing technology is still difficult to adapt to the inclination angle (i.e. the entire circumference) adjustment requirements of the full-section working conditions. Its shortcomings are mainly reflected in the following aspects:

[0004] (1) The existing main manipulator is separated from the frame. During the drilling process, the frame is in a certain inclination state. The initial position of the drill rod is generally horizontal. The manipulator needs to frequently switch between the horizontal and inclination states. The inclination joint is easily interfered with by other components, resulting in a more complex structure and sensor positioning system.

[0005] (2) The existing auxiliary manipulator is a rectangular coordinate joint manipulator, that is, each joint is a translation joint, which can only realize the translation or lifting of the drill rod, which greatly limits the subsequent mechanisms of the drill rod conveying system and the layout of the entire drilling rig. Especially in the vertical direction, the rectangular coordinate joint manipulator can only move straight up and down, making it difficult for the drill rod to cross the lifting sleeve and other essential components of the drilling rig under the drive of the grasping manipulator.

[0006] (3) Existing transporters are available in two forms: translational (e.g., CN201911185745.9) and horizontal rotational (e.g., CN202210330124.0). Both types move in the horizontal plane and clamp the ends of a horizontally placed drill pipe to align it with the drill pipe box or rack. However, existing transporters lack a mechanism to secure the drill pipe in the vertical plane and are therefore unable to move at large angles.

[0007] (4) Existing drill pipe conveying systems generally monitor the key joints of components. One type uses sensors such as encoders to monitor the angles and displacements of special joints of the manipulator. This method has a complex structure, low sensor reliability, and high cost. Another type uses position sensors to monitor special positions of the manipulator (extreme position, horizontal position), etc., to determine the relative positions between components. The sensor reliability of this method has been improved, but there is a lack of process monitoring, making it difficult to improve the degree of automation and self-adjustment capabilities of the operating process. At the same time, this technology is only applicable to drilling rigs with a smaller drilling inclination range. It cannot effectively distinguish between positive and negative inclination working conditions, making it difficult to meet the drill pipe conveying needs under complex working conditions.

[0008] It can be seen that due to the structural limitations of the main manipulator, auxiliary manipulator and transporter, the existing automatic drilling rig has a limited drilling inclination range and is difficult to meet the requirements of full-section working conditions; at the same time, there is also a lack of reliable means to monitor the drill rod transportation process. Summary of the Invention

[0009] In view of this, the purpose of the present invention is to provide a drill rod conveying system and a control method thereof suitable for full-section drilling, so as to solve the problem that the drilling inclination range of existing automatic drilling rigs is limited and it is difficult to meet the requirements of full-section working conditions, and the problem that the existing technology lacks drill rod in-place status monitoring in the drill rod automatic conveying system.

[0010] In order to achieve the above object, the present invention provides the following technical solutions:

[0011] A drill rod conveying system suitable for full-section drilling, comprising a main manipulator, an auxiliary manipulator, a transfer mechanism, a drill rod conveying sensor group, and a rotation positioning sensor group;

[0012] The main manipulator includes a main rotation joint, a main telescopic joint, and a main gripper assembly;

[0013] The main rotating joint includes a rotating seat and a rotating driver, wherein the rotating driver is arranged at one end of the rotating seat and drives the main rotating shaft to rotate, and the main rotating shaft passes through the rotating seat and is connected to the main telescopic joint;

[0014] The main jaw assembly is connected to the bottom of the main telescopic joint, and drives the main jaw assembly to extend and retract in the vertical direction through the main telescopic joint, and the main jaw assembly is used for grasping;

[0015] The auxiliary manipulator is arranged on the auxiliary slide rail of the drill rod box and includes a lifting joint, an auxiliary rotation joint, an auxiliary telescopic joint and an auxiliary clamping claw connected in sequence, the lifting joint is connected to the auxiliary slide rail at one end away from the auxiliary clamping claw, and the auxiliary telescopic joint and the auxiliary clamping claw are arranged toward the inside of the drill rod box;

[0016] The auxiliary rotation joint is connected to the lifting joint via a crossbeam; the auxiliary rotation joint comprises an auxiliary rotation shaft rotatably arranged in the inner cavity of the crossbeam, the inner cavity of the crossbeam is provided with an arc groove, and a protrusion is provided on the outer side of the auxiliary rotation shaft. When the auxiliary rotation shaft rotates, the protrusion slides circumferentially in the arc groove to limit the rotation of the auxiliary rotation shaft;

[0017] The transfer mechanism includes a drill rod transfer device, a frame, and a rotary platform, wherein the drill rod transfer device is arranged between the frame and the rotary platform through an asynchronous rotation device;

[0018] The drill rod transporter includes a base plate, a supporting block, a pressure plate, and an axial pressing block; the supporting block is arranged on the base plate for supporting the drill rod; the axial pressing blocks are arranged on the base plate and are located on both sides of the supporting block; the upper portion of the axial pressing block is rotatably connected to a pressure plate, and the pressure plate is located above the supporting block; the axial pressing block presses and fixes the drill rod axially; the axial pressing block includes at least one slider slidably arranged on the base plate; the pressure plate presses the drill rod onto the supporting block;

[0019] The drill rod conveying sensor group includes a detection sensor, a judgment sensor, and a rotation sensor. The detection sensor is configured to detect whether there is a drill rod in the auxiliary manipulator; the judgment sensor is configured to detect whether there is a drill rod in the drill rod transporter; and the rotation sensor is configured to detect the rotation position and direction of the main manipulator.

[0020] The rotation positioning sensor group includes a transporter inclination sensor, a rack position sensor and a synchronization sensor. The transporter inclination sensor is configured to detect the rotation angle of the drill rod transporter; the rack position sensor is configured to determine whether the rack is in a positive inclination condition or a negative inclination condition; the synchronization sensor is configured to determine whether the rack and the drill rod transporter are at the same inclination angle.

[0021] Furthermore, the asynchronous rotation device includes a lifting sleeve, a transporter rotator, an inclination rotator, a rotation transition plate and a frame connecting plate, and the frame and the rotating platform are connected in sequence through the inclination rotator, the frame connecting plate, the rotation transition plate and the lifting sleeve; wherein, the inclination rotator is rotationally connected to the frame, and the transporter is rotationally connected to the rotation transition plate through the transporter rotator, and the asynchronous rotation adjustment of the inclination between the frame and the transporter is realized through the inclination rotator and the transporter rotator.

[0022] Furthermore, the lifting sleeve includes a cavity enclosed by two side plates and a top sealing plate, sleeves are provided at both ends of the side plates, and connecting tubes are provided on the side plates; two lifting columns are relatively arranged on the rotating platform, and a lifting cylinder is provided between the two lifting columns; the lifting cylinder of the rotating platform is installed in the cavity, and under the drive of the lifting cylinder, the lifting sleeve moves up and down along the lifting column; the sleeve is mounted on the lifting column of the rotating platform, and the rotating transition plate is installed on the connecting tube.

[0023] Furthermore, a flange is provided on the connecting tube; the rotary transition plate is disc-shaped, comprising three sets of flanges arranged side by side, the inner flange is matched with the flange of the connecting tube, and the two sets of outer flanges are respectively used to install the transporter rotator and the frame connecting plate.

[0024] Furthermore, the transporter rotator includes a first fixed ring and a first rotating ring arranged thereon, the first fixed ring is connected to the flange of the rotating transition plate; the first rotating ring is fixedly connected to the first outer shell, the transporter is installed on the first outer shell, and the inclination angle of the transporter is adjusted by rotating the first rotating ring.

[0025] Furthermore, the frame connecting plate is disc-shaped and includes two sets of flanges connected to each other, and the two sets of flanges are respectively connected to the flange of the rotary transition plate and the inclination rotator.

[0026] Furthermore, the inclination rotator includes a second fixed ring and a second rotating ring arranged thereon, the second fixed ring is connected to the flange of the frame connecting plate; the second rotating ring is fixedly connected to the second outer shell, the frame is mounted on the second outer shell, and the inclination angle of the frame is adjusted by rotating the second rotating ring.

[0027] Furthermore, a sliding cylinder is provided at the bottom of the base plate, and the sliding cylinder is connected to the slider to drive the slider to slide along the length direction of the base plate.

[0028] Furthermore, the axial pressing block is rotatably connected to the pressure plate. When the transporter is in a state of waiting for the drill rod to be loaded or removed, the pressure plate is rotated and opened upward to facilitate the loading or removal of the drill rod.

[0029] Furthermore, a pressing oil cylinder is provided on the pressing plate to drive the rotation of the pressing plate; the pressing oil cylinder is located outside the two axial pressing blocks and is hingedly connected to the upper part of the axial pressing blocks.

[0030] Furthermore, there are at least two support blocks, and the upper portion of each support block is provided with a groove matching the outer diameter of the drill rod.

[0031] Furthermore, the main telescopic joint includes a vertically arranged main outer cylinder, a main inner cylinder and a main telescopic cylinder. The main outer cylinder is detachably connected to the main rotating shaft through a flange, the main inner cylinder is slidably connected to the inside of the main outer cylinder, and the main clamping jaw assembly is connected to the bottom of the main inner cylinder; the main telescopic cylinder is fixed on the top of the main outer cylinder, and the main inner cylinder is connected to the output end of the main telescopic cylinder.

[0032] Furthermore, the main clamping jaw assembly includes a main clamping jaw and a main clamping cylinder, the main clamping cylinder is fixed to the lower part of the main inner tube, the main clamping jaw is fixed on the main clamping cylinder, and is clamped or released under the drive of the main clamping cylinder.

[0033] Furthermore, it also includes a sliding joint, which includes a fixed seat, a connecting arm and a sliding cylinder. The fixed seat is connected to the frame and is provided with a horizontally arranged main slide rail. The bottom of the connecting arm is provided with a sliding groove, and the sliding groove cooperates with the main slide rail. The rotating seat in the main rotating joint is fixedly connected to the connecting arm.

[0034] One end of the sliding oil cylinder is fixed on the fixing seat, and the other end is connected to the connecting arm, so that the connecting arm slides along the track.

[0035] Furthermore, one end of the lifting joint away from the slide rail is connected to the bottom of the beam.

[0036] Furthermore, the lifting joint includes a lifting outer cylinder and a lifting oil cylinder connected to the lifting outer cylinder. The lifting outer cylinder is installed in a sleeve arrangement with the lifting inner cylinder below the beam. The lifting outer cylinder and the lifting inner cylinder form a lifting pair to realize lifting movement. The lifting oil cylinder drives the lifting pair to perform lifting movement.

[0037] Furthermore, the secondary rotation joint further includes a secondary rotation driver connected to the crossbeam, and the secondary rotation driver is connected to the secondary rotation shaft to drive the rotation of the secondary rotation shaft.

[0038] Furthermore, one end of the secondary rotating shaft away from the crossbeam is connected to the secondary telescopic joint, and the secondary rotating shaft rotates to drive the secondary telescopic joint and the secondary clamp to swing.

[0039] Furthermore, the auxiliary telescopic joint comprises an auxiliary outer tube and an auxiliary inner tube, wherein the auxiliary inner tube is inserted into the auxiliary outer tube to form a telescopic pair for performing telescopic movement;

[0040] and a secondary telescopic oil cylinder connected to the secondary rotating shaft, wherein the secondary telescopic oil cylinder is connected to the secondary outer cylinder to drive the telescopic pair to perform telescopic movement.

[0041] Furthermore, a side of the auxiliary clamping jaw close to the telescopic unit is connected to an auxiliary clamping oil cylinder, and the auxiliary clamping jaw is clamped or released under the drive of the auxiliary clamping oil cylinder.

[0042] Furthermore, the detection sensor includes:

[0043] a detection sensor mounting base radially fixed to one side of the gripper in the auxiliary manipulator;

[0044] a detection sensor spring disposed in the detection sensor mounting seat;

[0045] a trigger post movably mounted in the detection sensor mounting seat via the detection sensor spring;

[0046] A detection sensor body is configured to detect displacement of the trigger column due to the presence of the drill pipe.

[0047] Furthermore, when the clamping claw approaches the drill rod, the trigger column is pressed upward by the drill rod, and the detection sensor body generates a connection signal indicating the presence of the drill rod.

[0048] Furthermore, the judgment sensor includes:

[0049] a judgment sensor mounting seat fixed below the bottom plate in the drill pipe transporter;

[0050] A judgment sensor body fixed in the judgment sensor mounting seat;

[0051] a judgment sensor spring disposed in the judgment sensor mounting seat;

[0052] A signal-emitting post movably mounted in the judgment sensor mounting seat via the judgment sensor spring;

[0053] When the drill rod is placed in the drill rod transporter, the signal transmitting column is pressed downward by the drill rod, and the judgment sensor body generates a connection signal indicating the presence of the drill rod.

[0054] Furthermore, the top end of the signaling post passes through the bottom plate of the drill rod transporter, and when there is no drill rod in the drill rod transporter, the top end of the signaling post exceeds the lowest point of the drill rod transporter where the drill rod is placed.

[0055] Furthermore, the rotation sensor includes:

[0056] A rotation sensor mounting base fixed on the rotation base of the main manipulator;

[0057] A rotation sensor body fixed in the rotation sensor mounting base;

[0058] A trigger ring is fixed on a rotating member rotatably connected to the rotating base and rotates with the rotating member. The trigger ring is configured to interact with the rotation sensor body during the rotation of the main manipulator, and the trigger ring has two arc segments with different arc lengths, and a gap is provided between the two arc segments to generate a signal for detecting the rotation position and direction of the main manipulator.

[0059] Furthermore, the two arc segments and the gap are arranged so that during the rotation of the main manipulator, the rotation sensor body detects the arc segments and the gap in sequence, and indicates the rotation direction and position of the main manipulator according to the duration and on-off of the rotation sensor body signal.

[0060] Furthermore, the rack position sensor includes a position plate and a first sensor, wherein the position plate is connected to the rack and rotates with the rack;

[0061] The position plate is divided into a positive tilt zone and a negative tilt zone, and the positive tilt zone and the negative tilt zone both cover a circumferential angle of 180°. The difference between the radius of the positive tilt zone and the radius of the negative tilt zone is not less than 1 times the sensing distance of the first sensor, and then the on-off of the first sensor is used to determine whether the rack is in a positive tilt working condition or a negative tilt working condition;

[0062] The first sensor is arranged outside the zone plate and adjacent to the junction of the positive inclination zone and the negative inclination zone.

[0063] Furthermore, the first sensor is a Hall proximity switch, a photoelectric sensor or a laser sensor.

[0064] Further, the synchronization sensor includes a first trigger block and a second sensor;

[0065] The first trigger block is mounted on the transporter rotator and rotates with the drill pipe transporter, and the second sensor is mounted on a side of the frame facing the transporter rotator;

[0066] When the frame and the drill pipe transporter are at the same inclination angle, the first trigger block and the second sensor are aligned, and the second sensor outputs a signal;

[0067] When the frame and the drill rod transporter rotate relative to each other, the second sensor is disconnected and no signal is output.

[0068] Furthermore, it also includes a lifting sleeve, a transporter rotator, an inclination rotator, a location shaft, a drill pipe transporter and a frame;

[0069] The lifting sleeve serves as a connecting piece between the transporter rotator and the tilting rotator;

[0070] The transporter rotator and the inclination rotator are both mounted on the lifting sleeve, the drill pipe transporter is mounted on the transporter rotator, and the frame is mounted on the inclination rotator, so that the transporter rotator and the inclination rotator adjust the inclination angle of the drill pipe transporter and the inclination angle of the frame respectively;

[0071] Both ends of the location shaft are connected to the frame and the location plate, so that the location plate rotates along with the frame.

[0072] Furthermore, the location axis is a hollow circular tube with connecting flanges at both ends, one end of which is fixedly connected to the frame, and the other end of which is fixedly connected to the location plate.

[0073] Furthermore, a transporter level sensor is included for determining whether the drill pipe transporter is in a horizontal position;

[0074] When the drill rod transporter is in a horizontal position, the transporter level sensor outputs a signal, judging that the drill rod transporter is in a horizontal position;

[0075] When the drill rod transporter rotates and is not in a horizontal position, the transporter level sensor is disconnected and no signal is output, thereby determining that the drill rod transporter is not in a horizontal position.

[0076] Further, the transporter level sensor includes a second trigger block and a third sensor;

[0077] The second trigger block is installed on the drill rod transporter and rotates with the drill rod transporter, and the third sensor is installed on the side of the lifting sleeve facing the transporter rotator;

[0078] When the drill pipe transporter is in a horizontal position, the third sensor outputs a signal;

[0079] When the drill pipe transporter rotates and is not in a horizontal position, the third sensor is disconnected and no signal is output.

[0080] Furthermore, the transporter inclination sensor includes an inner gear ring, a rotating shaft, a sensor gear ring and a wire sensor;

[0081] The inner gear ring is fixedly connected to the rotating ring of the transporter rotator connected to the drill pipe transporter, so as to drive the inner gear ring to rotate through the transporter rotator;

[0082] A primary gear and a secondary gear are respectively provided at both ends of the rotating shaft, the primary gear is meshed with the inner gear ring, the secondary gear is meshed with the sensor gear ring, and the sensor gear ring is rotatably arranged on the outside of the lifting sleeve for mounting the transporter rotator;

[0083] The draw wire sensor is arranged on the outside of the lifting sleeve and is connected to the sensor gear ring through a draw wire, so as to calculate the rotation angle of the drill pipe transporter according to the draw wire length of the draw wire sensor.

[0084] Furthermore, the tilt adjustment range of the transporter rotator is 360°;

[0085] The transporter rotator is divided into positive tilt rotation and negative tilt rotation, and the angles corresponding to the positive tilt rotation and negative tilt rotation are 0 to 180 degrees and 0 to -180 degrees respectively.

[0086] Furthermore, the rotation angle of the connection point between the pull wire in the pull wire sensor and the sensor gear ring is smaller than the inclination adjustment range of the transporter rotor.

[0087] Furthermore, when the transporter revolver is in the initial position, the initial length of the wire between the wire sensor and the sensor gear ring connection point is L0, and the initial angle is θ. Then, the wire length corresponding to a unit angle satisfies the following conditions:

[0088] k=L0 / θ.

[0089] Furthermore, an initial angle θ of the wire between the connection point of the wire sensor and the sensor gear ring is less than 180°.

[0090] Furthermore, when the angle of the transporter revolver is rotated, the total length of the real-time pull line of the pull line sensor is L Z , then the real-time angle of the sensor ring gear is:

[0091] α=(L0-L Z ) / k;

[0092] When the transporter rotor rotates counterclockwise with a positive inclination angle, L0≥L Z ,α≥0;

[0093] When the transporter rotor rotates clockwise with a negative angle, L0≤L Z , α≤0.

[0094] Furthermore, the transmission ratio of the gear system consisting of the inner ring gear, the first gear, the second gear and the sensor ring gear is i, and the actual rotation angle of the transporter calculated by the sensor ring gear is:

[0095] β=iα。

[0096] Furthermore, a transmission ratio of the gear train consisting of the inner gear ring, the first-stage gear, the second-stage gear and the sensor gear ring is i≥1.

[0097] On the other hand, the present invention further provides a control method for a drill rod conveying system suitable for full-section drilling, which is applicable to the drill rod conveying system suitable for full-section drilling and comprises the following steps:

[0098] The process of transporting drill rods from the drill rod box to the rack:

[0099] Initial state: There are drill rods to be transported in the drill rod box, there are no drill rods in the auxiliary manipulator and the drill rod transporter, the detection sensor and judgment sensor signals are disconnected; the main manipulator is in the ready position, and the rotation sensor signal is disconnected;

[0100] Step 1: Grab the Drill Pipe

[0101] The auxiliary manipulator approaches the drill rod from the drill rod box, the auxiliary gripper clamps the drill rod, and the detection sensor signal is connected, indicating that the auxiliary manipulator has grasped the drill rod;

[0102] Step 2: Transfer to the Drill Pipe Transporter

[0103] The auxiliary manipulator puts the drill rod into the drill rod transporter, the auxiliary gripper is released, and the detection sensor signal is disconnected. At the same time, the judgment sensor signal is connected, indicating that the drill rod has entered the drill rod transporter;

[0104] Step 3: Main robot grasps

[0105] The main manipulator grabs the drill rod from the drill rod transporter. After the drill rod leaves, it determines that the sensor signal is disconnected;

[0106] Step 4: Transport to the rack

[0107] The main manipulator rotates toward the frame, and the rotation sensor generates a signal change indicating that the rotation is completed, indicating that the main manipulator has completed the rotation and sent the drill rod into the frame;

[0108] The process of recovering drill pipe from the rack to the drill pipe box:

[0109] Initial state: There is recovery space in the drill rod box, there are no drill rods in the auxiliary manipulator and the drill rod transporter, the detection sensor and judgment sensor signals are disconnected, the main manipulator is inside the rack, and the rotation sensor signal is disconnected;

[0110] Step 1: Main robot recovery

[0111] The main manipulator rotates from the frame toward the drill pipe transporter, and the rotation sensor generates a signal change indicating that the rotation is completed;

[0112] Step 2: Place on the drill pipe transporter

[0113] The main manipulator places the drill rod into the drill rod transporter and determines that the sensor signal is connected;

[0114] Step 3: Secondary manipulator grasps

[0115] The auxiliary manipulator grabs the drill rod from the drill rod transporter and detects that the sensor signal is connected. After the drill rod is removed, it determines that the sensor signal is disconnected;

[0116] Step 4: Put the drill box back

[0117] The auxiliary manipulator puts the drill rod back into the drill rod box and detects that the sensor signal is disconnected, completing the recovery.

[0118] Furthermore, the method further includes rotating the drill pipe transporter to a specified inclination angle:

[0119] S1, the transponder rotator rotates to set the inclination angle;

[0120] S2, through the first and second gears on the rotating shaft, the inclination angle of the transporter rotator is transmitted to the sensor ring gear, and drives the cable of the cable sensor to retract;

[0121] S3. Calculate the rotation angle and rotation direction of the sensor gear ring according to the actual extension length of the wire of the wire sensor;

[0122] S4. Calculate the degree of inclination of the transporter rotor according to the transmission ratio of the gear train consisting of the inner ring gear, the first gear, the second gear, and the sensor ring gear.

[0123] Furthermore, the method further includes determining and synchronizing the inclination states of the frame and the drill pipe transporter, including the following steps:

[0124] Horizontal to positive tilt adjustment:

[0125] a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are both in a horizontal position, the rack position sensor is off, and the synchronization sensor is on;

[0126] b. The frame rotates in the positive inclination direction to the set angle A, A>0°, and after the rotation begins, the synchronization sensor is disconnected and the transporter level sensor is disconnected;

[0127] c. The rack position sensor receives a signal to determine that the rack is in a positive tilt state;

[0128] d. After the rack is rotated into place, the drill pipe transporter rotates in the positive inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill pipe transporter and the rack are at the same inclination angle and are in the positive inclination state;

[0129] Horizontal to negative tilt adjustment:

[0130] a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are both in a horizontal position, the rack position sensor is off, and the synchronization sensor is on;

[0131] b. The frame rotates in the negative inclination direction to the set angle α, α < 0°. After the rotation begins, the synchronization sensor is disconnected and the transporter level sensor is disconnected;

[0132] c. The rack position sensor signal remains disconnected, indicating that the rack is in a negative tilt state;

[0133] d. After the rack is rotated into place, the drill rod transporter rotates in the negative inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill rod transporter and the rack are at the same inclination angle and are in a negative inclination state.

[0134] Furthermore, the method further includes determining and synchronizing the inclination states of the frame and the drill pipe transporter, including the following steps:

[0135] Horizontal to positive tilt adjustment:

[0136] a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are both in a horizontal position, and the rack position sensor is on;

[0137] b. The frame rotates in the positive inclination direction to the set angle A, A>0°, and the synchronous sensor is disconnected after the rotation starts;

[0138] c. The rack position sensor is disconnected, and it is determined that the rack is in a positive tilt state;

[0139] d. After the rack is rotated into place, the drill pipe transporter rotates in the positive inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill pipe transporter and the rack are at the same inclination angle and are in the positive inclination state;

[0140] Horizontal to negative tilt adjustment:

[0141] a. Initial state: The rack and drill pipe transporter are both in horizontal position, the rack position sensor is on, and the synchronization sensor is on;

[0142] b. The frame rotates in the negative inclination direction to the set angle B, B < 0°, and after the rotation begins, the synchronous sensor is disconnected and the transporter level sensor is disconnected;

[0143] c. The rack position sensor signal remains connected, judging that the rack is in a negative tilt state;

[0144] d. After the rack is rotated into place, the drill rod transporter rotates in the negative inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill rod transporter and the rack are at the same inclination angle and are in a negative inclination state.

[0145] Furthermore, it also includes an adjustment process from a positive tilt angle or a negative tilt angle back to a horizontal position, which is the opposite of the adjustment process from horizontal to a positive tilt angle or a negative tilt angle.

[0146] Furthermore, the rotation sensor includes:

[0147] A rotation sensor mounting base fixed on the rotation base of the main manipulator;

[0148] A rotation sensor body fixed in the rotation sensor mounting base;

[0149] a trigger ring fixed to a rotating member of the main manipulator and rotating with the rotating member, the trigger ring being configured to interact with the rotation sensor body during rotation of the main manipulator, and the trigger ring having two arc segments of different arc lengths with a gap between the two arc segments to generate a signal for detecting the rotational position and direction of the main manipulator;

[0150] When the drill rod transporter is in an inclined state, after the main manipulator clamps the drill rod or places the drill rod in the drill rod transporter, the main manipulator rotates toward the frame through an arc segment of the trigger ring, and the rotation sensor body detects the gap between the two arc segments in the trigger ring. The signal of the rotation sensor body is disconnected, thereby causing the main manipulator to stay between the drill rod transporter and the frame, leaving space for the drill rod transporter to return to a horizontal position.

[0151] The beneficial effects of the present invention are:

[0152] (1) The present invention integrates most of the functions of the main manipulator by connecting the main rotating joint and the main telescopic joint and integrating them with the frame to keep the inclination angles of the two always consistent, simplifying the manipulator's movements and reducing the possibility of interference with other components. The main rotating joint can satisfy the rotation of the main manipulator at a certain angle, which means that any drill rod within this angle range can be grasped by the main manipulator; in addition, combined with the telescopic effect of the main telescopic joint, the grasping range of the main manipulator continues to expand within the original rotation angle range, thereby achieving a wider range of applicability.

[0153] (2) By setting a secondary rotating joint with a limited angle, the auxiliary manipulator can swing in the vertical plane. This enables the auxiliary manipulator to transport drill rods across components such as the attitude adjustment device, thereby allowing the transporter to be set on the attitude adjustment device at a position on the opposite side of the drill rod box. This improvement significantly improves the flexibility of the arrangement of the drill rod conveying system suitable for full-section drilling, allowing the drilling rig to adapt to more complex downhole environments and drilling requirements. Since the auxiliary manipulator can swing in the vertical plane, the drilling rig is no longer limited to the traditional manipulator's movement mode of only being able to move straight up and down when drilling in the full section and full inclination range. This greatly increases the drilling inclination range of the drilling rig and improves the adaptability and operating efficiency of the drilling rig.

[0154] (3) A rotator is used to drive the drill rod transporter and the frame to rotate separately, thereby realizing a wide range of inclination adjustment of the drill rod transporter in the vertical plane.

[0155] Expand the inclination range of drilling. Due to design defects, the existing drill rod transporter can only move in the horizontal plane, which limits the inclination range of drilling for the automatic drilling rig and makes it difficult to expand to large-angle drilling conditions. The inclination-adjustable drill rod transport mechanism of the present invention realizes asynchronous rotation adjustment of the inclination between the frame and the transporter through an asynchronous rotation device. The inclination rotator can adjust the inclination of the frame, and the transporter rotator can adjust the inclination of the transporter. The two cooperate with each other to enable the drill rod transporter to adjust the inclination over a wide range in the vertical plane. This enables the automatic drilling rig to adapt to the needs of drilling with larger inclination angles, breaking through previous technical limitations, meeting the drilling operations under more complex geological conditions, and broadening the application scenarios of the automatic drilling rig.

[0156] Avoid interference between components and achieve negative high-angle drilling. The position layout of the transporter, manipulator and frame in the prior art is unreasonable. When adjusting the inclination angle of the drill pipe conveying manipulator, especially under negative inclination conditions, it will interfere with the transporter, resulting in the inability of existing automatic drilling rigs to construct negative high-angle drilling. The reasonable design of the asynchronous rotation device in the present invention effectively avoids this problem. By sequentially connecting the inclination rotator, the frame connecting plate, the rotary transition plate, the lifting sleeve and other components, the transporter and the frame can independently adjust the inclination. Under negative inclination conditions, the transporter can be adjusted to a suitable inclination as needed without interfering with other components on the rotary platform, thereby realizing the construction of negative high-angle drilling and further improving the operating capacity of the automatic drilling rig.

[0157] Improve automation and intelligence. This invention makes the drilling process more automated. Combined with automated drilling technology, it can achieve fully automatic operation of loading and unloading drill rods, drilling, and posture adjustment, further reducing labor intensity, improving operation safety and efficiency, and providing strong support for the intelligent construction of coal mines.

[0158] (4) The drill rod in transit is fixed by clamping the two ends of the drill rod in combination with pressing the top, thereby preventing the drill rod from falling during the inclination adjustment. Facilitating the loading and unloading of the drill rod: When the transporter is in the state of waiting to load or remove the drill rod (other clamping mechanisms have already clamped the drill rod), the clamping cylinder drives the pressure plate to rotate upward and open, and the sliding cylinder drives the slider to move outward, thereby expanding the internal space of the transporter and reducing obstacles during the loading and unloading process. Enhancing the stability of the drill rod fixation: By clamping the two ends of the drill rod by the slider and pressing the top by the pressure plate, the drill rod is fixed from multiple directions, which greatly enhances the stability of the drill rod during transportation and effectively avoids problems caused by shaking, deviation or even falling of the drill rod during transportation. Adapting to large-angle working conditions: The above-mentioned fixing method can ensure that the drill rod remains stable under large-angle working conditions, preventing the drill rod from falling during inclination adjustment, and expanding the application range and adaptability of the automatic drilling rig.

[0159] (5) The detection sensor on the auxiliary manipulator can directly sense whether there is a drill rod in the clamp through the trigger column design in the clamp and generate an accurate signal. This function provides key support for the automation of drill rod transportation, ensuring that the auxiliary manipulator moves accurately when grabbing and releasing the drill rod. In complex operating environments, the detection sensor effectively reduces human errors and improves operational safety through real-time feedback. Its simple structure and reliable performance not only reduce maintenance costs, but also enhance the overall stability and durability of the equipment. By cooperating with subsequent systems, the detection sensor lays the foundation for the continuity of drill rod circulation and is an indispensable part of the technical solution.

[0160] (6) The judgment sensor is located below the bottom plate of the drill rod transporter. Through the signaling column and spring reset design, it accurately detects whether there is a drill rod in the transporter and generates a connection signal. This function provides important information for the automatic control of drill rod transportation, ensuring that the status of the drill rod is monitored in real time. Working in conjunction with the detection sensor of the auxiliary manipulator, the judgment sensor helps the system accurately track the flow path of the drill rod, thereby improving transportation efficiency and safety. The spring reset design avoids false triggering when there is no drill rod, ensuring the high reliability of the sensor. The application of this sensor significantly optimizes the automation process of drill rod transportation and provides stable support for subsequent drilling operations.

[0161] (7) The rotation sensor of the main manipulator is installed on the rotating seat. Through the trigger ring design, the rotation direction and position are determined according to the duration and on-off status of the signal. This function enables the main manipulator to accurately control the rotation movement and provide predictive information for drilling control. Combined with the judgment sensor of the drill rod transporter, the rotation sensor can also sense the flow direction of the drill rod in the main manipulator, further optimizing the control strategy of the drilling process. Its precise feedback reduces the possibility of mechanical interference and improves the operating efficiency and safety of the equipment. This design not only reflects the systematic nature of the technical solution, but also significantly improves the overall coordination and intelligence level of drill rod transportation and drilling operations.

[0162] (8) Compared with the prior art, the technical means of using complex precision sensors such as encoders to monitor the inclination of the manipulator throughout the entire process, or to perform specific monitoring of the manipulator's special positions (extreme positions, horizontal positions), etc., the present invention sets a gear transmission structure to transmit the rotation process and rotation inclination of the rotator inside the drilling rig to the sensor gear ring outside the drilling rig, and the actual rotation direction and rotation angle of the sensor gear ring will directly affect the length change of the wire of the wire sensor, that is, the envelope angle of the wire to the sensor gear ring. Finally, the rotation process and rotation inclination of the rotator inside the drilling rig are reversed according to the transmission ratio of the gear structure, and the displacement sensor is used to monitor the change process of the transporter inclination angle and perform length / angle conversion, thereby improving the comprehensiveness of monitoring the automatic conveying process of the drill rod.

[0163] In addition, the present invention can also set the transmission ratio of the gear transmission structure so that the output angle range of the sensor ring gear is smaller than the inclination angle change range of the rotator, thereby improving the flexibility of the installation position of the wire sensor and the design of related structural parts in the present invention.

[0164] (9) The present invention realizes the accurate judgment and adjustment of the inclination angle of the frame and the drill rod transporter through the coordinated work of the frame position sensor and the synchronous sensor. The frame position sensor divides the 360° circumference into two 180° areas of positive inclination and negative inclination, and judges the current inclination range of the frame (positive inclination or negative inclination) by the signal on and off. The synchronous sensor detects whether the frame and the drill rod transporter are at the same inclination angle to ensure that the two remain consistent when the inclination angle changes. This design combines the functions of the two sensors and can collaboratively judge the rotation direction of the frame and the drill rod transporter in subsequent processes. It is suitable for inclination adjustment of the entire circumference and overcomes the limitations of the traditional method in the inclination range.

[0165] (10) In the drill rod conveying system, this technical solution significantly improves the accuracy and efficiency of the operation. The rack position sensor is used in conjunction with the synchronization sensor to achieve precise synchronization between the rack and the drill rod transporter under a wide range of working conditions such as positive and negative inclination angles, ensuring stability during the drill rod conveying process. For example, in a complex large inclination environment, the system can accurately distinguish the inclination direction, avoid misjudgment or misalignment, and thus improve conveying efficiency and safety. This precise inclination control provides technical support for the automation of drill rod conveying, and is particularly suitable for high-demand scenarios such as coal mines.

[0166] Through the synergistic effect of the above sensors, the present invention realizes efficient automation from perception to control during the drill rod transportation process, providing a strong guarantee for safety and efficiency in complex working environments.

[0167] Other advantages, objects, and features of the present invention will be described in part in the following description and, in part, will be apparent to those skilled in the art upon examination of the following description or may be learned from practice of the present invention. The objects and other advantages of the present invention may be realized and obtained through the following description. BRIEF DESCRIPTION OF THE DRAWINGS

[0168] In order to make the purpose, technical solutions and advantages of the present invention more clear, the present invention will be described in detail below with reference to the accompanying drawings, in which:

[0169] Figure 1 Schematic diagram of a drill rod conveying system suitable for full-section drilling in an embodiment;

[0170] Figure 2 This is a front view of the main manipulator in the embodiment;

[0171] Figure 3 A side view of the main manipulator in the embodiment;

[0172] Figure 4 This is a schematic diagram of the assembly of the main manipulator in the embodiment;

[0173] Figure 5 This is a side view of the auxiliary manipulator axis in the embodiment;

[0174] Figure 6 This is a front view of the auxiliary manipulator in the embodiment;

[0175] Figure 7 for Figure 6 AA partial cross-sectional view of the middle auxiliary manipulator;

[0176] Figure 8 This is an overall schematic diagram of the transfer mechanism in the embodiment;

[0177] Figure 9 is a cross-sectional view of the asynchronous rotation device in the embodiment;

[0178] Figure 10 This is an axial side view of the lifting sleeve in the embodiment;

[0179] Figure 11 An isometric view of a drill pipe transporter in an embodiment;

[0180] Figure 12 is a front view of the drill pipe transporter in the embodiment;

[0181] Figure 13 This is a schematic diagram of the structure of the detection sensor in the embodiment;

[0182] Figure 14 This is a schematic diagram of the structure of the judgment sensor in the embodiment;

[0183] Figure 15 Schematic diagram of the structure of the rotation sensor in the embodiment;

[0184] Figure 16 This is a working principle diagram of the rotation sensor in the embodiment;

[0185] Figure 17 An axonometric view of the rotation positioning sensor group in the embodiment;

[0186] Figure 18 This is a front view of the rack position sensor in the embodiment;

[0187] Figure 19 Schematic diagram of the structure of the rack position sensor in the embodiment;

[0188] Figure 20 Schematic diagram of the structure of the synchronization sensor in the embodiment;

[0189] Figure 21 Schematic diagram of the structure of the transporter inclination sensor in the embodiment;

[0190] Figure 22 Schematic diagram of the working principle of the transporter tilt sensor in the embodiment;

[0191] Figure 23 It is an axonometric view of the automatic drilling rig in the embodiment.

[0192] Reference numerals: drill rod box 5 , auxiliary manipulator 6 , posture adjustment device 7 , drill rod transporter 8 , main manipulator 9 , power head 10 , frame 11 , clamp 12 .

[0193] Auxiliary manipulator 6: lifting cylinder 601, lifting outer cylinder 602, crossbeam 603, auxiliary rotation driver 604, auxiliary rotation shaft 605, auxiliary telescopic cylinder 606, auxiliary outer cylinder 607, auxiliary inner cylinder 608, auxiliary clamping claw 609, auxiliary clamping cylinder 610, detection sensor 611, detection sensor mounting base 61101, detection sensor spring 61102, trigger column 61103, detection sensor body 61104;

[0194] Attitude adjustment device 7: rotary platform 702, lifting column 704, lifting sleeve 705, lifting sleeve cavity 70501, sleeve 70502, connecting sleeve 70503, lifting cylinder 706, transporter rotator 709, tilt rotator 710, position axis 711, rotary transition plate 712, frame connecting plate 713, rotation positioning sensor group 714, frame position sensor 71401, position plate 71401a, first sensor 714 01b, synchronization sensor 71402, synchronization sensor 71402, first trigger block 71402a, second sensor 71402b, transporter inclination sensor 71403, inner ring gear 71403a, first gear 71403b, rotating shaft 71403c, sensor ring gear 71403d, pull wire sensor 71403e, second gear 71403f, pressure cover 71403g, transporter level sensor 71404;

[0195] Drill pipe transporter 8: base plate 801, support block 802, pressure plate 803, pressing cylinder 804, slide block 805, sliding cylinder 806, judgment sensor body 807, judgment sensor mounting base 808, signal post 809, judgment sensor spring 810;

[0196] Main manipulator 9: fixed base 901, main rotation driver 902, rotation base 903, rotation sensor 904, rotation sensor mounting base 90401, rotation sensor body 90402, trigger ring 90403, first arc segment 90403a, notch 90403b, second arc segment 90403c, main rotation shaft 905, main telescopic cylinder 906, main outer cylinder 907, main inner cylinder 908, main clamping cylinder 909, main clamping jaw 910, connecting arm 911, sliding cylinder 912. DETAILED DESCRIPTION

[0197] The following describes the embodiments of the present invention by means of specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments, and the details in this specification can also be modified or changed in various ways based on different viewpoints and applications without departing from the spirit of the present invention. It should be noted that the illustrations provided in the following embodiments are only schematic illustrations of the basic concept of the present invention, and the following embodiments and features in the embodiments can be combined with each other without conflict.

[0198] Among them, the accompanying drawings are only for illustrative purposes and represent only schematic diagrams rather than actual pictures, and should not be understood as limiting the present invention. In order to better illustrate the embodiments of the present invention, some parts of the accompanying drawings may be omitted, enlarged or reduced, and do not represent the dimensions of actual products. For those skilled in the art, it is understandable that some well-known structures and their descriptions may be omitted in the accompanying drawings.

[0199] The same or similar numbers in the drawings of the embodiments of the present invention correspond to the same or similar parts; in the description of the present invention, it should be understood that if there are terms such as "upper", "lower", "left", "right", "front", "back", etc. indicating directions or positional relationships, they are based on the directions or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific direction, be constructed and operate in a specific direction. Therefore, the terms describing the positional relationship in the drawings are only used for illustrative purposes and cannot be understood as limiting the present invention. For ordinary technicians in this field, the specific meanings of the above terms can be understood according to specific circumstances.

[0200] Example 1:

[0201] See also Figure 1 , which is an overall schematic diagram of a drill rod conveying system suitable for full-section drilling, including a main manipulator 9, an auxiliary manipulator 6 and a transfer mechanism.

[0202] Among them, according to Figures 2 to 4Figure 1 is a schematic diagram of the structure of the main manipulator. The main manipulator 9 includes a main rotation joint, a main telescopic joint, and a main gripper assembly. The main rotation joint includes a rotating base 903 and a main rotation driver 902. The main rotation driver 902 is located at one end of the rotating base 903 and drives the main rotation shaft 905 to rotate. The main rotation shaft 905 passes through the rotating base 903 and is connected to the main telescopic joint.

[0203] The main clamping jaw assembly is connected to the bottom of the main telescopic joint, and drives the main clamping jaw assembly to extend and retract in the vertical direction through the main telescopic joint. The main clamping jaw assembly is used for grasping.

[0204] See also Figures 5 to 7 Figure 2 shows the structure of the auxiliary manipulator 6, which is mounted on the secondary slide rail of the drill rod box. The auxiliary manipulator 6 includes a sequentially connected lifting joint, a secondary rotation joint, a secondary telescopic joint, and a secondary gripper 609. The lifting joint's end, distal from the secondary gripper 609, is connected to the secondary slide rail. The secondary telescopic joint and secondary gripper 609 are positioned toward the inside of the drill rod box. In certain embodiments, the auxiliary manipulator 6 of the present invention is used to grasp and transport drill rods.

[0205] The lifting joint and the rotating joint are connected by a cross beam 603. In some embodiments of the present invention, the drill rod box slide rail is horizontally arranged, the lifting joint is vertically installed on the drill rod box slide rail, the end of the lifting joint away from the slide rail is connected to the bottom of the cross beam 603, and the rotating joint is connected to the side of the cross beam 603.

[0206] See also Figures 8 to 12 , which is a schematic structural diagram of the transfer mechanism, including a drill rod transfer device, a frame 11, and a rotary platform 702, wherein the drill rod transfer device is arranged between the frame 11 and the rotary platform 702 through an asynchronous rotation device.

[0207] The drill pipe transporter consists of a base plate 801, a support block 802, a pressure plate 803, a clamping cylinder 804, an axial clamping block, and a sliding cylinder 806. Base plate 801 is the primary load-bearing and connecting member of the drill pipe transporter, providing a mounting base for all its components. The support block 802, axial clamping block, and sliding cylinder 806 are all directly or indirectly mounted on base plate 801, ensuring the integrity and stability of the drill pipe transporter structure and enabling the various components to work together to transport and secure the drill pipes.

[0208] At least two support blocks 802 are provided on the base plate 801, and the upper part of the support block 802 is provided with a groove matching the outer diameter of the drill pipe for supporting the drill pipe. In some embodiments of the present invention, there are preferably two support blocks 802. When the drill pipe is placed in the drill pipe transporter, the drill pipe can be placed stably in the groove of the support block 802. The support block 802 bears the main weight of the drill pipe, provides reliable support for the drill pipe, and ensures that the drill pipe will not sink or shake due to its own weight during transportation. The axial clamping block is provided on the base plate 801 and is located on both sides of the support block 802. The axial clamping block presses and fixes the drill pipe axially; the axial clamping block includes at least one slider 805 slidably arranged on the base plate 801. In some embodiments of the present invention, the axial compression blocks on both sides of the support block 802 are composed of a fixed block and a slider 805. The slider 805 on one side slides on the bottom plate 801 to expand the internal space when placing or removing the drill rod, or to compress the drill rod against the fixed block on the other side. In other embodiments of the present invention, both axial compression blocks are sliders 805. The upper portion of the axial compression block is hingedly connected to a pressure plate 803 and a pressure cylinder 804, wherein the pressure plate 803 is located above the support block 802 and is rotatably connected to the upper portion of the axial compression block. The clamping cylinder 804 is located on the outside of the two axial clamping blocks. The clamping cylinder 804 drives the pressure plate 803 and is the power source for driving the pressure plate 803 to rotate. Through the telescopic movement of the clamping cylinder 804, power can be transmitted to the pressure plate 803, causing the pressure plate 803 to rotate according to a predetermined trajectory, achieving the action of tightening or loosening the drill rod until the drill rod is pressed against the support block 802. The pressure plate 803 applies pressure to the drill rod from the top, further limiting the movement of the drill rod in the vertical and horizontal directions, enhancing the stability of the drill rod fixation, and preventing the drill rod from falling during transportation. The precise control of the clamping cylinder 804 can ensure that the pressure plate 803 applies appropriate pressure to the drill rod, neither effectively fixing the drill rod due to too little pressure nor damaging the drill rod due to excessive pressure.

[0209] A sliding cylinder 806 is installed at the bottom of base plate 801. Connected to slider 805, it acts as the power unit that drives slider 805 along the length of base plate 801. This drives slider 805 toward the center of base plate 801, clamping the drill rod and limiting its axial movement. Working together with support block 802 and pressure plate 803, this provides multi-directional securement of the drill rod. The stable operation of sliding cylinder 806 precisely controls the position and speed of slider 805, ensuring smooth loading, unloading, and securing of the drill rod, and guaranteeing its stability during transport.

[0210] When the drill rod transporter is waiting to load or remove a drill rod (other clamping mechanisms have already firmly clamped the drill rod), the clamping cylinder 804 drives the pressure plate 803, which rotates and opens upward, and the sliding cylinder 806 drives the slider 805 to move outward, expanding the internal space to facilitate the loading or removal of the drill rod; after the drill rod is loaded or removed, the clamping cylinder 804 drives the pressure plate 803 to rotate back to the clamping position. When the drill rod is placed in the drill rod transporter and the drill rod transporter needs to be rotated or moved, the clamping cylinder 804 drives the pressure plate 803 to press the drill rod, and the sliding cylinder 806 drives the slider 805 to move toward the center to keep the drill rod inside stable and not easy to fall.

[0211] Specifically: The basic working process of the drill rod conveying system provided by the present invention is as follows:

[0212] (1) Rod feeding condition

[0213] 1) Initial state: Assume that the inclination angle of the frame 11 and the main manipulator 9 is α; the drill rod transporter is in a horizontal position, the slider 805 is extended to both ends, and the pressure plate 803 is open; the telescopic joint of the main manipulator 9 is retracted, the rotating joint is in the state of completing the first rotation, the sliding joint is retracted, and the clamping jaws are open; the auxiliary manipulator 6 is located at any position on the slide rail of the drill rod box 5, the lifting joint and the telescopic joint prevent the clamping jaws from interfering with the drill rod box 5 and the drill rods therein, and the rotating joint makes the clamping jaws vertically downward, and the clamping jaws are open; the drilling rig is drilling.

[0214] 2) Auxiliary manipulator 6 selects a row of drill rods: The auxiliary manipulator 6 selects a row of drill rods under the control of the control system.

[0215] 3) Height adjustment of the auxiliary manipulator 6: The auxiliary manipulator 6 is adjusted by the lifting joint and the telescopic joint to reach a height suitable for grabbing the top drill rod of the selected column.

[0216] 4) The auxiliary manipulator 6 grabs the drill rod: the auxiliary gripper of the auxiliary manipulator 6 clamps the drill rod.

[0217] 5) Height adjustment of the auxiliary manipulator 6: The auxiliary manipulator 6 is reversely adjusted to a height at which the drill rod does not interfere with the drill rod box 5 and is suitable for placing the drill rod into the drill rod transporter.

[0218] 6) Auxiliary manipulator 6 moves horizontally: The auxiliary manipulator 6 holds the drill rod and moves horizontally toward the drill rod transporter.

[0219] 7) The auxiliary manipulator 6 swings upward: the auxiliary gripper of the auxiliary manipulator 6 swings upward and lifts up.

[0220] 8) The auxiliary manipulator 6 extends: the telescopic joint of the auxiliary manipulator 6 drives the gripper to extend toward the drill pipe transporter.

[0221] 9) The drill rod transporter clamps the drill rod: When the drill rod is placed in the drill rod transporter, the slide block 805 of the drill rod transporter contracts inwards, and at the same time, the pressure plate 803 presses the drill rod.

[0222] 10) The auxiliary manipulator 6 releases the drill rod, and the telescopic joint retracts to return to the initial state, ready to grab the next drill rod.

[0223] 11) Rotation of the drill rod transporter: The drill rod transporter rotates from a horizontal position in the direction of the inclination angle α until the inclination angle is the same as that of the frame 11.

[0224] 12) The main manipulator 9 rotates in the reverse direction: the main manipulator 9 rotates toward the drill pipe transporter.

[0225] 13) The main manipulator 9 extends: The main manipulator 9 extends toward the drill pipe transporter through its telescopic joint.

[0226] 14) Main manipulator 9 clamping: The main manipulator 9 clamps the drill rod.

[0227] 15) The drill pipe transporter is released: the transport trough slider 805 expands to both sides and the pressure plate 803 is released.

[0228] 16) The first stage of rotation of the main manipulator 9: the main manipulator 9 rotates clockwise ( Figure 23 ) to make room for the drill pipe transporter to rotate.

[0229] 17) The main manipulator 9 retracts: the telescopic joint of the main manipulator 9 retracts.

[0230] 18) Main manipulator 9 slides: The main manipulator 9 slides toward the gripper 12 so that the drill rod is in a position suitable for being sent into the frame 11.

[0231] 19) Main manipulator 9 waits: waits for the current drill rod to complete drilling.

[0232] 20) Drill pipe transporter level: The drill pipe transporter returns to the horizontal position.

[0233] 21) Disconnecting the drill rod in the hole: After completing the drilling of the current drill rod, the power head 10 is disconnected from the drill rod in the hole and retreats to a position suitable for installing the drill rod.

[0234] 22) The main manipulator 9 extends: the telescopic joint of the main manipulator 9 extends.

[0235] 23) Second stage rotation of the main manipulator 9: The main manipulator 9 performs the second stage rotation, sending the drill rod into the frame 11, and the drill rod is clamped by the clamper 12 or the power head 10.

[0236] 24) Main manipulator 9 releases: Main manipulator 9 releases the drill rod.

[0237] 25) Drill rod connection: The power head 10 and the clamp 12 cooperate to complete the drill rod connection and continue drilling.

[0238] (2) Rod withdrawal condition

[0239] 1) Initial state: Assume that the inclination angle of the frame 11 and the main manipulator 9 is α; the drill rod transporter is in a horizontal position, the slider 805 is expanded to both ends, and the pressure plate 803 is open; the telescopic joint of the main manipulator 9 is retracted, the main rotation joint is in the state of completing the first rotation, the sliding joint is retracted, and the main gripper is open; the auxiliary manipulator 6 is located at the position where the slide rail of the drill rod box 5 is closest to the transfer trough, the lifting joint makes the gripper at a height suitable for grabbing the drill rod in the drill rod transporter, the auxiliary telescopic joint is retracted, the auxiliary rotation joint makes the auxiliary gripper rise, and the auxiliary gripper is open; the drilling rig has just completed drilling the last drill rod.

[0240] 2) The power head 10 retreats: the power head 10 drags the drill rod in the hole backward;

[0241] 3) The main manipulator 9 slides: The main manipulator 9 slides toward the gripper 12 and is in a position suitable for extending into the frame 11 to grab the drill rod.

[0242] 4) Main manipulator 9 waits: waits for the current drill pipe to complete shattering;

[0243] 5) Rotation of the drill rod transporter: The drill rod transporter rotates in the direction of the inclination angle α until the inclination angle is the same as that of the frame 11.

[0244] 6) Drill pipe shackle: The power head 10 and the clamp 12 cooperate to complete the drill pipe shackle (disconnection with the drill pipe in the hole).

[0245] 7) The main manipulator 9 extends: the telescopic joint of the main manipulator 9 extends.

[0246] 8) Second stage rotation of the main manipulator 9: The main manipulator 9 performs the second stage rotation, and the gripper reaches a position where it can grip the drill rod to be removed in the frame 11.

[0247] 9) Main manipulator 9 clamping: The main manipulator 9 clamps the drill rod.

[0248] 10) The clamp 12 or the power head 10 is released: the clamp 12 or the power head 10 is completely disconnected from the drill pipe to be removed.

[0249] 11) The main manipulator 9 rotates in the opposite direction: The main manipulator 9 rotates in the opposite direction to place the drill rod into the drill rod transporter.

[0250] 12) Drill rod transporter clamping: When the drill rod is placed in the drill rod transporter, the slide block 805 of the drill rod transporter contracts inwards, and at the same time, the pressure plate 803 presses the drill rod.

[0251] 13) Main manipulator 9 releases: Main manipulator 9 releases the drill rod.

[0252] 14) The main manipulator 9 retracts: the telescopic joint of the main manipulator 9 retracts.

[0253] 15) The first stage of rotation of the main manipulator 9: the main manipulator 9 rotates clockwise ( Figure 1 ) to make room for the drill pipe transporter to rotate.

[0254] 16) Drill pipe transporter level: The drill pipe transporter returns to the horizontal position.

[0255] 17) The auxiliary manipulator 6 extends: the telescopic joint of the auxiliary manipulator 6 drives the gripper to extend toward the drill pipe transporter.

[0256] 18) Auxiliary manipulator 6 clamping: The auxiliary clamping claws of the auxiliary manipulator 6 clamp the drill rod.

[0257] 19) The drill pipe transporter is released: the transport trough slider 805 expands to both sides and the pressure plate 803 is released.

[0258] 20) The auxiliary manipulator 6 retracts: The telescopic joint of the auxiliary manipulator 6 retracts and takes out the drill rod from the drill rod transporter.

[0259] 21) The auxiliary manipulator 6 swings down: the auxiliary gripper of the auxiliary manipulator 6 swings downward and away from the drill rod transporter.

[0260] 22) Auxiliary manipulator 6 selects a column: Under the control of the control system, the auxiliary manipulator 6 selects a column of space where the drill rod can be placed.

[0261] 23) Height adjustment of the auxiliary manipulator 6: The auxiliary manipulator 6 is adjusted by the lifting joint and the telescopic joint to reach a height suitable for placing the current drill rod into the drill rod box 5.

[0262] 24) Auxiliary manipulator 6 releases: After the drill rod is placed, the auxiliary gripper of the auxiliary manipulator 6 releases the drill rod.

[0263] Example 2:

[0264] This embodiment further defines the main telescopic joint as comprising a vertically arranged main outer cylinder 907 and a main inner cylinder 908. The main outer cylinder 907 is connected to the main rotating shaft 905, the main inner cylinder 908 is slidably connected to the interior of the main outer cylinder 907, and the main gripper assembly is connected to the bottom of the main inner cylinder 908. During implementation, the main inner cylinder 908 and the main outer cylinder 907 of the present invention maintain relative sliding in the axial direction, with the sliding direction being perpendicular to the axis of the main rotating shaft 905 in the main rotating joint, thereby extending the radius of the original main manipulator 9 and expanding the grasping range of the main manipulator 9. In addition, during installation, the main inner cylinder 908 and the main outer cylinder 907 should be provided with structures such as limit rings or retaining rings to ensure that the main inner cylinder 908 does not slide outside the main outer cylinder 907.

[0265] Furthermore, the main outer cylinder 907 is detachably connected to the main rotating shaft 905 via a flange. During implementation, the main telescopic joint in the present invention is suspended at one end of the main rotating shaft 905. In addition to the weight of the main clamping jaw assembly, sufficient connection strength is required between the main rotating shaft 905 and the main outer cylinder 907. Flange connection is to first fix two pipes, pipe fittings or equipment on a flange plate, add a flange gasket between the two flange plates, and fasten them together with bolts to complete the connection. Flange connection is an important connection method for pipeline construction. Flange connection is easy to use and can withstand greater pressure. Therefore, the present invention meets the connection strength between the main rotating shaft 905 and the main outer cylinder 907 through flange connection, and the flange connection is connected by multiple bolts, so that the main rotating shaft 905 and the main outer cylinder 907 can be disassembled to facilitate the later inspection or replacement of various components.

[0266] In addition, the main outer cylinder 907 and the main inner cylinder 908 in the present invention are both hollow cylindrical structures, which reduces the weight of the main telescopic joint to a certain extent and further ensures the connection strength between the main outer cylinder 907 and the main rotating shaft 905.

[0267] Furthermore, the main telescopic joint also includes a main telescopic oil cylinder 906, which is fixed to the top of the main outer cylinder 907. The main inner cylinder 908 is connected to the output end of the main telescopic oil cylinder 906. The present invention uses the main telescopic oil cylinder 906 to intelligently control the relative movement between the main outer cylinder 907 and the main inner cylinder 908, so that the main clamping jaw assembly located at the bottom of the main inner cylinder 908 can stop at a set position and perform a grasping action. The extension and contraction process of the main telescopic oil cylinder 906 is the distance that the main outer cylinder 907 and the main inner cylinder 908 can move relative to each other, and this distance should be less than the maximum displacement between the main outer cylinder 907 and the main inner cylinder 908 to prevent collision between the main outer cylinder 907 and the main inner cylinder 908.

[0268] Furthermore, the main clamping jaw assembly includes a main clamping jaw 910 and a main clamping cylinder 909. The main clamping cylinder 909 is fixed to the lower portion of the main inner tube 908. The main clamping jaw 910 is fixed to the main clamping cylinder 909 and is clamped or released under the drive of the main clamping cylinder 909. During operation, after the main rotating joint drives the main clamping jaw 910 to rotate to a set angle, the main telescopic joint's telescopic function extends the main clamping jaw 910 to a specified position. Finally, the main clamping cylinder 909 executes the grasping command to complete the grasping process. The main telescopic joint then controls the main clamping jaw 910 to retract. After the main rotating joint drives the main telescopic joint and the main clamping jaw 910 to rotate to the specified position, the main clamping cylinder 909 executes the release command to release the grasped drill rod to the specified position.

[0269] Example 3:

[0270] Based on Figure 2 As shown, the frame-mounted main manipulator 9 provided by the present invention also includes a sliding joint, and the rotating seat 903 is fixed to the sliding joint to drive the overall horizontal displacement of the main manipulator 9. The difference from Example 2 is that this embodiment adds a sliding joint, while the remaining main rotating joints and main telescopic joints remain the same as Example 2.

[0271] As mentioned above, the combination of the main rotating joint and the main telescopic joint enables the main manipulator 9 to expand the grasping range. The sliding joint in this embodiment applies a horizontal displacement function to the main manipulator 9, further expanding the grasping range of the main manipulator 9.

[0272] Furthermore, the sliding joint includes a fixed seat 901 and a connecting arm 911. The fixed seat 901 is connected to the frame 11 and is equipped with a horizontally arranged main slide rail. The bottom of the connecting arm 911 is provided with a sliding groove that cooperates with the main slide rail. The rotating seat 903 in the main rotating joint is fixedly connected to the connecting arm 911. During implementation, the cooperation between the rail and the sliding groove limits the horizontal displacement between the connecting arm 911 and the fixed seat 901, that is, determines the direction and amount of horizontal displacement of the connecting arm 911. The main rotating joint and the main telescopic joint in the present invention are both fixed to the connecting arm 911. Therefore, any displacement of the connecting arm 911 will cause the entire main manipulator 9 to move. The specific horizontal displacement direction needs to be determined based on the initial position of the drill rod, the required transport position, and the initial position of the main manipulator 9 in the actual situation. In other words, the rail in the sliding joint in the present invention can be set in any direction to ensure that the main manipulator 9 can effectively complete the grasping process.

[0273] In addition, in Example 3, it is mentioned that the main telescopic joint is suspended at one end of the main rotating shaft 905, that is, the connecting arm 911 also needs to assume the supporting role of the main manipulator 9. Therefore, according to the principle of leverage, without interfering with the normal extension and contraction of the main telescopic joint, there should be sufficient connection area between the connecting arm 911 and the rotating base 903, and the distance between the connecting arm 911 and the main telescopic joint should be reduced as much as possible to ensure sufficient connection strength between the two, so as to avoid the problem of damage to the main rotating shaft 905 due to excessive suspension of the main telescopic joint. Similarly, the rotating base 903 should also have sufficient covering area for the main rotating shaft 905, and distribute the gravity of the main telescopic joint and the main clamping jaw assembly to each part of the rotating base 903 through the transmission shaft, and then transmit it as a whole to the fixed base 901 through the connecting arm 911.

[0274] Furthermore, the sliding joint also includes a sliding oil cylinder 912, one end of which is fixed to the fixed seat 901, and the other end is connected to the connecting arm 911, so that the connecting arm 911 slides along the track. The present invention uses the sliding oil cylinder 912 to intelligently control the relative displacement between the connecting arm 911 and the fixed seat 901, so that the main manipulator 9 can stop at a set position and perform a grasping action. The displacement process of the sliding oil cylinder 912 is the distance that the connecting arm 911 and the fixed seat 901 can move relative to each other, and this distance should be less than the maximum displacement between the connecting arm 911 and the fixed seat 901 to prevent collision between the connecting arm 911 and the fixed seat 901.

[0275] See also Figures 5 to 7 As shown, the lifting joint and the auxiliary rotation joint are connected via a crossbeam 603 . The lifting joint is connected below the crossbeam 603 , and the auxiliary rotation joint is connected to the side of the crossbeam 603 .

[0276] The lifting joint includes a lifting cylinder 601 and a lifting outer cylinder 602 which are connected to each other. The lifting outer cylinder 602 is installed in a sleeve arrangement with the lifting inner cylinder below the beam 603. The lifting outer cylinder 602 and the lifting inner cylinder form a lifting pair. The lifting cylinder 601 drives the lifting pair to perform lifting motion.

[0277] The secondary rotating joint includes a secondary rotating driver 604 connected to the beam 603 and a secondary rotating shaft 605 connected to the secondary rotating driver 604. The secondary rotating shaft 605 rotates under the drive of the secondary rotating driver 604; the end of the secondary rotating shaft 605 away from the beam 603 is connected to the secondary telescopic joint. The secondary rotating shaft 605 rotates, driving the secondary telescopic joint and the secondary clamp 609 to swing.

[0278] The secondary telescopic joint includes a secondary telescopic oil cylinder 606 connected to the secondary rotating shaft 605. The secondary outer cylinder 607 and the secondary inner cylinder 608 are connected to the lower part of the secondary telescopic oil cylinder 606. The secondary inner cylinder 608 is inserted into the secondary outer cylinder 607 to form a telescopic joint, which performs telescopic movement under the drive of the secondary telescopic oil cylinder 606.

[0279] The auxiliary rotating shaft 605 is installed in the inner cavity of the beam 603. The inner cavity of the beam 603 is provided with an arc groove. The outer side of the auxiliary rotating shaft 605 is provided with a protrusion. When the auxiliary rotating shaft 605 rotates, the protrusion slides circumferentially in the arc groove to limit the rotation of the auxiliary rotating shaft 605.

[0280] A side of the auxiliary clamping jaw 609 close to the telescopic unit is connected to an auxiliary clamping oil cylinder 610 , and the auxiliary clamping jaw 609 is clamped or released under the drive of the auxiliary clamping oil cylinder 610 .

[0281] The present invention achieves vertical swinging of the auxiliary manipulator 6 by providing a secondary rotational joint with a defined angle. This allows the manipulator to transport drill pipe across components such as the attitude adjustment device, thereby allowing the transporter to be positioned on the attitude adjustment device on the opposite side of the drill pipe box. This improvement significantly increases the flexibility of the drill pipe transportation system layout for full-face drilling, enabling the drilling rig to adapt to more complex downhole environments and drilling requirements.

[0282] Example 4:

[0283] See also Figures 8 to 12 As shown, the asynchronous rotation device includes a lifting sleeve 705, a transporter rotator 709, an inclination rotator 710, a rotation transition plate 712 and a frame connecting plate 713. The frame 11 and the rotating platform 702 are connected in sequence through the inclination rotator 710, the frame connecting plate 713, the rotation transition plate 712 and the lifting sleeve 705; wherein, the inclination rotator 710 is rotationally connected to the frame 11, and the drill rod transporter is rotationally connected to the rotation transition plate 712 through the transporter rotator 709, and the inclination angle between the frame 11 and the drill rod transporter is asynchronously rotated and adjusted through the inclination rotator 710 and the transporter rotator 709.

[0284] The lifting sleeve 705 is a connector for installing the transporter rotator 709, the tilt rotator 710, the rotary transition plate 712 and the frame connecting plate 713. It includes a cavity enclosed by two side plates 70501 and a top cover plate. Sleeves 70502 are provided at both ends of the side plates 70501, and a connecting cylinder 70503 is provided on the side plates 70501. Two lifting columns 704 are relatively provided on the rotary platform 702, and a lifting cylinder 706 is provided between the two lifting columns 704. The cavity The lifting cylinder 706 of the rotating platform 702 is installed inside, and one end of the lifting cylinder 706 is connected to the lifting sleeve 705 by a pin shaft or the like, and the other end is fixedly installed on the rotating platform 702, thereby indirectly installing the lifting sleeve 705 on the rotating platform 702. Driven by the lifting cylinder 706, the lifting sleeve 705 moves up and down along the lifting column 704; the sleeve 70502 is sleeved on the lifting column 704 of the rotating platform 702, and a rotating transition plate 712 is installed on the connecting cylinder 70503.

[0285] The connecting tube 70503 is located on the side of the lifting sleeve 705 facing the frame 11, and a flange is provided on the connecting tube 70503; the rotary transition plate 712 is disc-shaped, including three sets of flanges arranged side by side, the inner flange is connected to the flange of the connecting tube 70503, and the two sets of outer flanges are used to install the transporter rotator 709 and the frame connecting plate 713 respectively.

[0286] The transporter rotator 709 is a driving element for adjusting the inclination of the drill pipe transporter. The transporter rotator 709 includes a first fixed ring and a first rotating ring disposed thereon. The first fixed ring is bolted to the flange of the rotating transition plate 712, thereby indirectly fixing the rotating transition plate 712 to the lifting sleeve 705. The first rotating ring is fixedly connected to the first outer shell, and the drill pipe transporter is mounted on top of the first outer shell. The inclination of the drill pipe transporter is adjusted by rotating the first rotating ring. In some embodiments of the present invention, the transporter rotator 709 is preferably a worm gear reducer, with the first rotating ring being the inner ring and the first fixed ring being the outer ring. The outer side of the outer ring is a worm wheel, which is driven by the worm.

[0287] The frame connecting plate 713 is disc-shaped and includes two sets of flanges connected to each other. The two sets of flanges are respectively connected to the flange of the rotary transition plate 712 and the inclination rotator 710.

[0288] The inclination rotator 710 includes a second fixed ring and a second rotating ring arranged thereon, and the second fixed ring is connected to the flange of the frame connecting plate 713; the second rotating ring is fixedly connected to the second outer shell, and the frame 11 is installed on the second outer shell. The rotation of the second rotating ring drives the frame 11 to rotate in a circle to adjust the inclination angle of the frame 11; the inclination rotator 710 is similar to the transporter rotator 709, the second rotating ring is the inner ring, and the second fixed ring is the outer ring.

[0289] The asynchronous rotation principle of the drill rod transfer mechanism of the present invention is as follows:

[0290] The first fixing ring of the transporter rotator 709 is bolted to the flange of the rotary transition plate 712, thereby indirectly securing the rotary transition plate 712 to the lifting sleeve 705. The inner ring of the transporter rotator 709 is the first rotating ring and is fixedly connected to the first outer shell. The drill pipe transporter is fixedly mounted on the top of the outer shell, and its inclination angle can be adjusted as the outer shell rotates. Figure 1 The attitude adjustment device 7 is an actuator for adjusting the drilling inclination and azimuth of the frame 11.

[0291] Similar to the first fixed ring of the transporter rotator 709, the frame connecting plate 713 is fixedly mounted on the rotary transition plate 712, thereby indirectly fixing the frame connecting plate 713 to the lifting sleeve 705. The second rotating ring (preferably the inner ring) of the inclinometer rotator 710 is connected to the frame 11, and the second fixed ring (outer ring) is fixedly mounted on the frame connecting plate 713, thereby indirectly fixing the frame connecting plate 713 to the lifting sleeve 705.

[0292] Therefore, the first fixed ring of the transporter rotator 709 and the second fixed ring of the inclination rotator 710 are both fixedly mounted on the lifting sleeve 705, and the first rotating ring and the second rotating ring respectively carry the drill rod transporter and the frame 11, and are not restricted in rotation by the lifting sleeve 705, and can rotate independently and freely, thereby forming an asynchronous rotation device that drives the frame 11 and the drill rod transporter to adjust the inclination angles of the two components separately.

[0293] Example 5:

[0294] like Figures 13 to 16 As shown, this embodiment, based on Example 4, further provides a drill rod conveying sensor group and a rotation positioning sensor group 714 for an automatic drill rod conveying system. This drill rod conveying sensor group is applied to the drill rod conveying process in an automatic drilling rig. This system uses sensors installed on the auxiliary manipulator 6, the drill rod transporter 8, and the main manipulator 9 to accurately monitor the position and status of the drill rods, thereby improving the automation and safety of drill rod conveying.

[0295] 1. Detection sensor

[0296] The detection sensor 611 is installed on the auxiliary gripper 609 of the auxiliary manipulator 6 and is used to detect whether there is a drill rod in the auxiliary manipulator 6.

[0297] like Figure 13 As shown, the detection sensor 611 includes the following components:

[0298] Detection sensor mounting base 61101: radially fixed on one side of the clamping jaw to support other components.

[0299] Detection sensor spring 61102: set in the detection sensor mounting seat 61101 to provide elastic reset force.

[0300] Trigger column 61103: movably mounted in the detection sensor mounting seat 61101 through the detection sensor spring 61102, and in direct contact with the drill pipe.

[0301] Detection sensor body 61104: fixed in the detection sensor mounting base 61101, configured to detect whether the trigger column 61103 enters the coverage range.

[0302] The working principle is as follows: when there is no drill rod in the auxiliary gripper 609 of the auxiliary manipulator 6, the trigger column 61103 is initially positioned below the detection range of the detection sensor body 61104 under the elastic force of the detection sensor spring 61102, and the signal of the detection sensor body 61104 is disconnected;

[0303] When the auxiliary gripper 609 of the auxiliary manipulator 6 approaches and grips the drill rod, the trigger pin 61103 is pressed upward by the drill rod, overcoming the elastic force of the detection sensor spring 61102 and moving upward, entering the detection range of the detection sensor body 61104. The detection sensor body 61104 generates an on signal indicating the presence of the drill rod. When the auxiliary gripper 609 leaves the drill rod, the detection sensor spring 61102 resets the trigger pin 61103, and the signal from the detection sensor body 61104 is disconnected.

[0304] 2. Judgment sensor

[0305] The determination sensor is installed on the drill rod transporter 8 and is used to detect whether there is a drill rod in the drill rod transporter 8.

[0306] like Figure 14 As shown, the judgment sensor includes the following components:

[0307] Judgment sensor mounting base 808: fixed below the bottom plate 801 of the drill pipe transporter 8, serving as a support structure for the judgment sensor.

[0308] Judgment sensor body 807: fixed in the judgment sensor mounting seat 808, used to generate a detection signal.

[0309] Judgment sensor spring 810: set in the judgment sensor mounting seat 808 to provide a reset force.

[0310] The signal post 809 is movably mounted in the sensor mounting seat 808 through the sensor spring 810, and its top end penetrates the bottom plate for contacting the drill rod.

[0311] The working principle is as follows: when there is no drill rod in the drill rod transporter 8, under the elastic force of the sensor spring 810 of the signal post 809, the bottom end of the signal post 809 does not enter the sensing range of the sensor body 807, and the signal of the sensor body 807 is disconnected;

[0312] When the drill rod is placed in the drill rod transporter 8, the signal post 809 is pressed downward by the drill rod, overcoming the elastic force of the judgment sensor spring 810, and the bottom end enters the sensing range of the judgment sensor body 807, generating a connection signal;

[0313] When the drill rod is removed, the sensor spring 810 resets the signal post 809 and the signal is disconnected.

[0314] The top of the signal post 809 is designed to exceed the lowest point of the bottom plate where the drill rod is placed, so as to ensure that the signal post 809 can be pressed down when there is a drill rod in the drill rod transporter 8.

[0315] 3. Rotation sensor

[0316] The rotation sensor 904 is mounted on the main manipulator 9 and is used to detect the rotation position and direction of the main manipulator 9. The rotation shaft 905 and the main outer cylinder 907 in the main manipulator 9 are both rotating parts that are rotatably connected to the rotating base 903.

[0317] like Figure 15 and Figure 16 As shown, the rotation sensor 904 includes the following components:

[0318] Rotation sensor mounting base 90401: fixed on the rotation base of the main manipulator 9 to support the sensor body.

[0319] Rotation sensor body 90402: fixed in the rotation sensor mounting base 90401 to detect the rotation signal.

[0320] Trigger ring 90403: fixed on the rotating shaft or outer cylinder of the main manipulator 9, rotates along with the rotating shaft or outer cylinder, interacts with the rotation sensor body 90402 to generate a corresponding signal, and the circumferential angle of the trigger ring 90403 covers the rotation angle range of the main manipulator 9.

[0321] The trigger ring 90403 includes two arc segments of different lengths and a gap. As the main manipulator 9 rotates, the rotation sensor body 90402 sequentially detects the arc segments and gap. Based on the duration and on / off state of the signal, it indicates the main manipulator's rotation direction and position. For example, a short arc segment corresponds to a short-duration on signal, a long arc segment corresponds to a long-duration on signal, and a gap corresponds to an off signal.

[0322] Specifically, in this embodiment, the arc segments of different arc lengths and one gap are respectively the first arc segment 90403a, the gap 90403b and the second arc segment 90403c, wherein the first arc segment 90403a is the arc segment close to the rotation sensor body 90402 in the initial state of the trigger ring 90403 (the main manipulator is defined as the initial state when it is on the side of the drill rod transporter), and the arc length of the first arc segment 90403a is smaller than the arc length of the second arc segment 90403c, thereby forming a signal change process of "off-short on-off-long on-off" in the process of the main manipulator rotating the drill rod transporter toward the frame.

[0323] During the actual operation of an automated drilling rig, after the main manipulator removes a drill rod from the drill rod transporter, the transporter must return to a horizontal position to receive the next drill rod. The main manipulator must leave a certain amount of space to avoid interfering with the transporter's movements. However, since the rig is still drilling, the main manipulator cannot be directly positioned within the gantry. Therefore, it must remain between the transporter and the gantry.

[0324] Therefore, the circumferential angle of the trigger ring is divided into two segments. After the main manipulator grabs the drill rod from the drill rod transporter, the rotation sensor body 90402 switches from the disconnected state to first detect the first arc segment 90403a, generating a short-circuit signal. It then enters the gap 90403b and switches from the disconnected state. After remaining in the disconnected state for a specified period of time or until a signal from the control system is received, it continues to rotate, with the rotation sensor body 90402 detecting the second arc segment 90403c and generating a long-circuit signal. The signal from the rotation sensor body 90402 is disconnected again, at which point the main manipulator delivers the drill rod into the rack.

[0325] Since the arc length of the first arc segment is smaller than that of the second arc segment, the control system can determine the direction of rotation of the manipulator by the change in the duration of the sensor signal connection "from short to long or from long to short", thereby recording the status of the main manipulator in the system.

[0326] Through the coordinated operation of the above three sensors, the drill rod conveying sensor group of this embodiment can monitor the position and status of the drill rod between the auxiliary manipulator 6, the drill rod transporter 8 and the main manipulator 9 in real time, ensuring a smooth and safe conveying process.

[0327] The rotation positioning sensor group 714 includes a transporter inclination sensor 71403, a rack position sensor 71401, a synchronization sensor 71402 and a transporter level sensor 71404, which are used to locate and detect the rotation direction during the transportation of the drill pipe;

[0328] The rack position sensor 71401 includes a position plate 71401a and a first sensor 71401b. The position plate 71401a is connected to the rack 11 and rotates with the rack 11.

[0329] The zone plate 71401a is divided into a positive inclination zone and a negative inclination zone. The positive inclination zone and the negative inclination zone both cover a circumferential angle of 180°, and the difference between the radius of the positive inclination zone and the radius of the negative inclination zone is not less than 1 times the sensing distance of the sensor.

[0330] The first sensor 71401b is arranged on the outside of the positioning plate 71401a and is adjacent to the junction of the positive inclination area and the negative inclination area, so that when the frame changes between the positive and negative inclination states, the first sensor 71401b can send a corresponding signal in time.

[0331] Furthermore, the location shaft 711 is a hollow circular tube with connecting flanges at both ends, one end of which is fixedly connected to the frame 11, and the other end of which is fixedly connected to the location plate 71401a.

[0332] The working principle of the rack position sensor is as follows:

[0333] Frame 11 is connected to the zone plate via a zone shaft 711. When frame 11 rotates to a certain angle, zone plate 71401a, driven by the zone shaft, rotates by the same angle. Therefore, when the frame switches between positive and negative inclination, the alignment area between the first sensor signal and zone plate 71401a also switches between positive and negative inclination zones, further switching the signal from first sensor 71401b on and off to determine the frame's positive and negative inclination, ensuring that the frame and the drill pipe transporter maintain the same inclination.

[0334] The synchronization sensor 71402 is composed of a first trigger block 71402a and a second sensor 71402b. The first trigger block 71402a is mounted on the outer shell (rotating circle) of the transporter rotor 709 and rotates with the outer shell. The second sensor 71402b is mounted on the side of the frame facing the transporter rotor 709 via a mounting bracket.

[0335] The working principle of the synchronization sensor 71402 is as follows: when the frame and the drill pipe transporter are at the same inclination angle, the first trigger block 71402a and the second sensor 71402b are aligned, and the second sensor has a signal output; when the two rotate relative to each other and the inclination angles are no longer equal, the first trigger block 71402a and the second sensor 71402b are no longer aligned, the second sensor is disconnected, and no signal output.

[0336] The principle of the transporter level sensor 71404 is the same as that of the synchronous sensor 71402. The difference is that it includes a second trigger block installed on the drill pipe transporter 8 and rotates accordingly, and a third sensor is installed at an appropriate position on the side of the lifting sleeve facing the transporter rotator through a mounting seat.

[0337] The working principle of the transporter level sensor 71404 is as follows: when the drill pipe transporter is in a horizontal position, the third sensor outputs a signal;

[0338] When the drill pipe transporter rotates and is not in a horizontal position, the third sensor is not aligned with the second trigger block, the third sensor is disconnected, and no signal is output.

[0339] The frame and drill pipe transporter rotation positioning sensor system also includes an inclination rotator 710, a location axis 711 and a frame 11;

[0340] The inclination rotator 710 is mounted on the lifting sleeve 705, and the frame 11 is mounted on the inclination rotator 710, so that the transporter rotator and the inclination rotator adjust the inclination angle of the drill pipe transporter and the inclination angle of the frame respectively;

[0341] Both ends of the positioning shaft 711 are connected to the frame 11 and the positioning plate 71401 a so that the positioning plate 71401 a rotates along with the frame 11 .

[0342] Specifically, in this embodiment, Figures 18 and 19 For example, the rack position sensor 71401:

[0343] Function: used to determine whether the rack 11 is in a positive tilt angle condition or a negative tilt angle condition.

[0344] Composition: includes a location plate 71401a and a first sensor 71401b.

[0345] Positioning plate 71401a is fixedly connected to the frame 11 via the positioning axis 711 and rotates with it. The positioning plate is divided into a positive and negative tilt zone, each covering a 180° circumference. The radius of the positive tilt zone is larger than that of the negative tilt zone, and the difference between the two is designed to be 1.5 times the sensing distance of the first sensor to ensure clear signal differentiation.

[0346] The first sensor 71401b is a Hall-effect proximity switch installed on the outside of the positioning plate, in the negative tilt zone, near the boundary between the positive and negative tilt zones. As the positioning plate rotates, the first sensor outputs an on / off signal based on the difference in radius between the positive and negative tilt zones.

[0347] by Figure 20 Take the synchronous sensor 71402 as an example:

[0348] Function: used to determine whether the frame 11 and the drill rod transporter 8 are at the same inclination angle.

[0349] Composition: includes a trigger block 71402a and a second sensor 71402b.

[0350] Trigger block 71402a: fixed on the outer shell of the transporter rotator 709 and rotates with the drill pipe transporter 8.

[0351] Second sensor 71402b: A photoelectric sensor, secured to the side of frame 11 facing the transporter rotor via a mounting bracket. When the trigger block aligns with the second sensor, the sensor outputs an on signal, indicating that the frame and drill pipe transporter are aligned. The signal is off when the two rotate relative to each other.

[0352] The principle of the transporter level sensor 71404 is the same as that of the synchronous sensor 71402. The difference is that it includes a second trigger block installed on the drill pipe transporter 8 and rotates accordingly, and a third sensor is installed through a mounting bracket at an appropriate position on the side of the lifting sleeve facing the transporter rotator. In this application, this position is preferably the top middle position of the lifting sleeve.

[0353] The inclination rotator 710 has an outer ring fixed to the lifting sleeve, and an inner ring drives the frame 11 to rotate in a circle to adjust its inclination.

[0354] Zone shaft 711: A hollow circular tube with connecting flanges at both ends, one end of which is fixedly connected to the frame and the other end is connected to the zone plate.

[0355] This embodiment also provides a method for determining the inclination state of a frame and a drill rod transporter, so as to maintain the drill rod transporter and the frame at the same inclination state or to determine the subsequent rotation direction of the drill rod transporter. The specific steps are as follows:

[0356] 1. Initial State: Transporter Level Sensor 71404 is engaged, and both the frame 11 and the drill pipe transporter 8 are horizontal. At this point, the first sensor 71401b, located near the intersection of the negative inclination zone and not sensing the positive inclination zone, disconnects the frame position sensor. The first trigger block aligns with the second sensor, and the synchronization sensor connects.

[0357] 2. Frame rotation: The tilt rotator 710 drives the frame to rotate in the positive tilt direction to the set angle A (e.g., A=15°). After the rotation starts, the trigger block deviates from the second sensor, the synchronization sensor is disconnected, and the transporter level sensor 71404 is disconnected.

[0358] 3. Signal judgment: The rack rotates so that the positive inclination area of the position plate enters the sensing range of the first sensor, and the rack position sensor is turned on, indicating that the rack is in the positive inclination working condition.

[0359] 4. Drill rod transporter synchronization: After the frame rotates into place, the transporter rotator 709 drives the drill rod transporter to rotate in the positive inclination direction until the trigger block is aligned with the second sensor again and the synchronization sensor is connected. At this time, the drill rod transporter and the frame have the same inclination angle (both are 15°) and are in the positive inclination working condition.

[0360] Horizontal to negative tilt adjustment:

[0361] 1. Initial state: The transporter level sensor 71404 is connected, the frame and the drill pipe transporter are both in a horizontal position, the frame position sensor is disconnected, and the synchronization sensor is connected.

[0362] 2. Frame rotation: The inclination rotator drives the frame to rotate in the negative inclination direction to the set angle B (for example, B = -10°). After the rotation starts, the synchronization sensor is disconnected and the transporter level sensor 71404 is disconnected.

[0363] 3. Signal judgment: The rack rotates so that the negative inclination area of the position plate is aligned with the first sensor. Since the radius of the negative inclination area is small and does not enter the sensing range, the rack position sensor remains disconnected, indicating that the rack is in a negative inclination working condition.

[0364] 4. Drill pipe transporter synchronization: After the frame rotates into place, the transporter rotator drives the drill pipe transporter to rotate in the negative inclination direction until the synchronization sensor is connected again. At this time, the drill pipe transporter and the frame have the same inclination angle (both -10°) and are in a negative inclination working condition.

[0365] The drill pipe transporter inclination sensor 71403 includes an inner gear ring 71403a, a rotating shaft 71403c, a sensor gear ring 71403d and a pull wire sensor 71403e.

[0366] The inner gear ring 71403a is fixedly connected to the rotating ring in the transporter rotator 709 connected to the drill pipe transporter 8, so as to drive the inner gear ring 71403a to rotate through the transporter rotator 709.

[0367] The rotating shaft 71403c is rotatably connected to the lifting sleeve 705 for installing the transporter rotator 709, and a first-stage gear 71403b and a second-stage gear 71403f are respectively provided at both ends of the rotating shaft 71403c. The first-stage gear 71403b is engaged with the inner gear ring 71403a, and the second-stage gear 71403f is engaged with the sensor gear ring 71403d. The sensor gear ring 71403d is rotatably arranged on the outside of the lifting sleeve 705.

[0368] The pull wire sensor 71403e is arranged on the outside of the lifting sleeve 705 (away from the side of the transporter rotator 709) and is connected to the sensor gear ring 71403d through a pull wire to calculate the rotation angle of the drill pipe transporter 8 through the pull wire length of the pull wire sensor 71403e.

[0369] The drill rod transporter 8 is the second-level actuator of the drill rod conveying system, which realizes the transfer of the drill rod between the main manipulator and the auxiliary manipulator, and converts the inclination angle of the drill rod from horizontal to parallel to the frame. The lifting sleeve 705 is the main connecting part of the transporter rotator 709, lifting cylinder, lifting column and other components. The lifting sleeve cavity is formed by the front and rear side panels and the top sealing plate. The interior of the cavity is used to install the lifting cylinder. One end of the lifting cylinder is connected to the lifting sleeve 705 by a pin shaft or the like, and the other end is fixedly installed on the rotating platform, thereby driving the lifting sleeve 705 to move up and down along the lifting column. The rotating shaft 71403c and the transporter rotator 709 can be raised and lowered synchronously with the raising and lowering of the lifting sleeve 705.

[0370] In addition, a pressure cap 71403g is provided on the outside of the lifting sleeve 705, and the sensor ring gear 71403d is enclosed within the pressure cap 71403g to protect the sensor ring gear 71403d. The direction of rotation of the sensor ring gear 71403d can be displayed by the expansion and contraction of the cable of the cable sensor 71403e, and the angle can be calculated based on the change in the length of the cable of the cable sensor 71403e. The pressure cap 71403g can be configured as a transparent structure to intuitively display the rotation direction of the sensor ring gear 71403d and the degree of gear wear, thereby facilitating timely repair or replacement of the drill pipe transporter inclination sensor 71403 and avoiding large errors in the detection of the drill pipe transporter inclination sensor 71403.

[0371] This invention utilizes an integrated design combining gear transmission, cable measurement, and mechanical protection to achieve high-precision, highly reliable full-process inclination angle monitoring under complex operating conditions. By optimizing the gear ratio when converting rotary motion into linear displacement, the nonlinear error between cable extension and actual angle is reduced by 92%.

[0372] Furthermore, the inclination adjustment range of the transporter rotator 709 is 360°, and the transporter rotator 709 is divided into positive inclination rotation and negative inclination rotation. The angles corresponding to the positive inclination rotation and the negative inclination rotation are 0~180° and 0~-180° respectively.

[0373] The basic working principle of the transporter tilt sensor 71403 is as follows Figure 22 shown.

[0374] The inclination rotation range of the drill rod transporter 8 is consistent with that of the drilling rig frame, which is 360°. According to the settings of the drilling rig hydraulic pipeline, control circuit, etc., the inclination adjustment of the frame in actual operation is divided into two upper and lower semicircles, namely 0 to ±180°. In the specific implementation process, compared with the unidirectional control of 0° to 360°, the present invention effectively solves the problem of entanglement between hydraulic pipelines and cables through limited angle control + two-way rotation strategy, that is, the inclination rotation range of the drill rod transporter 8 is adjusted from unidirectional 0° to 360° to bidirectional 0 to ±180°, and the corresponding gear transmission structure and sensor gear ring 71403d also have forward and reverse rotation. The pull wire of the wire sensor 71403e is controlled by the limited angle of the drill rod transporter 8, avoiding the problem of failure of the wire sensor 71403e due to stress damage, or even breakage due to excessive stretching.

[0375] Furthermore, when the transporter rotator 709 is in the initial position, that is, assuming that the inclination angle of the drill pipe transporter 8 is 0°, the cable passes through the upper semicircle of the sensor gear ring 71403d and is fixed to it. The initial length of the cable between the connection point of the cable sensor 71403e and the sensor gear ring 71403d is L0, and the initial angle is θ. Then, the cable length corresponding to a unit angle satisfies the following conditions:

[0376] k=L0 / θ.

[0377] Furthermore, the initial angle θ of the wire between the connection point of the wire sensor 71403e and the sensor gear ring 71403d is less than 180°. In theory, the rotation angle of the transporter inclination sensor 71403 should be consistent with the inclination adjustment range of the drill pipe transporter 8. However, affected by factors such as the structural size of the lifting sleeve 705, the installation space, and processing and assembly errors, the fixed end of the wire of the wire sensor 71403e cannot always be installed facing 0° or 180° (the horizontal line in the figure), and there will actually be a section of the wire that cannot always fit the outer edge of the sensor gear ring 71403d. Therefore, the envelope range of the wire to the outer edge of the sensor gear ring 71403d is always less than 180°.

[0378] Preferably, the envelope range of the pull wire relative to the outer edge of the sensor gear ring 71403d is between 120° and 180°.

[0379] Specifically, in this embodiment, Figure 22 For example, the pull-wire sensor 71403e is located above the horizontal line of the sensor gear ring 71403d. When the transporter rotator is in the initial state, the connection point between the pull-wire sensor 71403e and the sensor gear ring 71403d rotates to the 0° or 180° horizontal line, and the pull-wire of the pull-wire sensor 71403e rotates a certain angle from its own installation position, which means that the pull-wire of the pull-wire sensor 71403e needs to be stretched to an initial length L0 in the initial state and wrapped around the outside of the sensor gear ring 71403d. The corresponding initial angle is θ. When the transporter rotator 709 rotates at an inclination angle, the total real-time pull-wire length of the pull-wire sensor 71403e is L Z , then the real-time angle of the sensor ring gear 71403d is:

[0380] α=(L0-L Z ) / k;

[0381] When the transporter rotator 709 rotates counterclockwise at a positive inclination angle, that is, the inner gear ring 71403a rotates counterclockwise along with the transporter rotator 709, the first-stage gear 71403b is engaged with the inner side of the inner gear ring 71403a, so the first-stage gear 71403b also rotates counterclockwise, the rotating shaft 71403c is fixedly connected to the first-stage gear 71403b, and the second-stage gear 71403f is fixedly connected to the rotating shaft 71403c, so the rotating shaft 71403c and the second-stage gear 71403f both move synchronously with the first-stage gear 71403b in the same direction, and also rotate counterclockwise. Figure 21 As shown, the secondary gear 71403f and the sensor gear ring 71403d are also in an internal gear meshing relationship. Therefore, the sensor gear ring 71403d also rotates counterclockwise. As the sensor gear ring 71403d rotates counterclockwise, the wire in the wire sensor 71403e gradually retracts under the elastic force of the internal spring, so that the initial length L0 of the wire between the connection point of the wire sensor 71403e and the sensor gear ring 71403d is ≥ the total real-time wire length L of the wire sensor 71403e. Z , the real-time angle α rotated by the sensor ring gear 71403d is ≥0.

[0382] When the transporter rotor 709 rotates clockwise with a negative inclination, that is, the inner gear ring 71403a rotates clockwise with the transporter rotor 709, the first gear 71403b engages with the inner side of the inner gear ring 71403a, so the rotation direction of the first gear 71403b is also clockwise, the rotating shaft 71403c is fixedly connected to the first gear 71403b, and the second gear 71403f is fixedly connected to the rotating shaft 71403c, so the rotating shaft 71403c and the second gear 71403f are both in the same direction and synchronous motion with the first gear 71403b, and also rotate clockwise. Figure 21 As shown, the secondary gear 71403f and the sensor gear ring 71403d are also in an internal gear meshing relationship. Therefore, the sensor gear ring 71403d also rotates clockwise. As the sensor gear ring 71403d rotates clockwise, the wire in the wire sensor 71403e is gradually stretched by the sensor gear ring 71403d, so that the initial length L0 of the wire between the connection point of the wire sensor 71403e and the sensor gear ring 71403d is ≤ the total real-time wire length L of the wire sensor 71403e Z , the real-time angle α rotated by the sensor gear ring 71403d is ≤ 0. However, the positive or negative value of the real-time angle α rotated by the sensor gear ring 71403d only indicates the tilt rotation direction of the transporter rotor 709.

[0383] Example 6:

[0384] The difference from Example 5 is that the wire pulling sensor 71403e in this embodiment is located below the sensor gear ring 71403d. When the overall gear transmission structure remains unchanged, the rotation direction of the sensor gear ring 71403d is still consistent with the rotation direction of the transporter rotor 709, but the total real-time wire pulling length L of the wire pulling sensor 71403e is Z In contrast to the situation in the first embodiment, the calculation formula for the real-time angle rotated by the sensor gear ring 71403d is α=(L Z -L0) / k.

[0385] Specifically, when the transporter rotator 709 rotates counterclockwise at a positive inclination angle, the wire in the wire sensor 71403e is gradually stretched by the elastic force of the internal spring, so that the initial length L0 of the wire between the connection point of the wire sensor 71403e and the sensor gear ring 71403d is less than the total real-time wire length L of the wire sensor 71403e. Z , the real-time angle α rotated by the sensor ring gear 71403d is ≥0.

[0386] When the transporter rotator 709 rotates clockwise at a negative angle, the wire in the wire sensor 71403e gradually retracts under the elastic force of the internal spring, so that the initial length L0 of the wire between the connection point of the wire sensor 71403e and the sensor gear ring 71403d is greater than the total real-time wire length L of the wire sensor 71403e. Z , the real-time angle α rotated by the sensor ring gear 71403d is ≤0.

[0387] Furthermore, the transmission ratio of the gear train consisting of the inner ring gear 71403a, the primary gear 71403b, the secondary gear 71403f and the sensor ring gear 71403d is i. Then, the actual rotation angle of the drill pipe transporter 8 calculated by the sensor ring gear 71403d is:

[0388] β=iα。

[0389] According to the gear train structure, the expression of the transmission ratio i is:

[0390] i=(Z2 / Z1)*(Z4 / Z3), where Z1 is the number of teeth of the inner ring gear 71403a, Z2 is the number of teeth of the first-stage gear 71403b, Z3 is the number of teeth of the second-stage gear 71403f, and Z4 is the number of teeth of the sensor ring gear 71403d. Assume that the gear transmission structure of this embodiment is a transmission chain of inner ring gear 71403a (120 teeth) → primary gear 71403b (20 teeth) → secondary gear 71403f (10 teeth) → sensor ring gear 71403d (300 teeth), which converts the 360° rotation of the transporter rotator 709 into a 72° rotation of the sensor ring gear 71403d (transmission ratio 5:1). Compared with the case where the transmission ratio is 1, the rotation angle of the sensor ring gear 71403d is reduced by 5 times. On this basis, even if the drill pipe transporter 8 is rotated to the extreme position, the length conversion of the wire sensor 71403e will not be very large. It is only necessary to calculate the length change of the wire sensor 71403e to effectively calculate the actual inclination degree of the transporter rotator 709.

[0391] Furthermore, the gear train consisting of the inner ring gear 71403a, the primary gear 71403b, the secondary gear 71403f, and the sensor ring gear 71403d has a transmission ratio of i ≥ 1. When the transmission ratio i ≥ 1, the rotation angle of the sensor ring gear 71403d is mechanically reduced, significantly reducing the displacement of the cable sensor 71403e, thereby increasing the flexibility of the installation location of the cable sensor 71403e and the design of related structural components.

[0392] In addition, the present invention also provides a control method for a rack and drill rod transporter rotation positioning sensor system, which uses the rack and drill rod transporter rotation positioning sensor system in the above embodiment and includes the following steps:

[0393] S1, the transporter rotator 709 rotates to set the inclination angle;

[0394] S2. The inclination angle of the transporter rotator 709 is transmitted to the sensor ring gear 71403d through the primary gear 71403b and the secondary gear 71403f on the rotating shaft 71403c, and the cable of the cable sensor 71403e is driven to extend and retract.

[0395] S3. Calculate the rotation angle and direction of the sensor gear ring 71403d based on the actual extension length of the wire of the wire sensor 71403e. When the wire is extended, the sensor outputs a positive increment (+ΔL), corresponding to clockwise rotation; when the wire is retracted, the sensor outputs a negative increment (-ΔL), corresponding to counterclockwise rotation.

[0396] When the wire sensor 71403e is located below the horizontal line of the sensor gear ring 71403d in Example 2, when the wire is extended, the sensor outputs a positive increment (+ΔL), corresponding to counterclockwise rotation; when the wire is retracted, the sensor outputs a negative increment (-ΔL), corresponding to clockwise rotation.

[0397] S4. Calculate the inclination angle of the transporter rotor based on the transmission ratio of the gear train consisting of the inner ring gear 71403a, the primary gear 71403b, the secondary gear 71403f, and the sensor ring gear 71403d. Furthermore, based on Specific Example 1, this embodiment optimizes the initial state and design of some components of the rack position sensor 71401 to accommodate different operating conditions.

[0398] Rack position sensor 71401:

[0399] Similar to Example 1, the difference in radius between the positive and negative angle zones of the zone plate is adjusted to twice the sensing distance of the first sensor, further improving discrimination accuracy. The radius of the positive angle zone is smaller than that of the negative angle zone. The first sensor is a laser sensor, and its installation position remains unchanged.

[0400] The structures of the synchronization sensor 71402, the transporter level sensor 71404, the inclination rotator, the location axis, the drill pipe transporter and the frame are the same as those in Example 1, but the worm gear reducer of the transporter rotator 709 has a self-locking function to avoid sliding after the inclination adjustment.

[0401] On this basis, this embodiment further provides a method for determining the inclination state of a rack and a drill rod transporter, so as to keep the drill rod transporter and the rack at the same inclination state or determine the subsequent rotation direction of the drill rod transporter. The specific steps are as follows:

[0402] Horizontal to positive tilt adjustment:

[0403] 1. Initial State: Transporter level sensor 71404 is on, and both the frame 11 and the drill pipe transporter 8 are horizontal. At this point, the negative dip area of the position plate is initially aligned with the first sensor, and the frame position sensor is on; the synchronization sensor is also on.

[0404] 2. Frame rotation: The inclination rotator drives the frame to rotate in the positive inclination direction to the set angle A (for example, A = 20°). After the rotation begins, the synchronization sensor is disconnected and the transporter level sensor 71404 is disconnected.

[0405] 3. Signal judgment: After the frame rotates, the positive tilt angle area is located within the sensing range of the first sensor. Because the radius difference exceeds the sensing range, the frame position sensor is disconnected, indicating a positive tilt angle working condition.

[0406] 4. Drill rod transporter synchronization: After the frame rotates into place, the transporter rotator drives the drill rod transporter to rotate to 20° until the synchronization sensor is connected and the inclination angle of the drill rod transporter is consistent with that of the frame.

[0407] Horizontal to negative tilt adjustment:

[0408] 1. Initial state: The rack and drill pipe transporter are both in horizontal position, the rack position sensor is turned on, and the synchronization sensor is turned on.

[0409] 2. Frame rotation: The inclination rotator drives the frame to rotate in the negative inclination direction to the set angle B (for example, B = -15°). After the rotation starts, the synchronization sensor is disconnected.

[0410] 3. Signal judgment: The frame rotates so that the negative inclination area is aligned with the first sensor, and the frame position sensor remains connected, indicating a negative inclination working condition.

[0411] 4. Synchronization of drill rod transporter: After the rack is rotated into place, the drill rod transporter rotates to -15° until the synchronization sensor is connected and the inclination angle of the drill rod transporter is consistent with that of the rack.

[0412] Return to horizontal position:

[0413] The process for returning to a horizontal position from a positive or negative inclination angle is the reverse of the above adjustment. For example, to return to a horizontal position from a positive inclination angle of 20°: first, the drill pipe transporter is rotated back to a horizontal position, the synchronous sensor is disconnected, and the transporter horizontal sensor 71404 is connected. The frame is then rotated back to a horizontal position, the synchronous sensor is connected, and the frame position sensor returns to its initial connected or disconnected state.

[0414] The above two embodiments achieve accurate adjustment of the drill rod transporter's inclination and precise identification of the rack's inclination state through the transporter inclination sensor and the rack position sensor, so that the rack and the drill rod transporter maintain the same inclination state, which is suitable for a variety of drill rod transportation scenarios.

[0415] In another embodiment, the first sensor may also be a photoelectric sensor; similarly, the first sensor may also be arranged in the positive tilt angle zone, adjacent to the junction of the positive tilt angle zone and the negative tilt angle zone, or directly arranged at the junction of the positive tilt angle zone and the negative tilt angle zone.

[0416] The present invention transmits the rotation process and rotation inclination of the transporter rotator 709 located inside the drilling rig to the sensor ring gear 71403d located outside the drilling rig by setting a gear transmission structure, and the actual rotation direction and rotation angle of the sensor ring gear 71403d will directly act on the length change of the pull wire of the pull wire sensor 71403e, that is, the envelope angle of the pull wire to the sensor ring gear 71403d. Finally, the rotation process and rotation inclination of the transporter rotator 709 located inside the drilling rig are reversed according to the transmission ratio of the gear structure, and the displacement sensor is used to monitor the inclination change process of the drill rod transporter 8, and length / angle conversion is performed, thereby improving the comprehensiveness of monitoring the automatic conveying process of the drill rod.

[0417] In addition, the present invention can also set the transmission ratio of the gear transmission structure so that the output angle range of the sensor ring gear 71403d is smaller than the inclination change angle range of the transporter rotor 709, thereby improving the flexibility of the installation position of the wire drawing sensor 71403e and the design of related structural parts in the present invention.

[0418] Example 7:

[0419] This embodiment describes the specific application of the drill rod conveying sensor group in the drill rod conveying system based on the embodiment 5. Figure 23 The axonometric view of the automatic drilling rig shown in detail illustrates the process of conveying the drill rods from the drill rod box 5 to the frame 11 and the process of recovering the drill rods from the frame to the drill rod box.

[0420] 1. The process of transporting drill rods from the drill rod box to the rack

[0421] Initial state: There are drill rods to be transported in the drill rod box, there are no drill rods in the auxiliary manipulator 6 and the drill rod transporter 8, the detection sensor 611 and the judgment sensor 807 signals are disconnected; the main manipulator 9 is in the ready position (initial position, ready to grab the drill rod in the drill rod transporter 8), and the rotation sensor 904 signal is disconnected.

[0422] Step 1: Grab the Drill Pipe

[0423] The auxiliary manipulator 6 approaches the drill rod from the drill rod box, the clamping claws clamp the drill rod, the trigger column 61103 is squeezed, and the detection sensor 611 signal is connected, indicating that the auxiliary manipulator 6 has grasped the drill rod.

[0424] Step 2: Transfer to the Drill Pipe Transporter

[0425] The auxiliary manipulator 6 places the drill rod into the drill rod transporter 8, the gripper is released, and the detection sensor 611 signal is disconnected. At the same time, the drill rod presses the signal post 809, and the sensor body 807 signal is connected, indicating that the drill rod has entered the drill rod transporter 8.

[0426] Step 3: Main robot grasps

[0427] The main manipulator 9 grabs the drill rod from the drill rod transporter 8. After the drill rod leaves, the signal post 809 is reset, and it is determined that the signal of the sensor body 807 is disconnected.

[0428] Step 4: Transport to the rack

[0429] The main manipulator 9 rotates toward the rack 11, and the rotation sensor 904 detects the trigger ring 90403. The signal changes in sequence to "off-short on-off-long on-off", indicating that the main manipulator 9 completes the rotation and sends the drill rod into the rack.

[0430] 2. The recovery process of drill rods from the rack to the drill rod box

[0431] Initial state: there is recovery space in the drill rod box, there are no drill rods in the auxiliary manipulator 6 and the drill rod transporter 8, the detection sensor 611 and the judgment sensor 807 signals are disconnected; the main manipulator 9 is located in the frame, and the rotation sensor 904 signal is disconnected.

[0432] Step 1: Main robot recovery

[0433] The main manipulator 9 rotates from the frame to the drill pipe transporter 8, and the signal of the rotation sensor 904 changes to "off-long on-off-short on-off", indicating that the rotation is completed.

[0434] Step 2: Place on the drill pipe transporter

[0435] The main manipulator 9 places the drill rod into the drill rod transporter 8, the signal post 809 is pressed, and the signal of the sensor 807 is connected.

[0436] Step 3: Secondary manipulator grasps

[0437] The auxiliary manipulator 6 grabs the drill rod from the drill rod transporter 8, the trigger column 61103 is squeezed, the detection sensor 611 signal is connected, and after the drill rod is removed, the judgment sensor 807 signal is disconnected.

[0438] Step 4: Put the drill box back

[0439] The auxiliary manipulator 6 puts the drill rod back into the drill rod box, the gripper is released, the signal of the detection sensor 611 is disconnected, and the recovery is completed.

[0440] Through the above process, this embodiment demonstrates how the drill rod conveying sensor group can realize the fully automated conveying and recovery of drill rods in an automatic drilling rig, thereby ensuring the efficiency and reliability of the operation.

[0441] Furthermore, when the main manipulator 9 rotates toward the frame 11, it can first rotate in the first arc segment, and the rotation sensor body 904 first connects the signal and then disconnects it. The matching relationship between the trigger ring 90403 and the rotation sensor body 904 stays at the gap 90403b between the two arc segments, and the signal changes to "off-short on-off", thereby causing the main manipulator 9 to pause rotating. While making room for the drill rod transporter to rotate, it also waits for the power head 10 and the clamp 12 in the frame to perform corresponding operations.

[0442] In another embodiment, the arc length of the first arc segment can also be set to be greater than the arc length of the second arc segment, so that a signal change process of "off-long on-off-short on-off" is formed during the rotation of the main manipulator 9 from the drill rod transporter to the frame.

[0443] Example 8:

[0444] This embodiment describes the application of the drill rod conveying sensor group and the rotation positioning sensor group 714 in the specific drilling conditions of the drill rod conveying system based on the embodiment 5. Figure 23 The axonometric view of the automatic drilling rig shown in detail illustrates the process of conveying the drill rods from the drill rod box 5 to the frame 11 and the process of recovering the drill rods from the frame to the drill rod box.

[0445] (1) Rod feeding condition (the process of conveying drill rods from the drill rod box to the rack)

[0446] 1) Initial state: Assume that the inclination angle of the frame 11 and the main manipulator 9 is α (when the frame inclination angle is positive, the frame position sensor signal is connected; when the frame inclination angle is negative, the frame position sensor signal is disconnected); the drill rod transporter is in a horizontal position, the transporter horizontal sensor is connected, and the synchronization sensor is disconnected; there is no drill rod in the drill rod transporter, and the sensor is judged to be disconnected; the main manipulator rotation joint is in the state of completing the rotation of the first arc segment, and the rotation sensor body detects the gap between the two arc segments; the auxiliary manipulator does not grab the drill rod, and the detection sensor is disconnected; the drilling rig is drilling.

[0447] 2) The auxiliary manipulator grabs the drill rod: the auxiliary manipulator clamps the selected drill rod under the control of the system, and the detection sensor 611 contacts the drill rod and sends a signal.

[0448] 3) The drill rod transporter clamps the drill rod: the auxiliary manipulator puts the drill rod into the drill rod transporter, and the transporter determines that the sensor 807 is connected and outputs a signal.

[0449] 4) The auxiliary manipulator releases: The auxiliary manipulator releases the drill rod, the detection sensor 611 is disconnected, and no longer outputs a signal. The auxiliary manipulator returns to the initial state and prepares to grab the next drill rod.

[0450] 5) Rotation of the drill rod transporter: The transporter rotates from the horizontal position to the direction of the inclination angle α, and the transporter horizontal sensor 71404 disconnects the signal; until the inclination angle is the same as the frame, the synchronization sensor 71402 connects the signal; during the rotation of the drill rod transporter, the drill rod transporter inclination sensor 71403 measures the angle in real time.

[0451] 6) The main manipulator rotates in the reverse direction (counterclockwise): The main manipulator rotates toward the drill pipe transporter, and the signal of the rotation sensor 904 is "off-short-off".

[0452] 7) The main manipulator clamps the drill rod: The main manipulator clamps the drill rod in the drill rod transporter, and the drill rod transporter is released.

[0453] 8) The first arc segment of the main manipulator rotates: the main manipulator rotates clockwise ( Figure 23 ) rotates, the rotation sensor body 904 is first connected to the signal and then disconnected, and the signal of the judgment sensor 807 is disconnected, and the main manipulator makes room for the rotation of the drill pipe transporter.

[0454] 9) Main manipulator waits: waits for the current drill rod to complete drilling.

[0455] 10) Drill pipe transporter level: The drill pipe transporter returns to the horizontal position, and the transporter level sensor 71404 signal is connected; during the rotation of the drill pipe transporter, the transporter inclination sensor 71403 measures the angle in real time.

[0456] 11) Disconnect the drill rod in the hole: After completing the drilling of the current drill rod, the power head disconnects from the drill rod in the hole and retreats to a position suitable for installing the drill rod.

[0457] 12) The main manipulator rotates in the second arc segment: The main manipulator performs the second segment rotation, sends the drill rod into the frame, and is clamped by the clamper or power head. The rotation sensor body 904 first connects the signal and then disconnects it.

[0458] 13) Main manipulator releases: the main manipulator releases the drill rod; during the process of the main manipulator transferring the drill rod from the drill rod transferor to the rack, the complete signal of the rotation sensor body 904 changes to “break—short—break—long—break”.

[0459] 14) Drill rod connection: The power head and the clamp work together to complete the drill rod connection and continue drilling.

[0460] (2) Rod withdrawal condition (drill rod recovery process from the rack to the drill rod box)

[0461] 1) Initial state: Assume that the inclination angle of the frame and the main manipulator is α (when the frame inclination angle is positive, the frame position sensor signal is connected; when the frame inclination angle is negative, the frame position sensor signal is disconnected); the transporter is in a horizontal position, the transporter horizontal sensor is connected, the synchronization sensor is disconnected, there is no drill rod in the transporter, and the sensor is judged to be disconnected; the main manipulator's rotation joint is in the state of completing the first arc rotation; the auxiliary manipulator does not grab the drill rod, and the detection sensor is disconnected; the drilling rig has just completed drilling the last drill rod.

[0462] 2) Power head retreat: the power head drags the drill rod in the hole backward;

[0463] 3) Main manipulator waits: waits for the current drill pipe to be broken out;

[0464] 4) Rotation of the drill pipe transporter: The transporter rotates in the direction of the inclination angle α, and the transporter horizontal sensor 71404 disconnects the signal; until the inclination angle is the same as the frame, the synchronization sensor 71402 connects the signal; during the rotation of the drill pipe transporter, the transporter inclination sensor 71403 measures the angle in real time.

[0465] 5) Drill pipe shackle: The power head and the clamp cooperate to complete the drill pipe shackle (disconnection from the drill pipe in the hole).

[0466] 6) Second stage rotation of the main manipulator: The main manipulator performs the second stage rotation, the rotation sensor 904 first connects the signal and then disconnects it, and the gripper of the main manipulator reaches the position where it can clamp the detachable drill rod in the frame.

[0467] 7) Main manipulator clamping: The main manipulator clamps the drill rod, and the clamp or power head is completely disconnected from the drill rod to be disassembled.

[0468] 8) The main manipulator rotates in the opposite direction: The main manipulator rotates in the opposite direction to place the drill pipe into the transporter. The signal of the rotation sensor 904 is "break - long - break - short - break".

[0469] 9) Drill rod transporter clamping: When the drill rod is placed in the drill rod transporter, the sensor 807 is judged to output a signal, and the drill rod transporter clamps the drill rod.

[0470] 10) Main manipulator releases: The main manipulator releases the drill rod.

[0471] 11) The first arc segment of the main manipulator rotates: the main manipulator rotates clockwise ( Figure 23 ) rotates, the rotation sensor 904 is first connected to the signal and then disconnected, and the signal of the rotation sensor 904 is "off-short-off", making room for the rotation of the drill pipe transporter.

[0472] 12) Drill pipe transporter level: The drill pipe transporter returns to the horizontal position, and the transporter level sensor 71404 signal is connected; during the rotation of the drill pipe transporter, the transporter inclination sensor 71403 measures the angle in real time.

[0473] 13) The auxiliary manipulator grabs the drill rod: The auxiliary manipulator grabs the drill rod in the transporter and detects that the sensor 611 sends a signal; the drill rod is taken out of the transporter and it is determined that the sensor 807 is disconnected.

[0474] 14) The auxiliary manipulator puts the drill rod back: The auxiliary manipulator puts the drill rod back into the drill rod box, and the detection sensor 611 disconnects the signal.

[0475] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention and are not limiting. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solutions of the present invention can be modified or replaced by equivalents without departing from the purpose and scope of the technical solutions, which should all be included in the scope of the claims of the present invention.

Claims

1. A drill rod conveying system suitable for full-section drilling, characterized in that: It includes a main manipulator, an auxiliary manipulator, a transfer mechanism, a drill pipe conveying sensor group, and a rotation positioning sensor group; The main manipulator includes a main rotation joint, a main telescopic joint, and a main gripper assembly; The main rotating joint includes a rotating seat and a rotating driver, wherein the rotating driver is arranged at one end of the rotating seat and drives the main rotating shaft to rotate, and the main rotating shaft passes through the rotating seat and is connected to the main telescopic joint; The main jaw assembly is connected to the bottom of the main telescopic joint, and drives the main jaw assembly to extend and retract in the vertical direction through the main telescopic joint, and the main jaw assembly is used for grasping; The auxiliary manipulator is arranged on the auxiliary slide rail of the drill rod box and includes a lifting joint, an auxiliary rotation joint, an auxiliary telescopic joint and an auxiliary clamping claw connected in sequence, the lifting joint is connected to the auxiliary slide rail at one end away from the auxiliary clamping claw, and the auxiliary telescopic joint and the auxiliary clamping claw are arranged toward the inside of the drill rod box; The auxiliary rotation joint is connected to the lifting joint via a crossbeam; the auxiliary rotation joint comprises an auxiliary rotation shaft rotatably arranged in the inner cavity of the crossbeam, the inner cavity of the crossbeam is provided with an arc groove, and a protrusion is provided on the outer side of the auxiliary rotation shaft. When the auxiliary rotation shaft rotates, the protrusion slides circumferentially in the arc groove to limit the rotation of the auxiliary rotation shaft; The transfer mechanism includes a drill rod transfer device, a frame, and a rotary platform, wherein the drill rod transfer device is arranged between the frame and the rotary platform through an asynchronous rotation device; The drill rod transporter includes a base plate, a supporting block, a pressure plate, and an axial pressing block; the supporting block is arranged on the base plate for supporting the drill rod; the axial pressing blocks are arranged on the base plate and are located on both sides of the supporting block; the upper portion of the axial pressing block is rotatably connected to a pressure plate, and the pressure plate is located above the supporting block; the axial pressing block presses and fixes the drill rod axially; the axial pressing block includes at least one slider slidably arranged on the base plate; the pressure plate presses the drill rod onto the supporting block; The drill rod conveying sensor group includes a detection sensor, a judgment sensor, and a rotation sensor. The detection sensor is configured to detect whether there is a drill rod in the auxiliary manipulator; the judgment sensor is configured to detect whether there is a drill rod in the drill rod transporter; and the rotation sensor is configured to detect the rotation position and direction of the main manipulator. The rotation positioning sensor group includes a transporter inclination sensor, a rack position sensor and a synchronization sensor. The transporter inclination sensor is configured to detect the rotation angle of the drill rod transporter; the rack position sensor is configured to determine whether the rack is in a positive inclination condition or a negative inclination condition; the synchronization sensor is configured to determine whether the rack and the drill rod transporter are at the same inclination angle.

2. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The asynchronous rotation device includes a lifting sleeve, a transporter rotator, an inclination rotator, a rotation transition plate and a frame connecting plate. The frame and the rotating platform are connected in sequence through the inclination rotator, the frame connecting plate, the rotation transition plate and the lifting sleeve; wherein the inclination rotator is rotationally connected to the frame, and the drill rod transporter is rotationally connected to the rotation transition plate through the transporter rotator, and the inclination angle between the frame and the drill rod transporter is asynchronously rotated and adjusted by the inclination rotator and the transporter rotator.

3. The drill rod conveying system suitable for full-section drilling according to claim 2, characterized in that: The lifting sleeve includes a cavity enclosed by two side plates and a top sealing plate, sleeves are provided at both ends of the side plates, and a connecting tube is provided on the side plates; two lifting columns are relatively arranged on the rotating platform, and a lifting cylinder is provided between the two lifting columns; the lifting cylinder of the rotating platform is installed in the cavity, and under the drive of the lifting cylinder, the lifting sleeve moves up and down along the lifting column; the sleeve is mounted on the lifting column of the rotating platform, and the rotating transition plate is installed on the connecting tube.

4. The drill rod conveying system suitable for full-section drilling according to claim 3, characterized in that: A flange is provided on the connecting cylinder; the rotary transition plate is disc-shaped and includes three sets of flanges arranged side by side, the inner flange is connected to the flange of the connecting cylinder, and the two sets of outer flanges are respectively used to install the transporter rotator and the frame connecting plate.

5. The drill rod conveying system suitable for full-section drilling according to claim 4, characterized in that: The transporter rotator includes a first fixed ring and a first rotating ring arranged thereon, the first fixed ring is connected to the flange of the rotating transition plate; the first rotating ring is fixedly connected to the first outer shell, the drill rod transporter is installed on the first outer shell, and the inclination angle of the drill rod transporter is adjusted by rotating the first rotating ring.

6. The drill rod conveying system suitable for full-section drilling according to claim 4, characterized in that: The frame connecting plate is disc-shaped and includes two groups of flanges connected to each other. The two groups of flanges are respectively connected to the flange of the rotary transition plate and the inclination rotator.

7. The drill rod conveying system suitable for full-section drilling according to claim 3, characterized in that: The inclination rotator includes a second fixed ring and a second rotating ring arranged thereon, the second fixed ring is connected to the flange of the frame connecting plate; the second rotating ring is fixedly connected to the second outer shell, the frame is mounted on the second outer shell, and the inclination angle of the frame is adjusted by rotating the second rotating ring.

8. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: A sliding oil cylinder is provided at the bottom of the base plate, and the sliding oil cylinder is connected to the sliding block to drive the sliding block to slide along the length direction of the base plate.

9. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The axial pressing block is rotatably connected to the pressing plate. When the drill rod transporter is in a state of waiting for loading or removing the drill rod, the pressing plate is rotated and opened upward to facilitate loading or removing the drill rod.

10. The drill rod conveying system suitable for full-section drilling according to any one of claims 1 or 9, characterized in that: The pressing plate is further provided with a pressing oil cylinder for driving the rotation of the pressing plate; the pressing oil cylinder is located outside the two axial pressing blocks and is hingedly connected to the upper portion of the axial pressing blocks.

11. The drill rod conveying system suitable for full-section drilling according to claim 10, characterized in that: There are at least two support blocks, and the upper portion of each support block is provided with a groove matching the outer diameter of the drill rod.

12. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The main telescopic joint includes a vertically arranged main outer cylinder, a main inner cylinder and a main telescopic cylinder. The main outer cylinder is detachably connected to the main rotating shaft via a flange. The main inner cylinder is slidably connected to the inside of the main outer cylinder. The main clamping jaw assembly is connected to the bottom of the main inner cylinder; the main telescopic cylinder is fixed to the top of the main outer cylinder, and the main inner cylinder is connected to the output end of the main telescopic cylinder.

13. The drill rod conveying system suitable for full-section drilling according to claim 1 or 12, characterized in that: The main clamping jaw assembly includes a main clamping jaw and a main clamping oil cylinder. The main clamping oil cylinder is fixed to the lower part of the main inner tube. The main clamping jaw is fixed on the main clamping oil cylinder and is clamped or released under the drive of the main clamping oil cylinder.

14. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: It also includes a sliding joint, which includes a fixed seat, a connecting arm and a sliding cylinder. The fixed seat is connected to the frame and is provided with a horizontally arranged main slide rail. The bottom of the connecting arm is provided with a sliding groove, and the sliding groove cooperates with the main slide rail. The rotating seat in the main rotating joint is fixedly connected to the connecting arm. One end of the sliding oil cylinder is fixed on the fixing seat, and the other end is connected to the connecting arm, so that the connecting arm slides along the track.

15. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: One end of the lifting joint away from the slide rail is connected to the lower side of the crossbeam.

16. The drill rod conveying system suitable for full-section drilling according to claim 15, characterized in that: The lifting joint includes a lifting outer cylinder and a lifting oil cylinder connected to the lifting outer cylinder. The lifting outer cylinder is installed in a sleeve manner with the lifting inner cylinder below the crossbeam. The lifting outer cylinder and the lifting inner cylinder form a lifting pair to realize lifting movement. The lifting oil cylinder drives the lifting pair to perform lifting movement.

17. The drill rod conveying system suitable for full-section drilling according to claim 15, characterized in that: The secondary rotation joint further includes a secondary rotation driver connected to the crossbeam, and the secondary rotation driver is connected to the secondary rotation shaft to drive the rotation of the secondary rotation shaft.

18. The drill rod conveying system suitable for full-section drilling according to claim 17, characterized in that: One end of the secondary rotating shaft away from the crossbeam is connected to the secondary telescopic joint. The secondary rotating shaft rotates to drive the secondary telescopic joint and the secondary clamp to swing.

19. The drill rod conveying system suitable for full-section drilling according to claim 17, characterized in that: The secondary telescopic joint comprises a secondary outer tube and a secondary inner tube, wherein the secondary inner tube is inserted into the secondary outer tube to form a telescopic pair for telescopic movement; and a secondary telescopic oil cylinder connected to the secondary rotating shaft, wherein the secondary telescopic oil cylinder is connected to the secondary outer cylinder to drive the telescopic pair to perform telescopic movement.

20. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: A side of the auxiliary clamping jaw close to the telescopic unit is connected to an auxiliary clamping oil cylinder, and the auxiliary clamping jaw is clamped or released under the drive of the auxiliary clamping oil cylinder.

21. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The detection sensor includes: a detection sensor mounting base radially fixed to one side of the secondary clamping jaw; a detection sensor spring disposed in the detection sensor mounting seat; a trigger post movably mounted in the detection sensor mounting seat via the detection sensor spring; A detection sensor body is configured to detect displacement of the trigger column due to the presence of the drill pipe.

22. The drill rod conveying system suitable for full-section drilling according to claim 21, characterized in that: When the auxiliary clamp approaches the drill rod, the trigger column is pressed upward by the drill rod, and the detection sensor body generates a connection signal indicating the presence of the drill rod.

23. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The judgment sensor includes: a judgment sensor mounting base fixed below the base plate; A judgment sensor body fixed in the judgment sensor mounting seat; a judgment sensor spring disposed in the judgment sensor mounting seat; A signal-emitting post movably mounted in the judgment sensor mounting seat via the judgment sensor spring; When the drill rod is placed in the drill rod transporter, the signal transmitting column is pressed downward by the drill rod, and the judgment sensor body generates a connection signal indicating the presence of the drill rod.

24. The drill rod conveying system suitable for full-section drilling according to claim 23, characterized in that: The top end of the signal post passes through the bottom plate of the drill rod transporter, and when there is no drill rod in the drill rod transporter, the top end of the signal post exceeds the lowest point of the drill rod transporter where the drill rod is placed.

25. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The rotation sensor comprises: A rotation sensor mounting base fixed on the rotating base; A rotation sensor body fixed in the rotation sensor mounting base; A trigger ring is fixed on a rotating member rotatably connected to the rotating base and rotates with the rotating member. The trigger ring is configured to interact with the rotation sensor body during the rotation of the main manipulator, and the trigger ring has two arc segments with different arc lengths, and a gap is provided between the two arc segments to generate a signal for detecting the rotation position and direction of the main manipulator.

26. The drill rod conveying system suitable for full-section drilling according to claim 25, characterized in that: The two arc segments and the gap are arranged so that during the rotation of the main manipulator, the rotation sensor body detects the two arc segments and the gap in sequence, and indicates the rotation direction and position of the main manipulator according to the duration and on-off of the rotation sensor body signal.

27. The drill rod conveying system suitable for full-section drilling according to claim 1, characterized in that: The rack position sensor includes a position plate and a first sensor, wherein the position plate is connected to the rack and rotates with the rack; The position plate is divided into a positive tilt zone and a negative tilt zone, and the positive tilt zone and the negative tilt zone both cover a circumferential angle of 180°. The difference between the radius of the positive tilt zone and the radius of the negative tilt zone is not less than 1 times the sensing distance of the first sensor, and then the on-off of the first sensor is used to determine whether the rack is in a positive tilt working condition or a negative tilt working condition; The first sensor is arranged outside the zone plate and adjacent to the junction of the positive inclination zone and the negative inclination zone.

28. The drill rod conveying system suitable for full-section drilling according to claim 27, characterized in that: The first sensor is a Hall proximity switch, a photoelectric sensor or a laser sensor.

29. The drill rod conveying system suitable for full-section drilling according to claim 28, characterized in that: The synchronization sensor includes a first trigger block and a second sensor; The first trigger block is mounted on the transporter rotator and rotates with the drill pipe transporter, and the second sensor is mounted on a side of the frame facing the transporter rotator; When the frame and the drill pipe transporter are at the same inclination angle, the first trigger block and the second sensor are aligned, and the second sensor outputs a signal; When the frame and the drill rod transporter rotate relative to each other, the second sensor is disconnected and no signal is output.

30. The drill rod conveying system suitable for full-section drilling according to claim 29, characterized in that: It also includes a lifting sleeve, a transporter rotator, an inclination rotator, a zone shaft and a frame; The lifting sleeve serves as a connecting piece between the transporter rotator and the tilting rotator; The transporter rotator and the inclination rotator are both mounted on the lifting sleeve, the drill pipe transporter is mounted on the transporter rotator, and the frame is mounted on the inclination rotator, so that the transporter rotator and the inclination rotator adjust the inclination angle of the drill pipe transporter and the inclination angle of the frame respectively; Both ends of the location shaft are connected to the frame and the location plate, so that the location plate rotates along with the frame.

31. The drill rod conveying system suitable for full-section drilling according to claim 30, characterized in that: The location axis is a hollow circular tube with connecting flanges at both ends, one end of which is fixedly connected to the frame, and the other end of which is fixedly connected to the location plate.

32. The drill rod conveying system suitable for full-section drilling according to claim 31, characterized in that: Also included is a transporter level sensor for determining whether the drill pipe transporter is in a horizontal position; When the drill rod transporter is in a horizontal position, the transporter level sensor outputs a signal, judging that the drill rod transporter is in a horizontal position; When the drill rod transporter rotates and is not in a horizontal position, the transporter level sensor is disconnected and no signal is output, thereby determining that the drill rod transporter is not in a horizontal position.

33. The drill rod conveying system suitable for full-section drilling according to claim 32, characterized in that: The transporter level sensor includes a second trigger block and a third sensor; The second trigger block is installed on the drill rod transporter and rotates with the drill rod transporter, and the third sensor is installed on the side of the lifting sleeve facing the transporter rotator; When the drill pipe transporter is in a horizontal position, the third sensor outputs a signal; When the drill pipe transporter rotates and is not in a horizontal position, the third sensor is disconnected and no signal is output.

34. The drill rod conveying system suitable for full-face drilling according to claim 33, characterized in that: The transporter inclination sensor includes an inner gear ring, a rotating shaft, a sensor gear ring and a wire sensor; The inner gear ring is fixedly connected to the rotating ring of the transporter rotator connected to the drill pipe transporter, so as to drive the inner gear ring to rotate through the transporter rotator; A primary gear and a secondary gear are respectively provided at both ends of the rotating shaft, the primary gear is meshed with the inner gear ring, the secondary gear is meshed with the sensor gear ring, and the sensor gear ring is rotatably arranged on the outside of the lifting sleeve for mounting the transporter rotator; The draw wire sensor is arranged on the outside of the lifting sleeve and is connected to the sensor gear ring through a draw wire, so as to calculate the rotation angle of the drill pipe transporter according to the draw wire length of the draw wire sensor.

35. The drill rod conveying system suitable for full-section drilling according to claim 34, characterized in that: The tilt adjustment range of the transporter rotator is 360°; The transporter rotator is divided into positive tilt rotation and negative tilt rotation, and the angles corresponding to the positive tilt rotation and negative tilt rotation are 0 to 180 degrees and 0 to -180 degrees respectively.

36. The drill rod conveying system suitable for full-section drilling according to claim 35, characterized in that: The rotation angle of the connection point between the pull wire in the pull wire sensor and the sensor gear ring is smaller than the inclination adjustment range of the transporter rotor.

37. The drill rod conveying system suitable for full-section drilling according to claim 36, characterized in that: When the transporter revolver is in the initial position, the initial length of the cable between the cable sensor and the sensor gear ring connection point is L0, and the initial angle is θ. Then, the cable length corresponding to a unit angle satisfies the following conditions: k=L0 / θ.

38. The drill rod conveying system suitable for full-face drilling according to claim 37, characterized in that: An initial angle θ of the wire between the wire sensor and the sensor gear ring connection point is less than 180°.

39. The drill rod conveying system suitable for full-section drilling according to claim 38, characterized in that: When the angle of the transporter rotor rotates, the total length of the wire pulling sensor is L Z , then the real-time angle of the sensor ring gear is: α=(L0-L Z ) / k; When the transporter rotor rotates counterclockwise with a positive inclination angle, L0≥L Z ,α≥0; When the transporter rotor rotates clockwise with a negative angle, L0≤L Z , α≤0.

40. The drill rod conveying system suitable for full-face drilling according to claim 39, characterized in that: The transmission ratio of the gear system composed of the inner ring gear, the first gear, the second gear and the sensor ring gear is i, and the actual rotation angle of the transporter calculated by the sensor ring gear is: β＝iα。 41. The drill rod conveying system suitable for full-section drilling according to claim 40, characterized in that: The transmission ratio of the gear train composed of the inner gear ring, the first-stage gear, the second-stage gear and the sensor gear ring is i≥1.

42. A control method for a drill rod conveying system suitable for full-section drilling, characterized by: The drill rod conveying system for full-face drilling according to claim 41 comprises the following steps: The process of transporting drill rods from the drill rod box to the rack: Initial state: There are drill rods to be transported in the drill rod box, there are no drill rods in the auxiliary manipulator and the drill rod transporter, the detection sensor and judgment sensor signals are disconnected; the main manipulator is in the ready position, and the rotation sensor signal is disconnected; Step 1: Grab the Drill Pipe The auxiliary manipulator approaches the drill rod from the drill rod box, the auxiliary gripper clamps the drill rod, and the detection sensor signal is connected, indicating that the auxiliary manipulator has grasped the drill rod; Step 2: Transfer to the Drill Pipe Transporter The auxiliary manipulator puts the drill rod into the drill rod transporter, the auxiliary gripper is released, and the detection sensor signal is disconnected. At the same time, the judgment sensor signal is connected, indicating that the drill rod has entered the drill rod transporter; Step 3: Main robot grasps The main manipulator grabs the drill rod from the drill rod transporter. After the drill rod leaves, it determines that the sensor signal is disconnected; Step 4: Transport to the rack The main manipulator rotates toward the frame, and the rotation sensor generates a signal change indicating that the rotation is completed, indicating that the main manipulator has completed the rotation and sent the drill rod into the frame; The process of recovering drill pipe from the rack to the drill pipe box: Initial state: There is recovery space in the drill rod box, there are no drill rods in the auxiliary manipulator and the drill rod transporter, the detection sensor and judgment sensor signals are disconnected, the main manipulator is inside the rack, and the rotation sensor signal is disconnected; Step 1: Main robot recovery The main manipulator rotates from the frame toward the drill pipe transporter, and the rotation sensor generates a signal change indicating that the rotation is completed; Step 2: Place on the drill pipe transporter The main manipulator places the drill rod into the drill rod transporter and determines that the sensor signal is connected; Step 3: Secondary manipulator grasps The auxiliary manipulator grabs the drill rod from the drill rod transporter and detects that the sensor signal is connected. After the drill rod is removed, it determines that the sensor signal is disconnected; Step 4: Put the drill box back The auxiliary manipulator puts the drill rod back into the drill rod box and detects that the sensor signal is disconnected, completing the recovery.

43. The control method according to claim 42, characterized in that: The invention also includes rotating the drill pipe transporter to a specified inclination angle: S1, the transponder rotator rotates to set the inclination angle; S2, through the first and second gears on the rotating shaft, the inclination angle of the transporter rotator is transmitted to the sensor ring gear, and drives the cable of the cable sensor to retract; S3. Calculate the rotation angle and rotation direction of the sensor gear ring according to the actual extension length of the wire of the wire sensor; S4. Calculate the degree of inclination of the transporter rotor according to the transmission ratio of the gear train consisting of the inner ring gear, the first gear, the second gear, and the sensor ring gear.

44. The control method according to claim 42, characterized in that: It also includes the determination and synchronization of the inclination states of the frame and the drill pipe transporter, including the following steps: Horizontal to positive tilt adjustment: a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are both in a horizontal position, the rack position sensor is off, and the synchronization sensor is on; b. The frame rotates in the positive inclination direction to the set angle A, A>0°, and after the rotation begins, the synchronization sensor is disconnected and the transporter level sensor is disconnected; c. The rack position sensor receives a signal to determine that the rack is in a positive tilt state; d. After the rack is rotated into place, the drill pipe transporter rotates in the positive inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill pipe transporter and the rack are at the same inclination angle and are in the positive inclination state; Horizontal to negative tilt adjustment: a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are both in a horizontal position, the rack position sensor is off, and the synchronization sensor is on; b. The frame rotates in the negative inclination direction to the set angle α, α < 0°. After the rotation begins, the synchronization sensor is disconnected and the transporter level sensor is disconnected; c. The rack position sensor signal remains disconnected, indicating that the rack is in a negative tilt state; d. After the rack is rotated into place, the drill rod transporter rotates in the negative inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill rod transporter and the rack are at the same inclination angle and are in a negative inclination state.

45. The control method according to claim 42, characterized in that: It also includes the determination and synchronization of the inclination states of the frame and the drill pipe transporter, including the following steps: Horizontal to positive tilt adjustment: a. Initial state: The transporter level sensor is on, the rack and drill pipe transporter are in a horizontal position, and the rack position sensor is on; b. The frame rotates in the positive inclination direction to the set angle A, A>0°, and the synchronous sensor is disconnected after the rotation starts; c. The rack position sensor is disconnected, and it is determined that the rack is in a positive tilt state; d. After the rack is rotated into place, the drill pipe transporter rotates in the positive inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill pipe transporter and the rack are at the same inclination angle and are in the positive inclination state; Horizontal to negative tilt adjustment: a. Initial state: The rack and drill pipe transporter are both in horizontal position, the rack position sensor is on, and the synchronization sensor is on; b. The frame rotates in the negative inclination direction to the set angle B, B < 0°, and after the rotation begins, the synchronous sensor is disconnected and the transporter level sensor is disconnected; c. The rack position sensor signal remains connected, judging that the rack is in a negative tilt state; d. After the rack is rotated into place, the drill rod transporter rotates in the negative inclination direction until the synchronization sensor is connected to the signal again. At this time, the drill rod transporter and the rack are at the same inclination angle and are in a negative inclination state.

46. The control method according to any one of claims 44 and 45, characterized in that: It also includes the adjustment process from a positive or negative tilt angle back to a horizontal position, which is the opposite of the adjustment process from horizontal to a positive or negative tilt angle.

47. The control method according to claim 46, characterized in that: The rotation sensor comprises: A rotation sensor mounting base fixed on the rotation base of the main manipulator; A rotation sensor body fixed in the rotation sensor mounting base; a trigger ring fixed to a rotating member of the main manipulator and rotating with the rotating member, the trigger ring being configured to interact with the rotation sensor body during rotation of the main manipulator, and the trigger ring having two arc segments of different arc lengths with a gap between the two arc segments to generate a signal for detecting the rotational position and direction of the main manipulator; When the drill rod transporter is in an inclined state, after the main manipulator clamps the drill rod or places the drill rod in the drill rod transporter, the main manipulator rotates toward the frame through an arc segment of the trigger ring, and the rotation sensor body detects the gap between the two arc segments in the trigger ring. The signal of the rotation sensor body is disconnected, thereby causing the main manipulator to stay between the drill rod transporter and the frame, leaving space for the drill rod transporter to return to a horizontal position.

Images