Direct drive drill pipe conveyance system and control method

Abstract

The present application relates to the field of automatic rack, disclose a straight drilling rod conveying system and control method, including the drilling rod box for storing drilling rod and the transfer manipulator for changing the drilling rod axis to be perpendicular to the rack rotation plane, the drilling rod transfer manipulator is slidably arranged on the side of the drilling rod box and is provided with a drilling rod positioning sensor, a lifting positioning sensor and a telescopic positioning sensor, through the special setting of the transfer manipulator, the existence of the drilling rod is detected by the drilling rod positioning sensor, and the height of the drilling rod pile is measured, at the same time, the position of the clamp jaw is comprehensively judged by the lifting positioning sensor and the telescopic positioning sensor, so that the processor can judge the displacement required by the clamp jaw to be extended, so that the clamping process is more accurate, and the probability of collision of the drilling rod is reduced.

Description

Technical Field

[0001] The present invention relates to the field of automatic drilling rigs, and in particular to a direct-rotation drill rod conveying system and a control method. Background Art

[0002] Existing automated mining drill rigs often utilize a drill rod conveying system (CN110952972B) that combines dual manipulators with a drill rod box. This system increases onboard drill rod storage capacity, enabling the rig to operate continuously for extended periods. However, the existing drill rod transfer mechanism involves numerous movements and a complex process, resulting in low drill rod conveying and overall construction efficiency. Furthermore, the relative positioning of the main manipulator, the frame, and the transporter can interfere with the crawler vehicle or transporter when transporting drill rods at significant negative inclination angles, preventing automatic drill rod delivery.

[0003] To solve the above problems, CN219299240U discloses a drill rod loading and unloading device, in which the drill rod loading and unloading mechanism and the drill rod conveying mechanism are respectively connected to the two sides of the mounting seat. The conveying mechanism transfers the drill rod perpendicular to the axis of the drill rod of the rack to the loading and unloading mechanism through the through hole on the mounting seat. The loading and unloading mechanism clamps the drill rod and rotates until the drill rod coincides with the axis of the rack, thereby completing the drill rod conveying.

[0004] However, the above technical solution still has the problem of connecting the drill rod from the storage box to the conveying mechanism. Summary of the Invention

[0005] The present invention aims to provide a straight-rotation drill rod conveying system and control method to convey the drill rod in a direction perpendicular to the rotation plane of the frame, thereby solving the problem of connecting the drill rod from the storage box to the conveying mechanism.

[0006] To achieve the above-mentioned purpose, the present invention adopts the following technical solution: a direct-rotation drill rod conveying system, including a drill rod box for storing drill rods, a transfer manipulator for transforming the axis of the drill rod to be perpendicular to the rotation plane of the frame and transporting it out of the drill rod box, and a drill rod transmission and positioning assembly for controlling the transfer manipulator.

[0007] The beneficial effects of this program are:

[0008] This solution transports the drill rod out of the drill rod box perpendicular to the frame, so that the drill rod and the frame are docked. During this process, there is no need to flip the drill rod, nor is there a transfer trough to transfer the drill rod again. This greatly simplifies the conveying route of the clamping unit, improves the conveying efficiency of the clamping unit, reduces the height requirement during drilling rig operation, and makes the frame suitable for operations in narrow lanes.

[0009] Furthermore, the transfer manipulator includes a control unit, a sliding assembly, a lifting joint, and a telescopic joint. The sliding assembly, lifting joint, telescopic joint, and rotary joint are all controlled by the control unit. The lifting joint is slidably mounted on the frame via the sliding assembly. The telescopic joint is fixedly connected to the lifting joint and slidably mounted on the plane of the frame's rotation axis. The free end of the telescopic joint is rotatably mounted with a rotary clamping assembly that can rotate the drill rod 90 degrees. Controlling the sliding assembly, telescopic assembly, lifting joint, and rotary joint through the control unit allows each component to form a unified whole, which helps reduce the difficulty of control.

[0010] Furthermore, the drill rod transmission and positioning assembly includes a telescopic positioning sensor for detecting the displacement of the telescopic joint, a lifting positioning sensor for detecting the displacement of the lifting joint, a drill rod positioning sensor for detecting the presence of the drill rod, and a processor for receiving and processing measurement information from the telescopic positioning sensor, the lifting positioning sensor, and the drill rod positioning sensor. The telescopic positioning sensor is fixed to the telescopic joint and can measure the displacement and displacement change information of the telescopic joint. The lifting positioning sensor is fixed to the lifting joint and can measure the displacement and displacement change information of the lifting joint. The drill rod positioning sensor is fixed to the lifting joint or the clamping jaw and can detect the presence of the drill rod. The processor is electrically connected to the lifting positioning sensor, the drill rod positioning sensor, the telescopic joint, and the rotary clamping assembly and can control the sliding assembly, the lifting joint, the telescopic joint, and the rotary clamping assembly based on the measurement information received from the lifting positioning sensor and the drill rod positioning sensor. Using sensors to detect the displacement of each component makes control more precise, simplifies the control process, and improves control accuracy.

[0011] Furthermore, the telescopic joint includes a telescopic outer cylinder, a telescopic inner cylinder and a telescopic drive member. The telescopic inner cylinder is slidably arranged on the plane where the frame rotation axis is located through a sliding assembly. The telescopic inner cylinder is slidably arranged in the telescopic outer cylinder and fixedly connected to one end of the rotation joint. One end of the telescopic drive member is fixedly connected to the telescopic outer cylinder, and the other end is fixedly connected to the telescopic inner cylinder. The drill rod transmission positioning assembly also includes a valve seat. The telescopic drive member is electrically connected to the processor through a control member. The telescopic positioning sensor is fixed on the side wall of the telescopic inner cylinder or the telescopic outer cylinder. A connecting member is fixed between the lifting inner cylinder and the telescopic outer cylinder. One end of the connecting member is fixedly connected to the lifting inner cylinder, and the other end is fixedly connected to the telescopic outer cylinder. The lifting positioning sensor includes a lifting positioning sensor transmitting and receiving end. The lifting positioning sensor is fixedly arranged on the connecting member or the lifting inner cylinder for detecting displacement information and displacement change information between the connecting member and the lifting outer cylinder.

[0012] Furthermore, the lifting joint includes a lifting outer cylinder and a lifting inner cylinder. The lifting outer cylinder is slidably set on the side wall of the drill rod box through a sliding assembly and can reciprocate on the side wall of the drill rod box under the action of the sliding assembly. The lifting inner cylinder is slidably set in the lifting inner cylinder and is fixedly connected to the telescopic inner cylinder through the free end. A lifting drive component electrically connected to the processor through a control component is provided between the lifting outer cylinder and the lifting inner cylinder. One end of the lifting drive component is fixedly connected to the lifting outer cylinder, and the other end is fixedly connected to the lifting inner cylinder. The transmitting and receiving ends of the lifting positioning sensor are fixed on the side wall of the lifting inner cylinder or the lifting outer cylinder.

[0013] Furthermore, the sliding assembly includes a sliding rail and a sliding seat. The sliding rail is fixedly connected to the side wall of the drill rod box. The sliding seat is slidably set on the sliding rail. A rack is fixedly set on the slide rail. A driving gear is rotatably set on the sliding seat. The driving gear is engaged with the rack. A sliding driving member is fixed on the fixed seat. The sliding driving member is electrically connected to the processor through the control member. The sliding driving member is fixedly set on the sliding seat and fixedly connected to the driving gear through the output shaft.

[0014] Furthermore, the drill rod transmission positioning assembly also includes a column selection sensor, which is electrically connected to the processor through a control component. The column selection sensor is fixedly arranged on the sliding seat and can measure the sliding displacement information of the sliding seat; the processor has built-in sliding displacement value interval information and controls the sliding of the sliding seat based on the sliding displacement value interval information, so that the sliding displacement information measured by the column selection sensor is within the value range.

[0015] Furthermore, the rotating clamping assembly includes a rotating joint and a clamping jaw, and the rotating joint and the clamping jaw are electrically connected to the processor through a controller via a control component. One end of the rotating joint is fixedly connected to the telescopic joint, and the other end is fixedly connected to the clamping jaw and can drive the clamping jaw to rotate under the control of the processor and switch between clamping conditions and transportation conditions.

[0016] The control method of the straight-rotation drill pipe conveying system includes the following steps: S1 positioning: the height of the clamping jaw is determined by the displacement combination of the telescopic positioning sensor and the lifting positioning sensor, and the processor obtains the displacement information a of the initial condition of the lifting positioning sensor, the displacement information b of the initial condition of the telescopic positioning sensor, the height information H1 of the clamping jaw from the bottom of the drill pipe box, and the drill pipe height information H2, and the height information H1 of the clamping jaw from the bottom of the drill pipe box is measured based on the drill pipe clamping center line; S2 clamping, the clamping jaw moves downward until the drill pipe sensor is triggered and obtains the change displacement information a1 of the lifting positioning sensor and the change displacement information b1 of the telescopic positioning sensor during the clamping jaw moving downward; S2 obtains the clamping jaw displacement information, the clamping jaw displacement information includes the descending displacement information δ1-2 and the upward displacement δ2-1, and the descending displacement information δ1-2 and the upward displacement δ2-1 are both obtained through the change displacement information a1 of the lifting positioning sensor and the change displacement information b1 of the lifting positioning sensor, wherein δ1-2 =H1-H2=a1+b1, δ2-1=H-H2+d=a1+b1+d; S3 clamping, the S3 clamping rotation step includes descending clamping and clamping lifting, the descending clamping is: under the monitoring of the lifting positioning sensor and the telescopic positioning sensor, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move downward by a displacement of δ1-2, and then clamps the drill rod through the clamping claw; the clamping lifting is: while the clamping claw keeps clamping the drill rod and under the monitoring of the lifting positioning sensor and the telescopic positioning sensor, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move upward by a displacement of δ2-1; S4 transportation, after the lifting is completed, the rotating joint rotates 90° to enter the transportation condition, and then the sliding assembly drives the clamping claw to translate to transport the drill rod clamped by the clamping claw in a direction perpendicular to the rotation plane of the frame.

[0017] Furthermore, it also includes S0 selection, S0 selection: S0 selection includes S01 reset, S02 translation detection and S03 drill rod detection, wherein S01 reset includes the following steps: the clamp is loosened, the rotary joint rotates to the clamping condition, the telescopic joint is fully retracted, and the lifting joint is raised to an appropriate height so that the lower end of the clamp does not interfere with the drill rod storage space of the drill rod box, and the processor receives the change displacement information h1 and h2 measured by the drill rod positioning sensor, and records the difference h between the change displacement information h1 and h2; S02 translation detection, the clamp translates under the action of the sliding assembly, and when the clamp reaches the specified position, the selection sensor sends a signal to the control component through the processor, and the control component controls the sliding drive component to stop working.

[0018] In combination with the above technical features, the present invention also includes the following technical effects:

[0019] 1. Drill rods are directly transported out of the drill rod box in a direction perpendicular to the rotation plane of the frame, eliminating the need to flip or re-transfer the drill rods as in traditional methods, thereby greatly simplifying the transportation route of the clamping unit;

[0020] 2. The simplified conveying path reduces unnecessary operating steps and improves the speed and efficiency of the entire conveying process;

[0021] 3. Since no additional space is required for the turning action, the overall height requirement of the drilling rig is reduced, making the system more suitable for use in environments with limited space (such as narrow roadways);

[0022] 4. All components of the transfer robot (sliding assembly, lifting joint, telescopic joint, and rotary clamping assembly) are centrally managed by a single control unit, which not only reduces control difficulty but also improves the system's response speed and positioning accuracy. Furthermore, the drill rod transfer positioning assembly utilizes multiple sensors (such as telescopic positioning sensors, lifting positioning sensors, and drill rod positioning sensors) to monitor the position of each component in real time. The processor performs data processing and feedback control, ensuring that each action is accurately executed. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 A schematic diagram of the assembly relationship between the embodiment of the present invention and the rack;

[0024] Figure 2 This is a three-dimensional diagram of an embodiment of the present invention after removing the positioning control mechanism;

[0025] Figure 3 A three-dimensional diagram of an embodiment of the present invention;

[0026] Figure 4 Schematic diagram of the detection state of the positioning control mechanism of the present invention;

[0027] Figure 5 Schematic diagram of the height of the transfer robot's gripper. DETAILED DESCRIPTION

[0028] The following is further described in detail through specific implementation methods:

[0029] The figure marks in the drawings of the specification include: drill rod box 1, base plate 11, partition 12, vertical plate 13, transfer robot 2, slide rail 21, sliding seat 22, lifting outer cylinder 231, lifting inner cylinder 232, connecting piece 233, telescopic outer cylinder 24, rotary clamping assembly 25, lifting positioning sensor 261, baffle 262, telescopic positioning sensor 263, drill rod positioning sensor 264, column selection sensor 265, and frame 3.

[0030] Example

[0031] The embodiment is basically as shown in the attached Figure 1-5 As shown, Figure 1-5 The straight-rotation drill rod conveying system shown includes a drill rod box 1 and a transfer manipulator 2.

[0032] The drill rod box 1 includes a bottom plate 11, side plates and vertical plates 13. The side plates and vertical plates 13 are connected to the bottom plate 11 by bolts to form a box body with an open top. A number of partitions 12 are welded or bolted to the opposite sides of the vertical plates 13. Drill rod storage space is formed between adjacent partitions 12. The width of the drill rod storage space is adapted to the drill rods. When arranged, the drill rod box 1 is fixed horizontally to the vehicle body on the side of the frame 3 so that the length direction of the drill rod storage space is parallel to the rotation plane of the frame 3.

[0033] The transfer robot 2 includes a sliding assembly, a lifting joint, a telescopic joint, a rotating clamping assembly 25 and a drill rod transmission positioning control assembly.

[0034] The sliding assembly includes a slide rail 21 and a slide seat 22. The slide rail 21 is fixedly connected to the vertical plate 13 by bolts. The slide seat 22 is slidably set on the slide rail 21. A rack is provided on the slide rail 21. A sliding drive member is fixed on the slide seat 22. A drive gear is keyed to the output shaft of the sliding drive member, and the drive gear is engaged with the rack. In this embodiment, the sliding drive member is a hydraulic motor. When in use, the rotation of the hydraulic motor drives the drive gear to rotate, thereby driving the slide seat 22 to slide on the slide rail 21.

[0035] The lifting joint includes a lifting outer cylinder 231 and a lifting inner cylinder 232. Figure 2 As shown, the lifting outer cylinder 231 is fixedly connected to the sliding seat 22 by bolts, the lifting inner cylinder 232 is slidably arranged in the lifting outer cylinder 231, and the top bolt of the lifting inner cylinder 232 is connected with a connecting piece 233. A lifting driving piece is arranged inside the lifting outer cylinder 231. In this embodiment, the lifting driving piece is an oil cylinder, one end of the oil cylinder is fixedly connected to the lifting outer cylinder 231, and the other end is fixedly connected to the lifting inner cylinder 232, so that the lifting inner cylinder 232 is driven to slide in the lifting outer cylinder 231 through the extension and contraction of the lifting driving piece, thereby driving the connecting piece 233 to move up and down.

[0036] The telescopic joint includes a telescopic outer cylinder 24 and a telescopic inner cylinder. The telescopic outer cylinder 24 is bolted to the connecting piece 233. The telescopic inner cylinder is slidably arranged in the telescopic outer cylinder 24. The rotary clamping assembly 25 is flange-connected to the lower end of the telescopic inner cylinder. A telescopic driving member is provided between the telescopic outer cylinder 24 and the telescopic inner cylinder. One end of the telescopic driving member is fixedly connected to the telescopic outer cylinder 24, and the other end is fixedly connected to the telescopic inner cylinder. Thus, the telescopic inner cylinder is driven to slide in the telescopic outer cylinder 24 through the extension and contraction of the telescopic driving member, thereby driving the rotary clamping assembly 25 to extend and retract up and down.

[0037] The rotating clamping assembly 25 includes a clamping jaw and a rotating joint. The fixed rotating joint includes a first rotating body, a second rotating body and a rotating driving member. The first rotating body is connected to the lower end flange of the telescopic inner cylinder. The second rotating body is rotatably arranged at the lower end of the first rotating body. The rotating driving member is fixed inside the first rotating body and is connected to the second rotating body through a gear set. The clamping jaw includes a fixed jaw, a movable jaw and a clamping driving member. The fixed jaw is connected to the lower end flange of the second rotating body. The movable jaw is hinged on the fixed jaw. One end of the clamping driving member is hinged to the fixed jaw and the other end is hinged to the movable jaw, thereby driving the clamping jaw to rotate through the rotating driving member, and at the same time driving the movable jaw to rotate through the clamping driving member to complete the clamping work. The rotating joint is arranged between the fixed jaw and the telescopic inner cylinder and is used to control the rotation of the clamping assembly 25. In this embodiment, the rotating joint is a hydraulic motor.

[0038] The drill rod transmission positioning control component includes a controller and a drill rod transmission positioning component. The control component is used to control the working conditions of the sliding drive component, the telescopic drive component, the lifting drive component, the telescopic drive component and the rotary joint. In this embodiment, the control component is a valve seat. During control, the valve seat is used to control the hydraulic pressure of the sliding drive component, the telescopic drive component, the lifting drive component, the telescopic drive component and the rotary joint to complete the corresponding control action.

[0039] The drill rod transmission positioning assembly includes a processor, a lifting positioning sensor 261, a telescopic positioning sensor 263, a drill rod positioning sensor 264 and a sliding positioning unit. The processor and the lifting positioning sensor 261, the telescopic positioning sensor 263, the drill rod positioning sensor 264, the column selection sensor 265 and the control component are electrically connected and have built-in partition 12 height information H1 and column selection sensor 265 displacement interval information. The lifting positioning sensor 261, the telescopic positioning sensor 263, the drill rod positioning sensor 264 and the column selection sensor 265 can be a combination of one or more displacement sensors such as a pull-wire displacement sensor and a magnetostrictive displacement sensor. In this embodiment, the lifting positioning sensor 261, the telescopic positioning sensor 263, the drill rod positioning sensor 264 and the column selection sensor 265 are all pull-wire displacement sensors, such as Figure 3 As shown, the lifting positioning sensor 261 is attached to the side wall of the lifting outer cylinder 231 and connected to the top of the telescopic inner cylinder through a pull wire. When in use, the displacement between the telescopic inner cylinder and the telescopic outer cylinder is determined by the extended length of the pull wire.

[0040] The telescopic positioning sensor is attached to the side wall of the telescopic outer cylinder 24 and fixed to the side wall of the telescopic inner cylinder through a wire measurement, so that the relative displacement between the telescopic outer cylinder 24 and the telescopic inner cylinder is determined by the change in the wire length.

[0041] The drill rod positioning sensor 264 is a proximity switch, which is bonded to the clamping jaws. Figure 5As shown, the sensing height of the drill rod positioning sensor 264 is h. When the clamp moves down to the height h between the drill rod positioning sensor 264 and the drill rod, the drill rod positioning sensor 264 sends a signal to the processor.

[0042] The sliding positioning unit includes a baffle 262 and a column selection sensor 265. Figure 3 As shown, the baffle 262 is fixed to one end of the slide rail 21 by bolts, and a protective part is provided on the upper end of the baffle 262. The bottom height of the protective part is higher than the upper edge of the column selection sensor 265 and the length of the protective part is greater than the column selection sensor 265. The column selection sensor 265 is fixedly provided on the slide and can measure the displacement information of the slide. In this embodiment, the column selection sensor 265 is also a pull-wire displacement sensor, which is fixedly connected to the baffle by a pull-wire to determine the position of the slide by changing the length of the pull-wire.

[0043] A control method for a straight-rotation drill pipe conveying system includes the following steps:

[0044] S0 selection: S0 selection includes S01 reset, S02 translation detection and S03 drill rod detection, where S01 reset includes the following steps: the clamping jaws are released, the rotary joints rotate to the clamping working condition, the telescopic joints are fully retracted, and the lifting joints are raised to an appropriate height so that the lower end of the clamping jaws does not interfere with the drill rod storage space of the drill rod box 1; S02 translation detection, the clamping jaws translate under the action of the sliding assembly. When the clamping jaws reach the specified position, the selection sensor sends a signal to the control component through the processor, and the control component controls the sliding drive component to stop working, at which point S0 selection ends and enters S1 positioning;

[0045] S1 positioning: The height of the gripper is determined by the displacement combination of the telescopic positioning sensor 263 and the lifting positioning sensor 261. The processor obtains the displacement information a of the initial condition of the lifting positioning sensor 261, the displacement information b of the initial condition of the telescopic positioning sensor 263, the height information H1 of the gripper from the bottom of the drill rod box 1, and the drill rod height information H2. The height information H1 of the gripper from the bottom of the drill rod box 1 is measured based on the drill rod clamping centerline. S2 clamping: The gripper moves downward until the drill rod sensor is triggered and obtains the displacement information a1 of the lifting positioning sensor and the displacement information b1 of the telescopic positioning sensor during the gripper's downward movement.

[0046] S2 obtains the displacement information of the gripper, which includes the descending displacement information δ1-2 and the ascending displacement δ2-1. The descending displacement information δ1-2 and the ascending displacement δ2-1 are both obtained by the change displacement information a1 and the change displacement information b1 of the lifting and positioning sensor 261, wherein δ1-2 = H1-H2 = a1+b1, and δ2-1 = H-H2+d = a1+b1+d;

[0047] S3 clamping, the S3 clamping rotation step includes descending clamping and clamping lifting. The descending clamping is: under the monitoring of the lifting positioning sensor and the telescopic positioning sensor 263, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move downward by a displacement of δ1-2, and then clamps the drill rod through the clamping claw; the clamping lifting is: under the monitoring of the lifting positioning sensor and the telescopic positioning sensor 263, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move upward by a displacement of δ2-1;

[0048] S4 transport: After the lifting is completed, the rotary joint rotates 90° to enter the transport state, and then the sliding assembly drives the clamping jaw to translate to transport the drill rod clamped by the clamping jaw in a direction perpendicular to the rotation plane of the frame 3.

[0049] The above is only an embodiment of the present invention, and common knowledge such as the specific technical solutions and / or characteristics in the solution are not described in detail here. It should be pointed out that the technical means for solving the problems in the above-mentioned embodiments of the present invention can be used in combination to solve multiple technical problems at the same time. For those skilled in the art, without departing from the technical solution of the present invention, several variations and improvements can be made, which should also be regarded as the scope of protection of the present invention. These will not affect the effect of the implementation of the present invention and the practicality of the patent. The scope of protection required by this application shall be based on the content of its claims, and the specific implementation methods and other records in the specification can be used to interpret the content of the claims.

Claims

1. Direct-rotation drill pipe conveying system, characterized by: It includes a drill rod box for storing drill rods, a transfer manipulator for converting the axis of the drill rods to be perpendicular to the rotation plane of the frame and transporting them out of the drill rod box, and a drill rod transmission and positioning assembly for controlling the transfer manipulator; The transfer manipulator includes a control member, a sliding assembly, a lifting joint and a telescopic joint. The sliding assembly, the lifting joint and the telescopic joint are all controlled by the control member. The lifting joint is slidably arranged on the frame through the sliding assembly. The telescopic joint is fixedly connected to the lifting joint and is slidably arranged on the plane where the rotation axis of the frame is located. The free end of the telescopic joint is rotatably provided with a rotating clamping assembly that can rotate the clamped drill rod 90°. The drill rod transmission positioning assembly includes a telescopic positioning sensor for detecting the displacement information of the telescopic joint, a lifting positioning sensor for detecting the displacement information of the lifting joint, a drill rod positioning sensor for detecting the existence information of the drill rod, and a processor for receiving measurement information of the telescopic positioning sensor, the lifting positioning sensor and the drill rod positioning sensor and processing the received information. The telescopic positioning sensor is fixed on the telescopic joint and can measure the displacement information and displacement change information of the telescopic joint. The lifting positioning sensor is fixed on the lifting joint and can measure the displacement information and displacement change information of the lifting joint. The drill rod positioning sensor is fixed on the lifting joint or the clamp and can detect the existence information of the drill rod; the processor is electrically connected to the lifting positioning sensor, the drill rod positioning sensor, the telescopic joint and the rotary clamping assembly and can control the sliding assembly, the lifting joint, the telescopic joint and the rotary clamping assembly based on the measurement information received from the lifting positioning sensor and the drill rod positioning sensor.

2. The direct-rotation drill pipe conveying system according to claim 1, characterized in that: The telescopic joint includes a telescopic outer cylinder, a telescopic inner cylinder and a telescopic drive member. The telescopic inner cylinder is slidably arranged on the plane where the frame rotation axis is located through a sliding assembly. The telescopic inner cylinder is slidably arranged in the telescopic outer cylinder and fixedly connected to one end of the rotation joint. One end of the telescopic drive member is fixedly connected to the telescopic outer cylinder, and the other end is fixedly connected to the telescopic inner cylinder. The drill rod transmission positioning assembly also includes a valve seat. The telescopic drive member is electrically connected to the processor through a control member. The telescopic positioning sensor is fixed on the side wall of the telescopic inner cylinder or the telescopic outer cylinder. A connecting member is fixed between the lifting inner cylinder and the telescopic outer cylinder. One end of the connecting member is fixedly connected to the lifting inner cylinder, and the other end is fixedly connected to the telescopic outer cylinder. The lifting positioning sensor includes a lifting positioning sensor transmitting and receiving end. The lifting positioning sensor is fixedly arranged on the connecting member or the lifting inner cylinder for detecting displacement information and displacement change information between the connecting member and the lifting outer cylinder.

3. The direct-rotation drill pipe conveying system according to claim 2, characterized in that: The lifting joint includes a lifting outer cylinder and a lifting inner cylinder. The lifting outer cylinder is slidably arranged on the side wall of the drill rod box through a sliding assembly and can reciprocate on the side wall of the drill rod box under the action of the sliding assembly. The lifting inner cylinder is slidably arranged in the lifting inner cylinder and is fixedly connected to the telescopic inner cylinder through the free end. A lifting drive component electrically connected to the processor through a control component is provided between the lifting outer cylinder and the lifting inner cylinder. One end of the lifting drive component is fixedly connected to the lifting outer cylinder, and the other end is fixedly connected to the lifting inner cylinder. The transmitting and receiving ends of the lifting positioning sensor are fixed on the side wall of the lifting inner cylinder or the lifting outer cylinder.

4. The direct-rotation drill pipe conveying system according to claim 3, characterized in that: The sliding assembly includes a sliding rail and a sliding seat. The sliding rail is fixedly connected to the side wall of the drill rod box. The sliding seat is slidably set on the sliding rail. A rack is fixedly set on the slide rail. A driving gear is rotatably set on the sliding seat. The driving gear is engaged with the rack. A sliding driving member is fixed on the fixed seat. The sliding driving member is electrically connected to the processor through a control member. The sliding driving member is fixedly set on the sliding seat and fixedly connected to the driving gear through an output shaft.

5. The direct-rotation drill pipe conveying system according to claim 4, characterized in that: The drill pipe transmission and positioning assembly also includes a column selection sensor, which is electrically connected to the processor through a control component. The column selection sensor is fixedly arranged on the sliding seat and can measure the sliding displacement information of the sliding seat. The processor has built-in sliding displacement value interval information and controls the sliding of the sliding seat according to the sliding displacement value interval information, so that the sliding displacement information measured by the selected sensor is within the value interval.

6. The direct-rotation drill pipe conveying system according to claim 5, characterized in that: The rotary clamping assembly includes a rotary joint and a clamping jaw. Both the rotary joint and the clamping jaw are electrically connected to the processor through a control component. One end of the rotary joint is fixedly connected to the telescopic joint, and the other end is fixedly connected to the clamping jaw. Under the control of the processor, the clamping jaw can be driven to rotate and switch between clamping and transporting conditions.

7. The control method of the direct-rotation drill pipe conveying system according to claim 6, characterized in that: The method includes the following steps: S1 positioning: the height of the clamping jaw is determined by the displacement combination of the telescopic positioning sensor and the lifting positioning sensor, and the processor obtains the displacement information a of the initial condition of the lifting positioning sensor, the displacement information b of the initial condition of the telescopic positioning sensor, the height information H1 of the clamping jaw from the bottom of the drill rod box, and the drill rod height information H2, and the height information H1 of the clamping jaw from the bottom of the drill rod box is measured with respect to the drill rod clamping center line; S2 clamping, the clamping jaw moves downward until the drill rod sensor is triggered and obtains the change displacement information a1 of the lifting positioning sensor and the change displacement information b1 of the telescopic positioning sensor during the clamping jaw moving downward; S2 obtains the clamping jaw displacement information, and the clamping jaw displacement information includes the descending displacement information δ1-2 and the upward displacement δ2-1, and the descending displacement information δ1-2 and the upward displacement δ2-1 are both obtained through the change displacement information a1 of the lifting positioning sensor and the change displacement information b1 of the lifting positioning sensor, wherein δ1-2 =H1-H2=a1+b1, δ2-1=H-H2+d=a1+b1+d; S3 clamping, the S3 clamping rotation step includes descending clamping and clamping lifting, the descending clamping is: under the monitoring of the lifting positioning sensor and the telescopic positioning sensor, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move downward by a displacement of δ1-2, and then clamps the drill rod through the clamping claw; the clamping lifting is: while the clamping claw keeps clamping the drill rod and under the monitoring of the lifting positioning sensor and the telescopic positioning sensor, the processor controls the telescopic assembly and the lifting assembly to drive the clamping claw to move upward by a displacement of δ2-1; S4 transportation, after the lifting is completed, the rotating joint rotates 90° to enter the transportation condition, and then the sliding assembly drives the clamping claw to translate to transport the drill rod clamped by the clamping claw in a direction perpendicular to the rotation plane of the frame.

8. The control method of the direct-rotation drill pipe conveying system according to claim 7, characterized in that: It also includes S0 selection, S0 selection: S0 selection includes S01 reset, S02 translation detection and S03 drill rod detection, wherein S01 reset includes the following steps: the clamp is loosened, the rotary joint rotates to the clamping condition, the telescopic joint is fully retracted, and the lifting joint is raised to an appropriate height so that the lower end of the clamp does not interfere with the drill rod storage space of the drill rod box, the processor receives the change displacement information h1 and h2 measured by the drill rod positioning sensor, and records the difference h between the change displacement information h1 and h2; S02 translation detection, the clamp translates under the action of the sliding component, and when the clamp reaches the specified position, the selection sensor sends a signal to the control component through the processor, and the control component controls the sliding drive component to stop working.

Images