Platform lifting control system and method
By using sensors, control modules and lifting drive modules in the underground downhole lift control system, combined with the PID control algorithm, the problems of insufficient platform lifting flexibility and safety hazards in underground operations are solved, and stable and accurate platform lifting control is achieved.
Patent Information
- Application Number
- CN202411129514.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-12
AI Technical Summary
Traditional downhole lifting solutions are not flexible enough in underground operations, which can easily cause safety hazards. Mechanical lifting equipment covers a large area and has poor mobility flexibility. The single-rail lifting cost is high and the maintenance is complex, making it difficult to adapt to complex environments.
Design a platform lift control system, including sensor module, control module and lift driving module, obtain platform attitude data through gyroscope sensors, control module generates driving control instructions, lift driving driving module responds to adjust the platform to the target level state, and use PID control algorithm Adjust the speed and angle of the encoded motor to ensure stable lifting and lowering of the platform.
Improves the stability and safety of the platform's lifting and lowering downhole, reduces shaking and tilting, achieves precise control, and enhances flexibility and adaptability to movement.
Smart Images

Figure CN118929463A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of automatic control technology, and in particular to a platform lifting control system and method. Background Art
[0002] Traditional underground lifting solutions mainly include manual lifting: in underground operations, winches or manpower are usually used to lift and lower equipment; mechanical lifting equipment: using fixed mechanical lifting equipment, such as electric lifts, hydraulic lifts, etc.; monorail lifting system: using a monorail crane with laid tracks to transport equipment underground and perform lifting.
[0003] However, although manual lifting is a relatively simple and low-cost method, it can easily cause safety hazards when working at heights or lifting heavy objects. Mechanical lifting equipment can effectively reduce the manpower burden, but it occupies a large area and has poor mobility, and is often difficult to adapt to complex underground environments. Monorail lifting saves some space and achieves flexible movement through tracks, but the laying and maintenance costs are high, and if a failure occurs, the track needs to be re-laid, which will result in a long work interruption time. Summary of the invention
[0004] In view of this, it is necessary to provide a platform lifting control system and method to solve the technical problems of insufficient flexibility and potential safety hazards caused by the platform during underground lifting operations.
[0005] In order to solve the above problems, the present invention provides a platform lifting control system for controlling the lifting of a three-point platform, the platform lifting control system comprising a sensor module, a control module, and three lifting drive modules corresponding to the three control points in the three-point platform; The sensor module is used to obtain the real-time horizontal state of the three-point platform; The control module is used to generate a drive control instruction when the real-time horizontal state is not the target state; The lifting drive module is used to respond to the drive control instruction and control the three-point platform to adjust to a target horizontal state.
[0006] In a possible implementation, the sensor module includes a gyroscope sensor; The gyro sensor is used to obtain the attitude data of the three-point platform in real time, and determine the horizontal state of the three-point platform based on the attitude data, wherein the attitude data includes a pitch angle, a roll angle and an angular velocity, and the angular velocity includes a roll angular velocity and a pitch angular velocity.
[0007] In a possible implementation, the control module includes a control unit and a communication unit; The communication unit is used to receive the wireless control command, the posture data of the sensor module and the speed data of the lifting drive module, and send the wireless control command, posture data and speed data to the control unit; The control unit is used to parse the wireless control instruction, and after starting the lifting drive module, determine whether the real-time horizontal state of the three-point platform is the target state based on the posture data, and generate a drive control instruction when the real-time horizontal state is not the target state.
[0008] In a possible implementation, the communication unit includes wireless wifi, a first serial port transparent transmission wireless, and a second serial port transparent transmission wireless; The wireless wifi is used to obtain wireless control instructions and feed the wireless control instructions back to the control module; The first serial port is wirelessly transparent and is used to receive the posture data of the sensor module and the speed data of the lifting drive module; The second serial port is wirelessly transparent and is used to send the posture data and speed data to the control module.
[0009] In a possible implementation, the control unit includes a first control and a second control; The first control is used to receive the wireless control instruction of the communication unit, start the lifting drive module after parsing the wireless control instruction, and send the pitch angle, roll angle and angular velocity of the three-point platform to the second control; The second control is used to determine the horizontal state of the three-point platform. When the real-time horizontal state is not the target state, the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform. The three-way pulse width modulation duty cycle is adjusted in real time by using a PID control algorithm based on the angle error. The actual speed of the lifting drive module and the angle of the three-point platform are determined based on the speed, posture data and the three-way pulse width modulation duty cycle of the lifting drive module. The angle error includes a first angle error, a second angle error and a third angle error. The first angle error is the angle error of the first point of the three-point platform, the second angle error is the angle error of the second point of the three-point platform, and the third angle error is the angle error of the third point of the three-point platform. The actual speed of the lifting drive module includes a first actual speed, a second actual speed and a third actual speed. The three-way pulse width modulation duty cycle includes a first pulse width modulation duty cycle, a second pulse width modulation duty cycle and a third pulse width modulation duty cycle. The angle of the three-point platform includes the angle of the first point, the angle of the second point and the angle of the third point.
[0010] In a possible implementation, the lifting drive module includes a first encoding motor, a second encoding motor and a third encoding motor; The second encoding motor corresponds to the second point of the three-point platform, and is used to obtain a second actual speed, determine a target height, and adjust the lifting speed of the second point of the three-point platform based on the second actual speed and the target height, so that the three-point platform can be lifted and lowered at a uniform speed; The first encoding motor corresponds to the first point of the three-point platform, and is used to determine the first actual speed based on the second actual speed, adjust the lifting speed of the first point of the platform based on the first actual speed, obtain the angle of the first point of the three-point platform, and adjust the pitch angle of the first point of the platform based on the angle of the first point of the three-point platform; The third encoding motor corresponds to the third point position of the three-point platform, and is used to determine the third actual speed based on the second actual speed, adjust the lifting speed of the third point position of the platform based on the third actual speed, obtain the angle of the third point position of the three-point platform, and adjust the rolling angle of the third point position of the platform based on the angle of the third point position of the three-point platform.
[0011] On the other hand, the present invention also provides a platform lifting control method for controlling the lifting of a three-point platform, which is implemented by the platform lifting control system as described above, and comprises the following steps: Acquiring a real-time horizontal state of the three-point platform based on the sensor module; generating a driving control instruction based on the control module when the real-time horizontal state is not a target state; Based on the lifting drive module responding to the drive control instruction, the three-point platform is controlled to be adjusted to a target horizontal state.
[0012] In a possible implementation, when the real-time horizontal state is not the target state, generating a drive control instruction includes: The real-time horizontal state of the three-point platform is determined based on the pitch angle, roll angle and angular velocity of the three-point platform acquired in real time. When the real-time horizontal state is not the target state, the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform, and the angle error is input into the PID controller to calculate the first pulse width modulation duty cycle, the second pulse width modulation duty cycle and the third pulse width modulation duty cycle.
[0013] In a possible implementation, responding to the drive control instruction and controlling the three-point platform to adjust to a target horizontal state includes: Acquire the speeds of the first encoding motor, the second encoding motor and the third encoding motor of the lifting drive module in real time; Determine the voltage signal of the second encoder motor based on the duty cycle of the second pulse width modulation, and determine the actual speed of the second encoder motor based on the voltage signal of the second encoder motor and the speed of the second encoder motor, so that the lifting speed of the second point of the platform remains uniform; Determine the speed of the first encoder motor based on the actual speed of the second encoder motor, determine the voltage signal of the first encoder motor based on the first pulse width modulation duty cycle, and determine the actual speed of the first encoder motor and the angle of the first point of the platform based on the voltage signal of the first encoder motor, the pitch angle of the three-point platform and the speed of the first encoder motor; Determine the speed of the third encoder motor based on the actual speed of the second encoder motor, determine the voltage signal of the third encoder motor based on the third pulse width modulation duty cycle, and determine the actual speed of the third encoder motor and the angle of the third point of the platform based on the voltage signal of the third encoder motor, the roll angle of the three-point platform and the speed of the third encoder motor; The three-point platform is controlled to be adjusted to a target horizontal state based on the actual speed of the second encoder motor, the angle of the first point of the platform, and the angle of the third point of the platform, wherein the actual speed of the second encoder motor is consistent with the actual speed of the first encoder motor and the actual speed of the third encoder motor.
[0014] In a possible implementation, the calculation formula for the pulse width modulation duty cycle of the first encoder motor is: , in, is the pulse width modulation duty cycle of the first encoder motor, is the roll angle, is the rolling angular velocity, is the scale parameter, is the differential parameter; The calculation formula of the pulse width modulation duty cycle of the third encoder motor is: , in, is the pulse width modulation duty cycle of the third encoder motor, is the pitch angle, is the pitch angular velocity, is the scale parameter, is the differential parameter.
[0015] The beneficial effects of the present invention are as follows: the platform lifting control system includes a sensor module, a control module, and a lifting drive module. After the speed of the lifting drive module is adjusted in real time through the driving control instructions of the control module and the angle of the platform is determined, the lifting speed of three points of the platform and the angles of the first point and the third point are adjusted in real time through the lifting drive module, thereby reducing the shaking and tilting of the platform during the lifting process and improving stability and safety. By adjusting the lifting speed of the three points of the platform in real time through the lifting drive module, the lifting speed and position of the platform can be accurately controlled, thereby improving flexibility. BRIEF DESCRIPTION OF THE DRAWINGS
[0016] Figure 1 A schematic diagram of the structure of an embodiment of a platform lifting control system provided by the present invention; Figure 2 A schematic structural diagram of an embodiment of a control module of a platform lifting control system provided by the present invention; Figure 3 A schematic diagram of the structure of an embodiment of a communication unit of a platform lifting control system provided by the present invention; Figure 4 A schematic structural diagram of an embodiment of a control unit of a platform lifting control system provided by the present invention; Figure 5 A schematic structural diagram of an embodiment of a lifting drive module of a platform lifting control system provided by the present invention; Figure 6 A schematic diagram of the structure of the platform lifting control system provided by the present invention; Figure 7 The present invention provides a flow chart of an embodiment of a platform lifting control method. DETAILED DESCRIPTION
[0017] The preferred embodiments of the present invention are described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of this application and are used together with the embodiments of the present invention to illustrate the principles of the present invention, but are not used to limit the scope of the present invention.
[0018] The invention discloses a platform lifting control system. Figure 1 is a schematic diagram of a platform lifting control system provided by an embodiment of the present invention, please refer to Figure 1 , the platform lifting control system 100 includes a sensor module 110, a control module 120, and three lifting drive modules 130 corresponding to the three control points in the three-point platform; The sensor module 110 is used to obtain the real-time horizontal state of the three-point platform; The control module 120 is used to generate a driving control instruction when the real-time horizontal state is not the target state; The lifting drive module 130 is used to respond to the driving control instruction and control the three-point platform to adjust to the target horizontal state.
[0019] In some embodiments, the sensor module 110 includes a gyroscope sensor; The gyroscope sensor is used to obtain the attitude data of the three-point platform in real time, and determine the horizontal state of the three-point platform based on the attitude data. The attitude data includes pitch angle, roll angle and angular velocity, and the angular velocity includes roll angular velocity and pitch angular velocity. The gyroscope is mup6050, and the pitch angle, roll angle and angular velocity of the three-point platform are read through the gyroscope.
[0020] In some embodiments, see Figure 2 , the control module 120 includes a communication unit 121 and a control unit 122; The communication unit 121 is used to receive the wireless control command, the posture data of the sensor module and the speed data of the lifting drive module, and send the wireless control command, the posture data and the speed data to the control unit; The control unit 122 is used to parse the wireless control command, and after starting the lifting drive module, determine whether the real-time horizontal state of the three-point platform is the target state based on the posture data, and generate a drive control command when the real-time horizontal state is not the target state; See also Figure 3 , the communication unit 121 includes a wireless wifi 1211, a first serial port transparent transmission wireless 1212 and a second serial port transparent transmission wireless 1213; Wireless wifi 1211 is used to obtain wireless control instructions and feed back the wireless control instructions to the control module 120. It communicates with the outside world through wireless wifi. After receiving the wireless control instructions, it parses the instruction parameters. When the instruction parameters are valid, it outputs 3 identical PWM (pulse width modulation duty cycle) through the control module to start the encoder motor of the control module. The first serial port transparent transmission wireless 1212 is used to receive the posture data of the sensor module and the speed data of the lifting drive module; The second serial port transparent transmission wireless 1213 is used to send the posture data and speed data to the control module 120; The first serial port transparent wireless transmission and the second serial port transparent wireless transmission are serial port transparent wireless transmission zigbee, and the data of the gyroscope and the data of the lifting drive module are fed back to the control module 120 through the serial port transparent wireless transmission; See also Figure 4 , the control unit 122 includes a first control 1221 and a second control 1222; The first control 1221 is used to receive the wireless control command of the communication unit, parse the wireless control command, and when the command parameter is wrong, not execute the control command and feedback the error; when the command parameter is correct, start the lifting drive module, and send the pitch angle, roll angle and angular velocity of the three-point platform to the second control; The second control 1222 is used to determine the real-time horizontal state of the three-point platform. When the real-time horizontal state is not the target state, the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform. The three-way pulse width modulation duty cycle is adjusted in real time using a PID control algorithm based on the angle error. The actual speed of the lifting drive module and the angle of the three-point platform are determined based on the speed and posture data of the lifting drive module and the three-way pulse width modulation duty cycle. The angle error includes a first angle error, a second angle error and a third angle error. The first angle error is the angle error of the first point of the three-point platform, the second angle error is the angle error of the second point of the three-point platform, and the third angle error is the angle error of the third point of the three-point platform. The actual speed of the lifting drive module includes the first actual speed, the second actual speed and the third actual speed. The three-way pulse width modulation duty cycle includes the first pulse width modulation duty cycle, the second pulse width modulation duty cycle and the third pulse width modulation duty cycle. The angle of the three-point platform includes the angle of the first point, the angle of the second point and the angle of the third point.
[0021] The first control and the second control are single-chip microcomputers. After receiving the data from the gyroscope and the lifting drive module 130, the single-chip microcomputer adjusts the duty cycle of the three-way pulse width modulation through the PID control algorithm, adjusts the speed of the lifting drive module according to the duty cycle of the three-way pulse width modulation, and determines the angle of the platform.
[0022] In some embodiments, see Figure 5 , the lifting driving module 130 includes a first encoding motor 131, a second encoding motor 132 and a third encoding motor 133; The second encoder motor 132 is connected to the second point of the three-point platform by a rope, and is used to obtain the second actual speed, determine the target height, and adjust the lifting speed of the second point of the platform based on the second actual speed and the target height, so that the platform can be lifted and lowered at a uniform speed; The first encoding motor 131 is connected to the first point of the three-point platform by a rope, and is used to determine the first actual speed of the first encoding motor based on the second actual speed of the second encoding motor, adjust the lifting speed of the first point of the platform based on the first actual speed, obtain the angle of the first point of the three-point platform, and adjust the pitch angle of the first point of the platform based on the angle of the first point of the three-point platform; The third encoding motor 133 is connected to the third point of the platform lower plate by a rope, and is used to determine the third actual speed of the third encoding motor based on the second actual speed of the second encoding motor, adjust the lifting speed of the third point of the platform based on the third actual speed, obtain the angle of the third point of the three-point platform, and adjust the rolling angle of the third point of the three-point platform based on the angle of the third point of the three-point platform; Get the target height and current height, calculate the lifting height that needs to be adjusted for the platform, and adjust the speed of the three encoder motors in time according to the real-time feedback information provided by the gyroscope and the current speed of the three encoder motors. Then, adjust the number of rotations of the cable in the encoder motor according to the lifting height that needs to be adjusted for the platform, so that the three encoder motors can be lifted and lowered synchronously. By controlling the three encoder motors to rise and fall synchronously according to the calculated height difference, the bottom platform can be kept level. By continuously updating the feedback information and adjusting the control output, smooth and precise horizontal lifting control can be achieved.
[0023] For the structural diagram of the platform lifting control system, please refer to Figure 6 ,like Figure 6 As shown, the platform lifting control system includes three encoding motors, the first serial port transparent wireless zigbee, wifi, the first single-chip microcomputer, the gyroscope, the second single-chip microcomputer, and the second serial port transparent wireless zigbee. The three encoding motors correspond to rope hole 1, rope hole 2, and rope hole 3 respectively.
[0024] A specific embodiment of the present invention discloses a platform lifting control method for controlling the lifting of a three-point platform. Figure 7 is a flow chart of the platform lifting control method provided by an embodiment of the present invention, please refer to Figure 7 , the platform lifting control method includes: S710, acquiring a real-time horizontal state of the three-point platform based on the sensor module; S720, generating a drive control instruction based on the control module when the real-time horizontal state is not the target state; S730, based on the lifting drive module responding to the drive control instruction, controlling the three-point platform to adjust to the target horizontal state; Among them, the gyroscope sensor of the sensor module obtains the pitch angle, attitude angle and angular velocity data of the platform in real time, the control module obtains the angle data of the sensor module and the real-time speed of the three encoder motors in the lifting drive module, and the control module adjusts the speed of the three encoder motors in the lifting drive module based on the feedback information. The three encoder motors correspond to the three points of the three-point platform respectively.
[0025] Compared with the prior art, the platform lifting control method provided in this embodiment obtains the real-time horizontal state of the three-point platform based on the sensor module; generates a drive control instruction based on the control module when the real-time horizontal state is not the target state, and controls the three-point platform to adjust to the target horizontal state based on the lifting drive module in response to the drive control instruction. The control module adjusts the speed of the lifting drive module through the drive control instruction, and adjusts the lifting speed and angle of the three-point platform through the lifting drive module, which can reduce the shaking and tilting of the equipment during the lifting process and provide a smoother movement experience; by adjusting the lifting speed and angle of the platform, the lifting speed and position of the platform can be accurately controlled, thereby improving the flexibility of the platform lifting.
[0026] In some embodiments, in step S710, the sensor module reads the feedback information of the gyroscope of the lower unit of the platform, and obtains the attitude data of the platform in real time to determine the current horizontal state of the platform. Its attitude data includes pitch angle, roll angle and angular velocity, and the angular velocity includes roll angular velocity and pitch angular velocity.
[0027] In some embodiments, in step S720, the control unit of the control module receives the wireless control instruction through the wireless wifi of the communication unit, and parses the wireless control instruction to start the encoding motor of the lifting drive module. After the communication unit receives the pitch angle, roll angle and angular velocity data of the lower plate, the pitch angle, roll angle and angular velocity data are sent to the control unit. At the same time, the communication unit receives the real-time speed of the lifting drive module and the number of rotations of the rope during the lifting process of the platform, and feeds back the real-time speed of the lifting drive module and the number of rotations of the rope to the control unit, and determines the position of the platform through the number of rotations of the rope; The first control of the control unit receives the wireless control instruction, and after parsing the wireless control instruction, when the control instruction is valid, outputs three identical PWMs to start the three encoder motors. In the process of the three encoder motors controlling the lifting of the platform, the second control of the control unit determines the real-time horizontal state of the three-point platform based on the pitch angle, roll angle and angular velocity of the three-point platform. When the real-time horizontal state of the three-point platform is not the target state, a drive control instruction is generated, that is, the voltage signals of the three encoder motors are adjusted respectively by the second control of the control unit using the PID control algorithm to determine the speeds of the three encoder motors in real time; the first control of the control unit obtains the speed of the lifting drive module and the pitch angle, roll angle and angular velocity of the three-point platform through the communication unit, and sends the speed of the lifting drive module and the pitch angle, roll angle and angular velocity of the three-point platform to the second control of the control unit through the communication unit; the second control determines the angle error based on the pitch angle, roll angle and angular velocity of the three-point platform, and uses the PID control algorithm to adjust the duty cycle of the three-way pulse width modulation in real time based on the angle error; The actual speed of the lifting drive module and the angle of the three-point platform are determined by the speed, posture data of the block and the duty cycle of the three-way pulse width modulation. The height adjustment of the motor is realized by using the PID control algorithm. The output of the motor is continuously adjusted through PID control so that the actual state of the platform gradually approaches the target state, thereby realizing a smooth lifting process. The process of generating the drive control instruction is as follows: the pitch angle, roll angle and angular velocity of the three-point platform are acquired in real time, and the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform. The angle error includes the angle error of the first point of the three-point platform, the angle error of the second point of the three-point platform and the angle error of the third point of the three-point platform. The angle error is input into the PID controller, and the duty cycle of the first pulse width modulation, the duty cycle of the second pulse width modulation and the duty cycle of the third pulse width modulation are calculated respectively. The voltage signals of the first encoding motor, the second encoding motor and the third encoding motor in the lifting drive module are adjusted by the duty cycle of the first pulse width modulation, the duty cycle of the second pulse width modulation and the duty cycle of the third pulse width modulation.
[0028] In some embodiments, in step S703, based on the response of the lifting drive module to the driving control instruction, the three-point platform is controlled to adjust to the target horizontal state, and the process is as follows: the speeds of the first encoder motor, the second encoder motor and the third encoder motor of the lifting drive module are acquired in real time, the voltage signal of the second encoder motor is determined based on the second pulse width modulation duty cycle, the actual speed of the second encoder motor is determined based on the voltage signal of the second encoder motor and the speed of the second encoder motor, and the lifting and lowering of the three-point platform is controlled based on the actual speed of the second encoder motor, so that the lifting and lowering speed of the second point of the three-point platform is kept uniform; the speed of the first encoder motor is determined based on the actual speed of the second encoder motor, the voltage signal of the first encoder motor is determined based on the first pulse width modulation duty cycle, the actual speed of the first encoder motor and the angle of the first point of the platform are determined based on the voltage signal of the first encoder motor, the pitch angle of the three-point platform and the speed of the first encoder motor, the actual speed of the first encoder motor and the actual speed of the third encoder motor are kept consistent with the actual speed of the second encoder motor, and the three-point platform is controlled to adjust to the target horizontal state based on the actual speed of the second encoder motor, the angle of the first point of the platform and the angle of the third point of the platform; the calculation formula of the first pulse width modulation duty cycle is: , in, is the pulse width modulation duty cycle of the first encoder motor, is the roll angle, is the rolling angular velocity, is the scale parameter, is the differential parameter; The duty cycle of the second pulse width modulation is: ; The calculation formula of the third pulse width modulation duty cycle is: , in, is the pulse width modulation duty cycle of the third encoder motor, is the pitch angle, is the pitch angular velocity, is the scale parameter, is the differential parameter.
[0029] When using a PID controller to control the lifting of a platform, the P, I, and D parameters represent the proportional, integral, and differential parts respectively. Their specific relationship with the bottom hanging bin of the controlled object platform is as follows: Proportional link P (Proportional): P represents the proportional part, which is adjusted according to the current angle error. The P part controls the controlled object by adjusting the size of the error. In the lifting control, the P parameter is used to control the acceleration and deceleration of the motor according to the current tilt angle (error) to make the bottom hanging bin rotate in the opposite direction; Integral link I (Integral): I represents the integral part, which is used to correct the static error of the system. The I part controls the controlled object by accumulating the accumulated amount of error. In the descent control, the I parameter is used to eliminate the long-term accumulated static error of the system to make the system more stable; Derivative link D (Derivative): D represents the differential part, which is used to adjust the response speed of the system. The D part controls the controlled object by detecting the rate of error change. In the bottom hanging warehouse control, the D parameter is used to control the speed of the encoder motor according to the trend of the angle change to avoid instability caused by too fast response; the P parameter controls the static response of the system, the I parameter controls the static stability of the system, and the D parameter controls the dynamic response of the system. By reasonably adjusting the size of P, I, and D parameters, precise control of the balanced bottom hanging warehouse can be achieved to keep it in a balanced state for lifting and lowering.
[0030] Based on the actual speed of the second encoder motor, the angle of the first point of the platform and the angle of the third point of the platform, the three-point platform is controlled to be adjusted to the target horizontal state. The process is: determine the target height and the height of the current platform, calculate the lifting height that the platform needs to adjust, and adjust the actual speeds of the first encoder motor and the third encoder motor in real time according to the actual speed of the second encoder motor, that is, adjust the lifting speed of the ropes in the three encoder motors so that the three-point platform can maintain a uniform speed in real time and be lifted to the target position; according to the angle of the first point of the platform, the pitch angle of the first point of the platform is adjusted by the first encoder motor, and the roll angle will not change during the adjustment process; according to the angle of the third point of the three-point platform, the roll angle of the third point of the three-point platform is adjusted by the third encoder motor; by adjusting the pitch angle of the first point of the three-point platform and the roll angle of the third point in real time, the platform is kept in a horizontal state during the lifting process, that is, the pitch angle and the roll angle are always 0, so as to avoid shaking and tilting of the three-point platform.
[0031] In summary, the platform lifting control system and method provided by the present invention include a sensor module, a control module, and three lifting drive modules corresponding to the three control points in the three-point platform one by one; the sensor module is used to obtain the real-time horizontal state of the three-point platform; the control module is used to generate a drive control instruction when the real-time horizontal state is not the target state; the lifting drive module is used to respond to the drive control instruction, control the three-point platform to adjust to the target horizontal state, so that the platform maintains horizontal lifting, thereby improving the safety, stability and flexibility of the platform in underground lifting.
[0032] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.
Claims
1. A platform lifting control system, characterized in that: Used to control the lifting of a three-point platform, the platform lifting control system includes a sensor module, a control module, and three lifting drive modules corresponding to the three control points of the three-point platform; The sensor module is used to obtain the real-time horizontal state of the three-point platform; The control module is used to generate a drive control instruction when the real-time horizontal state is not the target state; The lifting drive module is used to respond to the drive control instruction and control the three-point platform to adjust to a target horizontal state.
2. The platform lifting control system according to claim 1, characterized in that: The sensor module includes a gyroscope sensor; The gyro sensor is used to obtain the attitude data of the three-point platform in real time, and determine the horizontal state of the three-point platform based on the attitude data, wherein the attitude data includes a pitch angle, a roll angle and an angular velocity, and the angular velocity includes a roll angular velocity and a pitch angular velocity.
3. The platform lifting control system according to claim 2, characterized in that: The control module includes a control unit and a communication unit; The communication unit is used to receive the wireless control command, the posture data of the sensor module and the speed data of the lifting drive module, and send the wireless control command, posture data and speed data to the control unit; The control unit is used to parse the wireless control instruction, and after starting the lifting drive module, determine whether the real-time horizontal state of the three-point platform is the target state based on the posture data, and generate a drive control instruction when the real-time horizontal state is not the target state.
4. The platform lifting control system according to claim 3, characterized in that: The communication unit includes wireless wifi, a first serial port transparent transmission wireless, and a second serial port transparent transmission wireless; The wireless wifi is used to obtain wireless control instructions and feed the wireless control instructions back to the control module; The first serial port is wirelessly transparent and is used to receive the posture data of the sensor module and the speed data of the lifting drive module; The second serial port is wirelessly transparent and is used to send the posture data and speed data to the control module.
5. The platform lifting control system according to claim 3, characterized in that: The control unit includes a first control and a second control; The first control is used to receive the wireless control instruction of the communication unit, start the lifting drive module after parsing the wireless control instruction, and send the speed of the lifting drive module, the pitch angle, roll angle and angular velocity of the three-point platform to the second control; The second control is used to determine the real-time horizontal state of the three-point platform. When the real-time horizontal state is not the target state, the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform. The three-way pulse width modulation duty cycle is adjusted in real time by using a PID control algorithm based on the angle error. The actual speed of the lifting drive module and the angle of the three-point platform are determined based on the speed, posture data and the three-way pulse width modulation duty cycle of the lifting drive module. The angle error includes a first angle error, a second angle error and a third angle error. The first angle error is the angle error of the first point of the three-point platform, the second angle error is the angle error of the second point of the three-point platform, and the third angle error is the angle error of the third point of the three-point platform. The actual speed of the lifting drive module includes a first actual speed, a second actual speed and a third actual speed. The three-way pulse width modulation duty cycle includes a first pulse width modulation duty cycle, a second pulse width modulation duty cycle and a third pulse width modulation duty cycle. The angle of the three-point platform includes the angle of the first point, the angle of the second point and the angle of the third point.
6. The platform lifting control system according to claim 5, characterized in that: The lifting drive module includes a first encoding motor, a second encoding motor and a third encoding motor; The second encoding motor corresponds to the second point of the three-point platform, and is used to obtain a second actual speed, determine a target height, and adjust the lifting speed of the second point of the three-point platform based on the second actual speed and the target height, so that the three-point platform can be lifted and lowered at a uniform speed; The first encoding motor corresponds to the first point of the three-point platform, and is used to determine the first actual speed based on the second actual speed, adjust the lifting speed of the first point of the platform based on the first actual speed, obtain the angle of the first point of the three-point platform, and adjust the pitch angle of the first point of the platform based on the angle of the first point of the three-point platform; The third encoding motor corresponds to the third point position of the three-point platform, and is used to determine the third actual speed based on the second actual speed, adjust the lifting speed of the third point position of the platform based on the third actual speed, obtain the angle of the third point position of the three-point platform, and adjust the rolling angle of the third point position of the platform based on the angle of the third point position of the three-point platform.
7. A platform lifting control method, characterized in that: The method for controlling the lifting of a three-point platform is implemented by a platform lifting control system as claimed in any one of claims 1 to 6, comprising the following steps: Acquiring a real-time horizontal state of the three-point platform based on the sensor module; generating a driving control instruction based on the control module when the real-time horizontal state is not a target state; Based on the lifting drive module responding to the drive control instruction, the three-point platform is controlled to be adjusted to a target horizontal state.
8. The platform lifting control method according to claim 7, characterized in that: When the real-time horizontal state is not the target state, generating a drive control instruction includes: The real-time horizontal state of the three-point platform is determined based on the pitch angle, roll angle and angular velocity of the three-point platform acquired in real time. When the real-time horizontal state is not the target state, the angle error is determined based on the pitch angle, roll angle and angular velocity of the three-point platform, and the angle error is input into the PID controller to calculate the first pulse width modulation duty cycle, the second pulse width modulation duty cycle and the third pulse width modulation duty cycle.
9. The platform lifting control method according to claim 8, characterized in that: The step of responding to the driving control instruction and controlling the three-point platform to adjust to a target horizontal state comprises: Acquire the speeds of the first encoding motor, the second encoding motor and the third encoding motor of the lifting drive module in real time; Determine the voltage signal of the second encoder motor based on the duty cycle of the second pulse width modulation, and determine the actual speed of the second encoder motor based on the voltage signal of the second encoder motor and the speed of the second encoder motor, so that the lifting speed of the second point of the platform remains uniform; Determine the speed of the first encoder motor based on the actual speed of the second encoder motor, determine the voltage signal of the first encoder motor based on the first pulse width modulation duty cycle, and determine the actual speed of the first encoder motor and the angle of the first point of the platform based on the voltage signal of the first encoder motor, the pitch angle of the three-point platform and the speed of the first encoder motor; Determine the speed of the third encoder motor based on the actual speed of the second encoder motor, determine the voltage signal of the third encoder motor based on the third pulse width modulation duty cycle, and determine the actual speed of the third encoder motor and the angle of the third point of the platform based on the voltage signal of the third encoder motor, the roll angle of the three-point platform and the speed of the third encoder motor; The three-point platform is controlled to be adjusted to a target horizontal state based on the actual speed of the second encoder motor, the angle of the first point of the platform, and the angle of the third point of the platform, wherein the actual speed of the second encoder motor is consistent with the actual speed of the first encoder motor and the actual speed of the third encoder motor.
10. The platform lifting control method according to claim 8, characterized in that: The calculation formula of the first pulse width modulation duty cycle is: , in, is the pulse width modulation duty cycle of the first encoder motor, is the roll angle, is the rolling angular velocity, is the scale parameter, is the differential parameter; The calculation formula of the third pulse width modulation duty cycle is: , in, is the pulse width modulation duty cycle of the third encoder motor, is the pitch angle, is the pitch angular velocity, is the scale parameter, is the differential parameter.
Citation Information
Cited By
Control system and method of automatic lifting mechanism and intelligent lamp
CN120065846A
