Down-the-hole drill control device with PWM output and feedback detection functions

Abstract

The utility model provides a down-the-hole drill control device with PWM (Pulse-Width Modulation) output and feedback detection functions, which is characterized by comprising an embedded microprocessor, the power supply circuit, the key input circuit, the TFT color screen display module, the EEPROM storage module, the drilling machine start-stop control output circuit, the drilling machine analog quantity sampling circuit, the alarm protection output circuit, the hydraulic valve control input circuit, the hydraulic valve PWM drive control output circuit and the hydraulic valve PWM drive control feedback detection circuit are respectively connected with the embedded microprocessor. According to the utility model, the PWM is used for outputting modulation signals, digital signals are used for controlling the electric control hydraulic proportional valve, feedback detection on load current is added, comparison with a set target current value is carried out, modulation compensation is carried out on the output signals in real time, overshoot or insufficiency is prevented, the control signals are stable, and the control precision is improved. Therefore, flow and pressure output by the electric control hydraulic proportional valve are accurately controlled, and hydraulic driving equipment is accurately controlled.

Description

Technical Field

[0001] The utility model relates to a down-the-hole drill control device, in particular to a down-the-hole drill control device with PWM output and feedback detection. Background Art

[0002] With the development of social economy and the improvement of industrial technology, the intelligence of engineering machinery and equipment has become more and more popular, making the application of intelligent integrated control devices more and more extensive. In order to achieve more precise control, the hydraulic drive equipment in the down-the-hole drilling equipment has higher and higher requirements for hydraulic flow and pressure accuracy. The original hydraulic valve relies on manual operation to control the hydraulic flow, which is not accurate and depends entirely on the operator's experience. Gradually, the application of electronically controlled hydraulic proportional valves has gradually increased, and has gradually become the key development direction of down-the-hole drilling rigs. For example: the utility model patent with announcement number CN214092495U discloses a hydraulic system applied to down-the-hole drilling rigs, which is controlled by electromagnetic proportional multi-way valve group and control valve group, with fast action switching and high working efficiency; and the utility model patent with announcement number CN218325551U discloses a down-the-hole drilling rig and its integrated valve group and hydraulic control system, which are used to realize the heavy grasping and light grasping pressure switching of the manipulator during the disassembly and assembly of the drill rod, and improve the efficiency of drill rod disassembly.

[0003] Most of the above patents focus on the application of the electric-controlled hydraulic proportional valve in the down-the-hole drilling rig, and rarely involve how to realize the control device of the electric-controlled hydraulic proportional valve. Therefore, it is necessary to provide a control device that can control the flow and pressure output by the electric-controlled hydraulic proportional valve, thereby controlling the hydraulic drive equipment. Utility Model Content

[0004] In order to achieve the above purpose, the technical solution adopted by the utility model is:

[0005] The utility model provides a down-the-hole drilling rig control device with PWM output and feedback detection, comprising: an embedded microprocessor, and a power supply circuit, a key input circuit, a TFT color screen display module, an EEPROM storage module, a drilling rig start-stop control output circuit, a drilling rig analog quantity sampling circuit, an alarm protection output circuit, a hydraulic valve control input circuit, a hydraulic valve PWM drive control output circuit and a hydraulic valve PWM drive control feedback detection circuit respectively connected to the embedded microprocessor;

[0006] The power supply circuit is used to provide power to the down-the-hole drilling rig control device;

[0007] The key input circuit is used for starting and stopping the drilling rig and setting operating configuration parameters;

[0008] The drilling rig start-stop control output circuit is used to receive the start-stop command of the embedded microprocessor and start-stop the drilling rig engine;

[0009] The drilling rig analog quantity sampling circuit is used to collect external analog quantity data;

[0010] The alarm protection output circuit is used to receive the alarm instruction issued by the embedded microprocessor and output the alarm information;

[0011] The hydraulic valve control input circuit is used to detect external control signals;

[0012] The hydraulic valve PWM drive output circuit is used to adjust the PWM output duty cycle and output the target demand current;

[0013] The hydraulic valve PWM drive control feedback detection circuit is used to detect the feedback current in real time;

[0014] The TFT color screen display is used to display the status of the drilling rig, external analog data, alarm protection status, operating time, and PWM modulation voltage and current;

[0015] The EEPROM storage module is used to store the internal resistance and related control current value of the electronically controlled hydraulic proportional valve, as well as operation configuration parameters, alarm records and fault data.

[0016] Based on the above, the drilling rig start-stop control output circuit is connected to one end of the starter relay K1 coil through the starter output port, and the other end is connected to the starter coil of the starter motor M, and the other end of the starter coil of the starter motor M is connected to the battery B-terminal; the fuel output is connected to the fuel pump solenoid valve K2, and the other end of the fuel pump solenoid valve K2 is connected to the battery B-terminal.

[0017] Based on the above, the drilling rig analog quantity sampling circuit includes a TVS tube D10, a resistor R90, a current limiting resistor R92, a capacitor C124, a capacitor C125, and a capacitor C126;

[0018] One end of the TVS tube D10 is connected to the sensor input detection end, and the other end is grounded; one end of the resistor R90 is connected to the sampling reference voltage VREF+, and the other end is connected to the sensor input detection end; the sensor input detection end is connected to the sampling end of the embedded microprocessor through the current limiting resistor R92; one end of the capacitor C124, the capacitor C125 and the capacitor C126 are connected to the ground end, and the other end is connected to the sampling end to filter the input signal.

[0019] Based on the above, the hydraulic valve PWM drive control circuit includes a power switch chip BTT6030, a resistor, a capacitor, a diode, and a TVS tube;

[0020] The PWM output 1 end of the embedded microprocessor is connected to one end of the resistor R196, and the other end of the resistor R196 is connected to the IN0 end of the power switch chip BTT6030; the VS end of the power switch chip BTT6030 is connected to the power supply, the GND end of the power switch chip BTT6030 is connected to one end of the resistor R206, and the other end of the resistor R206 is connected to the diode D74, and the other end of the diode D74 is grounded; the OUT0 end of the power switch chip BTT6030 is connected to one end of the resistor R32, and the other end of the resistor R32 is connected to the signal control end of the hydraulic valve 1; one end of the resistor R197, the capacitor C188, the diode D70 and the TVS tube D71 are all grounded, and the other ends are all connected to the signal control end of the hydraulic valve 1.

[0021] Based on the above, the hydraulic valve PWM drive control feedback detection circuit includes a current detection amplifier INA240A, a capacitor, a resistor and a diode;

[0022] One end of the sampling resistor R32 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end; one end of the capacitor C36 and the capacitor C167 are both grounded, and the other ends are respectively connected to the IN+ and IN- ends of the current detection amplifier INA240A; one end of the capacitor C166 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end of the current detection amplifier INA240A; the VS end of the current detection amplifier INA240A is connected to a 3.3V voltage, the REF1 end and the REF2 end are grounded, the OUT end is connected to one end of the resistor R137, and the other end of the resistor R137 is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the capacitor C168 and the capacitor C191 are both grounded, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the diode D28 is connected to the 3.3V voltage, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the diode D32 is grounded, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor.

[0023] The utility model has substantial features and progress compared with the prior art, specifically:

[0024] The utility model uses PWM output modulation signal to control the electronically controlled hydraulic proportional valve with digital signal, and at the same time increases the feedback detection of load current, compares it with the set target current value, and modulates and compensates the output signal in real time to prevent overshoot or undershoot, so as to stabilize the control signal, thereby accurately controlling the flow and pressure output by the electronically controlled hydraulic proportional valve and accurately controlling the hydraulic drive equipment. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] Figure 1 It is a principle block diagram of the utility model.

[0026] Figure 2 It is a circuit wiring schematic diagram of the utility model.

[0027] Figure 3 The utility model discloses a drilling rig analog quantity sampling circuit diagram.

[0028] Figure 4 It is a hydraulic valve PWM drive control output circuit diagram of the utility model.

[0029] Figure 5 The utility model discloses a hydraulic valve PWM drive control feedback detection circuit diagram.

[0030] Figure 6 It is a schematic diagram of the PWM drive control and feedback detection process of the utility model. DETAILED DESCRIPTION

[0031] In order to more clearly understand the above-mentioned purpose, features and advantages of the utility model, the utility model is further described in detail below in conjunction with the accompanying drawings and specific implementation methods. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.

[0032] like Figure 1 As shown, this embodiment provides a down-the-hole drilling rig control device with PWM output and feedback detection, including: an embedded microprocessor, and a power supply circuit, a key input circuit, a TFT color screen display module, an EEPROM storage module, a drilling rig start-stop control output circuit, a drilling rig analog quantity sampling circuit, an alarm protection output circuit, a hydraulic valve control input circuit, a hydraulic valve PWM drive control output circuit and a hydraulic valve PWM drive control feedback detection circuit respectively connected to the embedded microprocessor;

[0033] The power supply circuit is used to provide power to the down-the-hole drilling rig control device;

[0034] The key input circuit is used for starting and stopping the drilling rig and setting operating configuration parameters;

[0035] The drilling rig start-stop control output circuit is used to receive the start-stop command of the embedded microprocessor and start-stop the drilling rig engine;

[0036] The drilling rig analog quantity sampling circuit is used to collect external analog quantity data;

[0037] The alarm protection output circuit is used to receive the alarm instruction issued by the embedded microprocessor and output the alarm information;

[0038] The hydraulic valve control input circuit is used to detect external control signals;

[0039] The hydraulic valve PWM drive output circuit is used to adjust the PWM output duty cycle and output the target demand current;

[0040] The hydraulic valve PWM drive control feedback detection circuit is used to detect the feedback current in real time;

[0041] The TFT color screen display is used to display the status of the drilling rig, external analog data, alarm protection status, operating time, and PWM modulation voltage and current;

[0042] The EEPROM storage module is used to store the internal resistance and related control current value of the electronically controlled hydraulic proportional valve, as well as operation configuration parameters, alarm records and fault data.

[0043] In specific implementation:

[0044] like Figure 2 As shown, the drilling rig start-stop control output circuit is connected to one end of the starter relay K1 coil through the starter output port, and the other end is connected to the starter coil of the starter motor M, and the other end of the starter coil of the starter motor M is connected to the battery B-terminal; the fuel output is connected to the fuel pump solenoid valve K2, and the other end of the fuel pump solenoid valve K2 is connected to the battery B-terminal;

[0045] When the embedded microprocessor receives the start command, it first closes the fuel output to energize the fuel pump solenoid valve K2, causing the fuel pump to start supplying fuel, and then closes the start output to energize the start relay K1, energize the coil of the starter motor M, and the starter motor M starts to start the drilling rig engine.

[0046] like Figure 3 As shown, the drilling rig analog quantity sampling circuit includes a TVS tube D10, a resistor R90, a current limiting resistor R92, a capacitor C124, a capacitor C125, and a capacitor C126;

[0047] One end of the TVS tube D10 is connected to the sensor input detection end, and the other end is grounded; one end of the resistor R90 is connected to the sampling reference voltage VREF+, and the other end is connected to the sensor input detection end; the sensor input detection end is connected to the sampling end of the embedded microprocessor through the current limiting resistor R92; one end of the capacitor C124, the capacitor C125 and the capacitor C126 are connected to the ground end, and the other end is connected to the sampling end to filter the input signal.

[0048] The external analog data collected by the drilling rig analog sampling circuit include the water temperature, oil pressure, fuel level, hydraulic temperature and exhaust temperature of the external engine. When the external analog data exceeds the set protection threshold, the embedded microprocessor issues an alarm instruction, and the alarm protection output circuit outputs alarm information such as high engine water temperature, low oil pressure, high exhaust temperature, and high hydraulic system temperature. Specifically, the embedded microprocessor performs a voltage division calculation with the resistor R90 based on the value of the acquired external analog data, calculates the resistance value of the sensor input terminal, and calculates the corresponding analog value by comparing the resistance and analog curve. The embedded microprocessor then sets the protection threshold. If the calculated corresponding analog value is greater than the set threshold, an alarm instruction is issued to cause the alarm protection output circuit to output;

[0049] If the calculated analog value of the water temperature is greater than the set threshold, the embedded microprocessor issues a water temperature alarm instruction, and the alarm protection output circuit outputs an engine water temperature high alarm;

[0050] If the calculated analog value of the oil pressure is greater than the set threshold, the embedded microprocessor issues an oil pressure alarm instruction, and the alarm protection output circuit outputs an engine oil pressure low alarm;

[0051] If the calculated fuel level analog value is greater than the set threshold, the embedded microprocessor issues a fuel level alarm instruction, and the alarm protection output circuit outputs an engine fuel level low alarm.

[0052] If the calculated analog value of the hydraulic temperature is greater than the set threshold, the embedded microprocessor issues a hydraulic temperature alarm instruction, and the alarm protection output circuit outputs a hydraulic system high temperature alarm.

[0053] like Figure 4-Figure 6 As shown, the hydraulic valve control input circuit detects the external control signal and sends it to the embedded microprocessor. The hydraulic valve PWM drive control output circuit controls the output current and the external control signal sent by the embedded microprocessor as needed, adjusts the PWM output duty cycle, and modulates the target demand current. The hydraulic valve PWM drive control feedback detection circuit detects the feedback current in real time. The embedded microprocessor determines whether the modulation target demand current is met based on the feedback current. If not, it calculates the difference between the target current and the current actual feedback current, and readjusts the PWM output duty cycle for compensation output.

[0054] like Figure 4 As shown, the hydraulic valve PWM drive control circuit includes a power switch chip BTT6030, a resistor, a capacitor, a diode, and a TVS tube;

[0055] The PWM output 1 end of the embedded microprocessor is connected to one end of the resistor R196, and the other end of the resistor R196 is connected to the IN0 end of the power switch chip BTT6030; the VS end of the power switch chip BTT6030 is connected to the power supply, the GND end of the power switch chip BTT6030 is connected to one end of the resistor R206, and the other end of the resistor R206 is connected to the diode D74, and the other end of the diode D74 is grounded; the OUT0 end of the power switch chip BTT6030 is connected to one end of the resistor R32, and the other end of the resistor R32 is connected to the signal control end of the hydraulic valve 1; one end of the resistor R197, the capacitor C188, the diode D70 and the TVS tube D71 are all grounded, and the other ends are all connected to the signal control end of the hydraulic valve 1.

[0056] like Figure 5 As shown, the hydraulic valve PWM drive control feedback detection circuit includes a current detection amplifier INA240A, a capacitor, a resistor and a diode;

[0057] One end of the sampling resistor R32 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end; one end of the capacitor C36 and the capacitor C167 are both grounded, and the other ends are respectively connected to the IN+ and IN- ends of the current detection amplifier INA240A; one end of the capacitor C166 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end of the current detection amplifier INA240A; the VS end of the current detection amplifier INA240A is connected to a 3.3V voltage, the REF1 end and the REF2 end are grounded, the OUT end is connected to one end of the resistor R137, and the other end of the resistor R137 is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the capacitor C168 and the capacitor C191 are both grounded, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the diode D28 is connected to the 3.3V voltage, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor; one end of the diode D32 is grounded, and the other end is connected to the detection feedback input 1 end of the embedded microprocessor.

[0058] Specifically, Figure 6As shown, the embedded microprocessor sets the proportional valve voltage, resistance and other parameters according to the selected electronically controlled hydraulic proportional valve model, sets the control current range and stores it in the EEPROM storage module, and sets the current value required for different hydraulic pressure gears according to different application scenarios; the embedded microprocessor detects the external control signal according to the hydraulic valve control input circuit, and adjusts the PWM output signal according to the external control signal and the target demand current, and adjusts the PWM output frequency and duty cycle. The output signal of the embedded microprocessor passes through the power switch chip BTT6030, amplifies the signal and drives the output to control the electronically controlled hydraulic proportional valve. The hydraulic valve PWM drive control feedback detection circuit detects the target demand current output by the hydraulic valve PWM drive control output circuit in real time, and feeds the target demand current back to the embedded microprocessor as the feedback current. The embedded microprocessor compares the target demand current in real time with the set target demand current. If the current is too large or too small, readjust the PWM output to compensate the modulation signal. If the current is too small, increase the PWM output duty cycle, and if the current is too large, reduce the PWM output duty cycle. Real-time current feedback detection effectively prevents over-adjustment of the electronically controlled hydraulic valve and realizes more accurate hydraulic valve control.

[0059] The TFT color screen display module has a display resolution of 480x272, samples RGB565 colors, has a colorful interface, adjustable backlight brightness, and has optional interface operations in Chinese, English and other languages. The interface adopts a graphical design. The configuration parameters, operating data, fault information, operation and status information of the drilling rig control device are all displayed intuitively and clearly, which is very convenient for operators to use.

[0060] The above is only a specific implementation of the utility model, but the protection scope of the utility model is not limited thereto. Any technician familiar with the technical field can easily think of changes or substitutions within the technical scope disclosed by the utility model, which should be included in the protection scope of the utility model. Therefore, the protection scope of the utility model should be based on the protection scope of the claims.

Claims

1. A down-the-hole drilling rig control device with PWM output and feedback detection, characterized in that: include: An embedded microprocessor, and a power supply circuit, a key input circuit, a TFT color screen display module, an EEPROM storage module, a drilling rig start-stop control output circuit, a drilling rig analog quantity sampling circuit, an alarm protection output circuit, a hydraulic valve control input circuit, a hydraulic valve PWM drive control output circuit and a hydraulic valve PWM drive control feedback detection circuit respectively connected to the embedded microprocessor; The power supply circuit is used to provide power to the down-the-hole drilling rig control device; The key input circuit is used for starting and stopping the drilling rig and setting operating configuration parameters; The drilling rig start-stop control output circuit is used to receive the start-stop command of the embedded microprocessor and start-stop the drilling rig engine; The drilling rig analog quantity sampling circuit is used to collect external analog quantity data; The alarm protection output circuit is used to receive the alarm instruction issued by the embedded microprocessor and output the alarm information; The hydraulic valve control input circuit is used to detect external control signals; The hydraulic valve PWM drive output circuit is used to adjust the PWM output duty cycle and output the target demand current; The hydraulic valve PWM drive control feedback detection circuit is used to detect the feedback current in real time; The TFT color screen display is used to display the status of the drilling rig, external analog data, alarm protection status, operating time, and PWM modulation voltage and current; The EEPROM storage module is used to store the internal resistance and related control current value of the electronically controlled hydraulic proportional valve, as well as operation configuration parameters, alarm records and fault data.

2. The down-the-hole drill control device with PWM output and feedback detection according to claim 1, characterized in that: The drilling rig start-stop control output circuit is connected to one end of the starter relay K1 coil through the starter output port, and the other end is connected to the starter coil of the starter motor M, and the other end of the starter coil of the starter motor M is connected to the battery B-terminal; the fuel output is connected to the fuel pump solenoid valve K2, and the other end of the fuel pump solenoid valve K2 is connected to the battery B-terminal.

3. The down-the-hole drill control device with PWM output and feedback detection according to claim 1, characterized in that: The drilling rig analog quantity sampling circuit includes a TVS tube D10, a resistor R90, a current limiting resistor R92, a capacitor C124, a capacitor C125, and a capacitor C126; One end of the TVS tube D10 is connected to the sensor input detection end, and the other end is grounded; one end of the resistor R90 is connected to the sampling reference voltage VREF+, and the other end is connected to the sensor input detection end; the sensor input detection end is connected to the sampling end of the embedded microprocessor through the current limiting resistor R92; one end of the capacitor C124, the capacitor C125 and the capacitor C126 are connected to the ground end, and the other end is connected to the sampling end to filter the input signal.

4. The down-the-hole drill control device with PWM output and feedback detection according to claim 1, characterized in that: The hydraulic valve PWM drive control circuit includes a power switch chip BTT6030, a resistor, a capacitor, a diode, and a TVS tube; The PWM output 1 terminal of the embedded microprocessor is connected to one end of the resistor R196, and the other end of the resistor R196 is connected to the IN0 terminal of the power switch chip BTT6030; The VS terminal of the power switch chip BTT6030 is connected to the power supply, the GND terminal of the power switch chip BTT6030 is connected to one end of the resistor R206, the other end of the resistor R206 is connected to the diode D74, and the other end of the diode D74 is grounded; The OUT0 terminal of the power switch chip BTT6030 is connected to one end of the resistor R32, and the other end of the resistor R32 is connected to the signal control terminal of the hydraulic valve 1; One ends of the resistor R197, the capacitor C188, the diode D70 and the TVS tube D71 are all grounded, and the other ends are connected to the signal control terminal of the hydraulic valve 1.

5. The down-the-hole drill control device with PWM output and feedback detection according to claim 1, characterized in that: The hydraulic valve PWM drive control feedback detection circuit includes a current detection amplifier INA240A, a capacitor, a resistor and a diode; One end of the sampling resistor R32 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end; one end of the capacitor C36 and the capacitor C167 are both grounded, and the other ends are respectively connected to the IN+ and IN- ends of the current detection amplifier INA240A; one end of the capacitor C166 is connected to the IN+ end of the current detection amplifier INA240A, and the other end is connected to the IN- end of the current detection amplifier INA240A; The VS terminal of the current detection amplifier INA240A is connected to a 3.3V voltage, the REF1 terminal and the REF2 terminal are grounded, the OUT terminal is connected to one end of the resistor R137, and the other end of the resistor R137 is connected to the detection feedback input 1 terminal of the embedded microprocessor; one end of the capacitor C168 and the capacitor C191 are both grounded, and the other end is connected to the detection feedback input 1 terminal of the embedded microprocessor; One end of the diode D28 is connected to the 3.3V voltage, and the other end is connected to the detection feedback input 1 terminal of the embedded microprocessor; one end of the diode D32 is grounded, and the other end is connected to the detection feedback input 1 terminal of the embedded microprocessor.

Images