Drilling machine core fishing rope control circuit

Abstract

The utility model discloses a kind of drilling machine core fishing rope arranging control circuit, it includes microprocessor and the photoelectric encoder of detection reel corner, the microprocessor is connected with driving module, the driving module is moved along the axial movement of reel by driving stepper motor and drives rope arranging device, to make steel wire rope on reel axial transverse migration realizes rope arranging in turn. This patent fundamentally solves the accurate automation control problem of rope arranging, it can automatically track reel speed change and steel wire rope diameter change, also provides a variety of ways of artificial participation adjustment parameter, greatly improves work efficiency, meets the various operation needs of rope arranging operation.

Description

Technical Field

[0001] This utility model relates to the field of drilling auxiliary technology, specifically to a drilling rig core retrieval rope control circuit. Background Technology

[0002] A winch is a small, lightweight lifting device that uses a drum to wind a steel wire rope or chain to lift or pull heavy objects. Winches can lift vertically, and pull horizontally or at an angle, and are commonly used in geological, oilfield extraction, and construction operations.

[0003] When using a winch, special attention should be paid to ensuring the stability of the winch by properly winding and arranging the wire rope on the drum. For example, 3-4 turns of wire rope must be retained on the drum to prevent the fixed end from loosening. Also, the wire rope should enter the drum perpendicular to the axis in the middle to avoid lateral forces causing equipment deviation. Furthermore, the wire rope should exit from below the drum to reduce friction and extend its service life. The wire rope exit angle is generally recommended to be between 1.5° and 2°, and should not exceed 4°, to avoid uneven arrangement or skipping of the wire rope on the drum.

[0004] The numerous uncertainties at the work site add complexity to the control of wire rope winding and unwinding. Different winch parameters and varying work stages necessitate corrective control of the wire rope's movement speed relative to both ends of the drum to ensure the rope alignment meets operational requirements. On-site operators often rely on the wire rope diameter and visually observed deviations for corrective control. They frequently monitor the winding and unwinding speed and diameter during the process, adjusting the speed using the plus and minus buttons when changes occur or the diameter deviates from the default value. However, relying solely on visual observation of the wire rope's winding and unwinding speed and diameter is not precise enough. This method, which relies on manual judgment and the use of plus and minus buttons, is not only inefficient but also produces poor rope alignment, hindering the stable operation of on-site equipment. Summary of the Invention

[0005] This invention provides a control circuit for rope routing in core retrieval from drilling rigs, which solves the problem of precise automation in rope routing.

[0006] To solve the above-mentioned technical problems, the technical solution of this utility model is as follows: a drilling rig core retrieval rope laying control circuit, which includes a microprocessor and a photoelectric encoder for detecting the drum rotation angle. The microprocessor is communicatively connected to a drive module. The drive module drives a stepper motor to move the rope laying device along the axial direction of the drum, thereby causing the wire rope to move laterally along the axial direction of the drum to achieve sequential rope laying. The microprocessor includes a microprocessor chip of model STM32F103R. The chip is configured with a first set of IO ports as a corner communication port for communicating with the photoelectric encoder, and with a second set of IO ports as a control signal port for communicating with the drive module. The driving module includes an H-bridge circuit and a driver chip of model SS6952T. The driver chip receives level and direction control signals from the microprocessor chip through pins 23, 24, 20, and 21. The driver chip receives PWM control signals from the microprocessor chip through pins 23 and 24. The driver chip drives the stepper motor to rotate forward and backward by controlling the power MOSFETs in the H-bridge circuit to turn on and off through its output pins.

[0007] Furthermore, the photoelectric encoder is an absolute multi-turn encoder, which is equipped with three sets of differential signal terminals for incremental quadrature pulse signals A, B, and Z phases, and also has absolute position signal terminals, time synchronization signal terminals, communication signal terminals, and power control signal terminals. The three sets of differential signal terminals are connected to pins 15, 16, 2, 3, 4, and 27 of the microprocessor chip via peripheral circuits. The absolute position signal terminal is connected to pin 14 of the microprocessor chip via peripheral circuits. The time synchronization signal terminal is connected to pin 23 of the microprocessor chip via peripheral circuits. The communication signal terminal is connected to pin 24 of the microprocessor chip via peripheral circuits. The power control signal terminal is connected to pin 17 of the microprocessor chip via peripheral circuits.

[0008] Furthermore, it also includes a CCD wire diameter measurement sensor. The microprocessor chip is also configured with a first ADC acquisition port to connect to the CCD wire diameter measurement sensor. The detection head of the CCD wire diameter measurement sensor is mounted on the rope arranger and oriented perpendicular to the length direction of the wire rope. The signal processing module output of the CCD wire diameter measurement sensor is connected to the first set of ADC acquisition ports.

[0009] Furthermore, it also includes a CAN communication chip and an RS485 communication chip. The microprocessor chip is also configured with a first communication port, which includes pins 44 and 45 of the CAN communication chip and pins 53, 54 and 58 of the RS485 communication chip.

[0010] Furthermore, it also includes a manual adjustment input module, and the microprocessor chip is also configured with a second ADC acquisition port, the second ADC acquisition port including a ninth pin for receiving the decrement key signal of the manual adjustment input module and a tenth pin for receiving the increment key signal of the manual adjustment input module.

[0011] Furthermore, it also includes limit switch groups at the two extreme positions of the rope laying movement of the rope laying device, and the microprocessor chip is also configured with a third ADC acquisition port, the third ADC acquisition port including a twenty-fifth pin corresponding to the limit signal at the starting extreme position of the rope laying device and a twenty-sixth pin corresponding to the limit signal at the ending extreme position of the rope laying device.

[0012] Compared with the prior art, the beneficial effects of this utility model are as follows: This patent fundamentally solves the problem of precise automated control of rope laying. It can automatically track changes in drum speed and wire rope diameter, and also provides a variety of ways for manual adjustment of parameters, which greatly improves work efficiency and meets the various operational needs of rope laying operations. Attached Figure Description

[0013] Figure 1 This is a circuit structure block diagram of the present invention.

[0014] Figure 2 This is the peripheral circuit of the differential signal terminal of the photoelectric encoder in one embodiment of the present invention.

[0015] Figure 3 This is the peripheral circuit of the time synchronization signal terminal of the photoelectric encoder in one embodiment of the present invention.

[0016] Figure 4 This is the peripheral circuit of the communication signal terminal of the photoelectric encoder in one embodiment of the present invention.

[0017] Figure 5 This is the peripheral circuit of the power control signal terminal of the photoelectric encoder in one embodiment of the present invention.

[0018] Figure 6 This is a pin configuration diagram of the driver chip in one embodiment of the present invention.

[0019] Figure 7 This is a switching circuit for a limit switch group in one embodiment of the present invention.

[0020] Figure 8 This is a pin configuration diagram of a microprocessor chip in one embodiment of the present invention.

[0021] Figure 9 This is a conversion circuit for starting the key input in one embodiment of the present invention. Detailed Implementation

[0022] The specific embodiments of this utility model will be further described below with reference to the accompanying drawings. It should be noted that these descriptions are for the purpose of aiding understanding of this utility model, but do not constitute a limitation thereof. Furthermore, the technical features involved in the various embodiments of this utility model described below can be combined with each other as long as they do not conflict with each other.

[0023] To facilitate understanding of the circuit operation mechanism and the program control logic in the microprocessor, the mechanical structure and motion process upon which the control circuit relies are explained. This solution uses a winch to wind up and unwind the wire rope in the drilling rig core retrieval system. The winch drum's rotation is driven by a high-power servo motor. The drum's rotation speed is affected by the real-time retrieval status and may vary depending on the stage of operation and the target object. To ensure the wire rope is neatly wound sequentially on the drum, a rope guide is needed to synchronously move the wire rope in real-time as its winding position on the drum changes, ensuring that the angle at which the wire rope enters or exits the drum is always perpendicular to the drum's axis. The synchronous translation of the steel wire rope pulled by the rope arranger is usually achieved by the rope arranger sliding on the guide rail and the lead screw driving the rope arranger to move left and right. In existing technology, a motor and reducer are generally used to provide a speed to the lead screw. The transmission ratio of the reducer is adjusted by lever or button to adjust the speed of the lead screw, thereby adjusting the speed of the rope arranger to move left and right. The speed ratio can also be adjusted by a PLC controller. However, the real-time synchronization of adjustment by the reducer and PLC controller is relatively lagging and the accuracy is limited. In the arrangement of ropes with long, thin, and varying diameters, the cumulative error is large, and the tension and uniformity of the rope arrangement are insufficient. For example, a rope arrangement detection component disclosed in the existing patent publication number CN 222799982 U is designed to take into account the rope arrangement error. However, this detection component alarms only after an abnormality occurs, which is relatively passive.

[0024] Therefore, this case employs a microprocessor 1 and a stepper motor 4 to precisely and in real-time control the rope laying process (rope laying in this case includes rope winding and rope unwinding). The solution is as follows: Figure 1 As shown, a core retrieval rope-laying control circuit for drilling rigs includes a microprocessor 1 and a photoelectric encoder 2 for detecting the drum rotation angle. The microprocessor 1 is communicatively connected to a drive module 3. The drive module 3 drives a stepper motor 4 to move the rope arranger along the axial direction of the drum, thereby causing the wire rope to move laterally along the drum's axial direction to achieve sequential rope laying. The drum diameter and wire rope diameter can have initial default values ​​given to the microprocessor 1. The calculation program in the microprocessor 1 calculates the current moving speed of the rope arranger that matches the drum rotation speed based on the current drum rotation speed, drum diameter, and wire rope diameter, obtains the rotation speed of the stepper motor 4, and outputs corresponding pulses at the corresponding frequency.

[0025] For the microprocessor 1, we selected the mature and commonly used STM32F103R microprocessor chip U4. Chip U4 is configured with a first set of I / O ports as the corner communication port for communication with the photoelectric encoder 2, and a second set of I / O ports as the control signal port for communication with the drive module 3. The drive module 3 includes an H-bridge circuit and a drive chip U5 of model SS6952T. The H-bridge circuit is composed of N-type power MOSFETs, which control the on / off switching of the stepper motor 4's operating current. Figure 6 As shown, the driver chip U5 receives the level signals from the microprocessor chip U4 through pins 23 and 24, which are used to configure the current control steps and realize the PWM speed regulation function. The driver chip U5 receives the direction control signals from the microprocessor chip U4 through pins 20 and 21. The driver chip U5 controls the power MOSFETs in the H-bridge circuit to turn on and off through output pins OUTA1 and OUTA2 to drive the stepper motor 4 in forward and reverse directions. The other pins of the driver chip U5, such as MODE1~3 and MD, can be configured according to the chip manual.

[0026] In one embodiment, the photoelectric encoder 2 is an absolute multi-turn encoder, configured with three sets of differential signal terminals DI1~DI6 for incremental quadrature pulse signal A, B, and Z phases, used for incremental quadrature pulse output. The photoelectric encoder 2 also includes an absolute position signal terminal DI0, a time synchronization signal terminal TIM_IN, a communication signal terminal DI_CHARG, and a power control signal terminal AI_PRE. The three sets of differential signal terminals DI1~DI6 are connected to pins 15, 16, 2, 3, 4, and 27 of the microprocessor chip U4 via peripheral circuitry. The peripheral circuitry for each differential signal terminal is identical. Taking differential signal terminal DI1 as an example, it passes through... Figure 2 The peripheral circuit shown is connected to pin 15 of the microprocessor chip U4 after output voltage normalization. The absolute position signal terminal DI0 is connected to pin 14 of the microprocessor chip U4 via a corresponding peripheral circuit. The peripheral circuit for the absolute position signal terminal DI0 is the same as that for the differential signal terminal, and therefore will not be described further. The time synchronization signal terminal TIM_IN is connected to pin 23 of the microprocessor chip U4 via a peripheral circuit. The peripheral circuit for the time synchronization signal terminal TIM_IN is as follows... Figure 3 As shown, the microprocessor chip U4 controls the MOS transistor Q9 to turn on and off at a certain clock frequency, thereby synchronously causing the time synchronization signal terminal TIM_IN of the photoelectric encoder 2 to also receive a pulse voltage at the same clock frequency as the trigger clock. The communication signal terminal DI_CHARG is connected to the twenty-fourth pin of the microprocessor chip U4 via an external circuit, the external circuit of which is as follows: Figure 4As shown, the microprocessor chip U4 controls the MOSFET Q9 to turn on and off, thereby controlling the communication signal terminal DI_CHARG to obtain high and low voltages. The power control signal terminal AI_PRE is connected via... Figure 5 The peripheral circuit shown is connected to the seventeenth pin of the microprocessor chip U4.

[0027] To automatically and promptly detect changes in the diameter of the wire rope, this invention also includes a CCD wire diameter measuring sensor 5. The microprocessor chip U4 is further equipped with a first ADC acquisition port to connect to the CCD wire diameter measuring sensor 5. The detection head of the CCD wire diameter measuring sensor 5 is mounted on the rope arranger and oriented perpendicular to the length direction of the wire rope. The signal processing module output of the CCD wire diameter measuring sensor 5 is connected to the first set of ADC acquisition ports. The CCD wire diameter measuring sensor 5 can automatically measure the diameter of the wire rope being unwound and retracted non-contactly. The wire rope diameter value is input into the program calculation in the microprocessor chip U4 to calculate the matching moving speed of the rope arranger.

[0028] This patent also includes a CAN communication chip U1 and an RS485 communication chip U3. The microprocessor chip U4 is further configured with a first communication port, which includes pins 44 and 45 of the CAN communication chip U1 and pins 53, 54, and 58 of the RS485 communication chip U3. The diameter of the steel wire rope can be calculated by setting the program of the microprocessor chip U4 via the CAN communication chip U1 or the RS485 communication chip U3 through a host computer. Calculation parameters and control parameters can also be set.

[0029] This patent also includes a manual adjustment input module 6, such as an increment / decrement button or joystick, where the increment button signal Throttle_UP is transmitted via... Figure 7 The conversion circuit shown inputs to the microprocessor chip U4; the decrease button signal Throttle_DOWN is also input to the microprocessor chip U4 via the same conversion circuit. The microprocessor chip U4 is configured with a second ADC acquisition port, which includes a ninth pin for receiving the decrease button signal from the manual adjustment input module 6 and a tenth pin for receiving the increase button signal from the manual adjustment input module 6. The manual adjustment input module 6 is used to provide manual adjustment of the rope guide's moving speed in certain situations.

[0030] This solution also includes limit switch groups 7 corresponding to the extreme positions at both ends of the rope-laying movement of the rope arranger. The microprocessor chip U4 is also configured with a third ADC acquisition port, which includes a twenty-fifth pin corresponding to the limit signal at the starting extreme position of the rope arranger and a twenty-sixth pin corresponding to the limit signal at the ending extreme position of the rope arranger. The limit switches are configured as follows: Figure 7The conversion circuit shown processes the switch signal. The processed limit switch signal is input to the microprocessor chip U4, which is used to pause the movement of the rope arranger after the rope is in place to avoid abnormal boundary crossing.

[0031] The STM32F103R microprocessor chip U4 has a sufficient number of input / output pins. Figure 8 In one embodiment, the pin configuration can be adjusted to include a start button input, depending on field requirements. Figure 9 As shown, the automatic rope-laying control of the microprocessor chip U4 used in this case is activated. Indicator lights 8 can also be provided to indicate various states, and a display screen 9 can be used to display the rope-laying parameter status.

[0032] This patent fundamentally solves the problem of precise automated control in rope laying. It can automatically track changes in drum speed and wire rope diameter, and also provides multiple ways for manual adjustment of parameters, greatly improving work efficiency and meeting various operational needs of rope laying operations.

[0033] The embodiments of this utility model have been described in detail above with reference to the accompanying drawings, but this utility model is not limited to the described embodiments. For those skilled in the art, various changes, modifications, substitutions, and variations can be made to these embodiments without departing from the principles and spirit of this utility model, and these variations still fall within the protection scope of this utility model.

Claims

1. A control circuit for core retrieval rope deployment in a drilling rig, characterized in that: It includes a microprocessor (1) and a photoelectric encoder (2) for detecting the rotation angle of the drum. The microprocessor (1) is connected to a drive module (3). The drive module (3) drives a stepper motor (4) to move the rope arranger along the axial direction of the drum, thereby making the wire rope move laterally along the axial direction of the drum to achieve sequential rope arrangement. The microprocessor (1) includes a microprocessor chip (U4) of model STM32F103R. The chip (U4) is configured with a first set of IO ports as a corner communication port for communicating with the photoelectric encoder (2), and with a second set of IO ports as a control signal port for communicating with the drive module (3). The driving module (3) includes an H-bridge circuit and a driving chip (U5) of model SS6952T. The driving chip (U5) receives level and direction control signals from the microprocessor chip (U4) through pins 23, 24, 20, and 21. The driving chip (U5) receives PWM control signals from the microprocessor chip (U4) through pins 23 and 24. The driving chip (U5) drives the stepper motor (4) to rotate forward and backward by controlling the power MOSFETs in the H-bridge circuit to turn on and off through the output pins.

2. The drilling rig core retrieval rope control circuit according to claim 1, characterized in that: The photoelectric encoder (2) is an absolute multi-turn encoder, which is equipped with three sets of differential signal terminals (DI1~DI6) for incremental quadrature pulse signals A, B, and Z phases. It is also equipped with an absolute position signal terminal (DI0), a time synchronization signal terminal (TIM_IN), a communication signal terminal (DI_CHARG), and a power control signal terminal (AI_PRE). The three sets of differential signal terminals (DI1~DI6) are connected to the fifteenth, sixteenth, second, third, fourth, and twenty-seventh pins of the microprocessor chip (U4) via peripheral circuits. The absolute position signal terminal (DI0) is connected to the fourteenth pin of the microprocessor chip (U4) via peripheral circuits. The time synchronization signal terminal (TIM_IN) is connected to the twenty-third pin of the microprocessor chip (U4) via peripheral circuits. The communication signal terminal (DI_CHARG) is connected to the twenty-fourth pin of the microprocessor chip (U4) via peripheral circuits. The power control signal terminal (AI_PRE) is connected to the seventeenth pin of the microprocessor chip (U4) via peripheral circuits.

3. The drilling rig core retrieval rope control circuit according to claim 1, characterized in that: It also includes a CCD wire diameter measurement sensor (5), and the microprocessor chip (U4) is also equipped with a first ADC acquisition port to connect to the CCD wire diameter measurement sensor (5). The detection head of the CCD wire diameter measurement sensor (5) is mounted on the rope arranger and is oriented perpendicular to the length direction of the wire rope. The signal processing module output of the CCD wire diameter measurement sensor (5) is connected to the first set of ADC acquisition ports.

4. The drilling rig core retrieval rope control circuit according to claim 1, characterized in that: It also includes a CAN communication chip (U1) and an RS485 communication chip (U3). The microprocessor chip (U4) is also configured with a first communication port, which includes pins 44 and 45 of the CAN communication chip (U1) and pins 53, 54 and 58 of the RS485 communication chip (U3).

5. The drilling rig core retrieval rope control circuit according to claim 1, characterized in that: It also includes a manual adjustment input module (6), and the microprocessor chip (U4) is also equipped with a second ADC acquisition port, which includes a ninth pin for receiving the decrement key signal of the manual adjustment input module (6) and a tenth pin for receiving the increment key signal of the manual adjustment input module (6).

6. The drilling rig core retrieval rope control circuit according to claim 1, characterized in that: It also includes limit switch groups (7) at the two extreme positions of the rope laying movement of the rope laying device. The microprocessor chip (U4) is also equipped with a third ADC acquisition port. The third ADC acquisition port includes a twenty-fifth pin corresponding to the limit signal at the starting extreme position of the rope laying device and a twenty-sixth pin corresponding to the limit signal at the ending extreme position of the rope laying device.

Images