A stepper motor adaptive torque regulation method based on position closed-loop control
Through the adaptive torque adjustment method based on position closed-loop control, the position sensor is used to monitor the number of missing steps and adjust the driving pulse, the problem of torque changes of stepper motor after long-term operation is solved, and the automatic adjustment of the motor is realized, avoiding vibration and Wear and wear extend the service life of the motor.
Patent Information
- Application Number
- CN202111419481.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-11-26
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2041-11-26
AI Technical Summary
After a long period of operation, the stepper motor has an increase in the output torque due to the volatility of solid lubricant and the reduction of the system electromagnetic efficiency. If the high torque is fixed in the initial stage, vibration and wear will aggravate, and the driving torque must be automatically adjusted according to the changes in resistance and load.
Adaptive torque adjustment method based on position closed-loop control is adopted, and the number of missing steps is monitored in real time by setting the position sensor, and the PWM duty cycle of the driving pulse is adjusted to realize adaptive torque adjustment of the stepper motor.
Automatically adjust the driving torque according to motor resistance and load changes, avoid high power waste and motor losses, extend service life, and is suitable for load changes in satellites and other fields.
Smart Images

Figure CN114337410B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of motor control, and in particular relates to an adaptive torque adjustment method for position-based closed-loop control of a stepping motor. Background Art
[0002] In the early stage of satellite space operation, the stepper motor drive system has low running resistance, and a small output torque can maintain its normal operation. In the middle and late stages of its life, after a long period of operation, the stepper motor will have an increase in the output torque required for normal rotation of the motor due to the volatilization of solid lubricants and the reduction of the system's electromagnetic efficiency. However, the output torque of the motor cannot be fixed at an excessively high level at the beginning of orbit entry, because although a large torque can ensure that the motor can continue to be driven in the later stages of its life, it consumes a lot of power and aggravates the vibration and wear of the motor. Therefore, it is necessary to automatically adjust the drive torque according to the changes in motor resistance and load.
[0003] In the stepper motor drive system of the position open-loop system, the torque can be indirectly controlled by detecting the current, but it is not easy to judge whether the torque is too large. Therefore, it is necessary to more directly collect the position loss of step situation in the position closed-loop system to judge whether the driving torque is sufficient. Summary of the invention
[0004] The output torque required by a stepper motor drive system increases after long-term operation. If the output torque of the motor is fixed at an excessively high value in the early stage, the vibration and wear of the motor will be aggravated. Therefore, the present invention proposes a stepper motor adaptive torque adjustment method based on position closed-loop control, which can automatically adjust the driving torque according to the changes in motor resistance and load.
[0005] A stepper motor adaptive torque adjustment method based on position closed-loop control comprises the following steps:
[0006] S1. Set the position sensor to monitor the number of lost steps of the stepper motor in real time;
[0007] S2. The control system adjusts the driving pulse of the stepper motor according to the number of lost steps to achieve adaptive torque adjustment of the stepper motor.
[0008] Preferably, the step S1 further comprises the following steps:
[0009] S11, setting a position sensor to form a closed-loop control system;
[0010] S12. Use a position sensor to monitor the number of lost steps of the stepper motor in real time.
[0011] Preferably, the position sensor is a rotary transformer.
[0012] Preferably, the rotary transformer is arranged on the side of the stepper motor, the rotatable part of the rotary transformer rotates synchronously with the stepper motor, and the rotation axis of the rotary transformer is the same as the rotation axis of the stepper motor.
[0013] Preferably, the number of lost steps is the difference between a theoretical position and an actual position of the stepping motor.
[0014] Preferably, the control system changes the drive current and thus the output torque by adjusting the PWM duty cycle value of the drive pulse.
[0015] Preferably, the step S2 is specifically as follows: when the control system determines that the driving torque of the stepper motor is insufficient according to the number of lost steps, the PWM duty cycle value of the driving pulse is increased to make the stepper motor reach a normal speed.
[0016] Preferably, the manifestations of insufficient driving torque include: during the acceleration process of the stepper motor, the increment of the number of lost steps per unit time exceeds the preset first allowable range A; during the uniform speed process of the stepper motor, the number of lost steps per unit time is greater than the second allowable range B.
[0017] Preferably, the first allowable range A is 1 / 5 of the theoretical acceleration of the stepper motor in the acceleration phase; and the second allowable range B is 1 / 20 of the theoretical value of the step angle of the stepper motor per unit time.
[0018] Preferably, by adjusting the first allowable range A and the second allowable range B, the monitoring sensitivity of the step-out caused by insufficient torque and the motor response speed can be changed.
[0019] In summary, the present invention can automatically adjust the driving torque according to the motor resistance and load changes, avoid the waste of high power and motor loss, and increase the service life of the motor. This solution can solve the torque change problem of the satellite drive system after long-term operation, and can also be applied to the occasions of loss of step and speed change caused by load changes, so that the stepper motor has greater versatility in other fields. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] Figure 1 A schematic flow chart of a stepping motor adaptive torque adjustment method based on position closed-loop control of the present invention;
[0021] Figure 2 A pulse signal for driving a motor using different duty cycles;
[0022] Figure 3 This is a graph showing the relationship between the duty cycle and the overall current consumption of the motor. DETAILED DESCRIPTION
[0023] The following will be combined with the embodiments of the present invention Figure 1 to Figure 3 , the technical solutions, structural features, objectives achieved and effects in the embodiments of the present invention are described in detail.
[0024] It should be noted that the drawings are in a very simplified form and use non-precise proportions. They are only used to conveniently and clearly assist in explaining the embodiments of the present invention, and are not used to limit the conditions for the implementation of the present invention. Therefore, they have no substantive technical significance. Any structural modification, change in proportional relationship or adjustment of size, without affecting the effects and purposes that can be achieved by the present invention, should still fall within the scope of the technical content disclosed by the present invention.
[0025] It should be noted that, in the present invention, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only the elements explicitly listed, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device.
[0026] A stepper motor adaptive torque regulation method based on position closed-loop control can be applied to driving situations with varying loads, such as Figure 1 As shown, the following steps are included:
[0027] S1. Set the position sensor to monitor the out-of-step situation in real time;
[0028] S11, setting a position sensor to form a closed-loop control system;
[0029] In order to realize adaptive torque regulation of the stepper motor, a position-based closed-loop control system is used for regulation. The closed-loop control system can return the controlled output to the input end in a certain way and exert a control influence on the input end.
[0030] When the stepper motor rotates normally, each control pulse drives the stepper motor to rotate a unit step angle; the embodiment of the present invention adopts a rotary transformer as a position sensor, and the rotary transformer is arranged on the side of the stepper motor, and the rotation axis of the rotary transformer is the same as the rotation axis of the stepper motor. By measuring the angular displacement of the rotary transformer, the step angle of the stepper motor can be obtained.
[0031] The control system sends out control pulses to drive the stepper motor to rotate. The rotary transformer can transmit the step angle data of the stepper motor to the control system. The control system analyzes the step angle data and sends out control pulses with appropriate duty cycle, thereby forming a closed-loop control system.
[0032] S12, using a rotary transformer to monitor the stepping motor's step loss in real time;
[0033] Driven by the control pulse, the stepper motor rotates, but because there is resistance in the rotation of the stepper motor and acceleration is required in the starting stage, there is a gap between the actual position of the stepper motor and the theoretical position. The difference between the theoretical position and the actual position is the number of lost steps. When the torque is greater than the resistance and the acceleration in the starting stage is met, the number of lost steps of the stepper motor is very small. When the output torque is less than the resistance and the acceleration in the starting stage is not met, the loss of steps will be very serious and the motor may even fail to drive or become blocked.
[0034] In this embodiment, the rotary transformer is used to measure the actual value of the step angle of the stepping motor, and the measured data is transmitted to the control system to be compared with the theoretical value of the step angle to obtain the number of lost steps.
[0035] S2, adjusting the driving pulse of the stepper motor according to the step-out situation to achieve adaptive torque adjustment of the stepper motor;
[0036] The output torque of the stepper motor is related to the current passing through the winding, and the winding current can be changed by adjusting the duty cycle value of the drive pulse, such as Figure 2 The following are pulse signals for motor driving using different duty cycles: Figure 3 Shown is a graph showing the relationship between the duty cycle and the overall current consumption of the motor.
[0037] The rotary transformer is used to monitor the out-of-step situation in real time, and then determine whether the output torque needs to be adjusted. When the rotary transformer detects that the stepper motor drive has a critical state of output torque vibration, the control system adjusts the PWM (pulse width modulation) duty cycle coefficient as follows:
[0038] When the control system detects the following situations through the rotating transformer, it is determined that the driving torque is insufficient: during the acceleration process of the stepper motor, the increment of the number of lost steps per unit time exceeds the pre-set first allowable range A (in this embodiment, 1 / 5 of the theoretical acceleration is used as the pre-set first allowable range A); during the uniform speed process of the stepper motor, the number of lost steps per unit time is greater than the second allowable range B (in this embodiment, 1 / 20 of the theoretical step angle of the stepper motor per unit time is used as the second allowable range B).
[0039] When the above-mentioned driving torque is insufficient, the control system increases the PWM duty cycle value of the driving pulse, that is, increases the driving current to increase the torque output, overcome the resistance and accelerate to the predetermined speed, so that the stepper motor reaches the normal speed and realizes the output torque adjustment of the adaptive load.
[0040] Furthermore, by adjusting the first allowable range A and the second allowable range B, the monitoring sensitivity of the step-out caused by insufficient torque and the motor response speed can be changed.
[0041] Although the content of the present invention has been described in detail through the above preferred embodiments, it should be appreciated that the above description should not be considered as a limitation of the present invention. After reading the above content, it will be apparent to those skilled in the art that various modifications and substitutions of the present invention will occur. Therefore, the protection scope of the present invention should be limited by the appended claims.
Claims
1. A stepper motor adaptive torque adjustment method based on position closed-loop control, characterized in that: The following steps are involved: S1. Set the position sensor to monitor the number of lost steps of the stepper motor in real time; S2, the control system adjusts the driving pulse of the stepper motor according to the number of lost steps to achieve adaptive torque adjustment of the stepper motor; The control system changes the driving current and thus the output torque by adjusting the PWM duty cycle value of the driving pulse; Wherein, the step S2 specifically comprises: when the control system determines that the driving torque of the stepping motor is insufficient according to the number of lost steps, increasing the PWM duty cycle value of the driving pulse to make the stepping motor reach a normal speed; The manifestations of insufficient driving torque include: During the acceleration process of the stepper motor, the increment of the number of lost steps per unit time exceeds a preset first allowable range A; During the uniform speed process of the stepper motor, the number of lost steps per unit time is greater than the second allowable range B; The first allowable range A is 1 / 5 of the theoretical acceleration of the stepper motor in the acceleration phase; the second allowable range B is 1 / 20 of the theoretical value of the step angle of the stepper motor per unit time.
2. A stepper motor adaptive torque adjustment method based on position closed-loop control as claimed in claim 1, characterized in that: The step S1 further comprises the following steps: S11, setting a position sensor to form a closed-loop control system; S12. Use a position sensor to monitor the number of lost steps of the stepper motor in real time.
3. A stepper motor adaptive torque adjustment method based on position closed-loop control as claimed in claim 1, characterized in that: A rotary transformer is used as the position sensor.
4. A stepper motor adaptive torque adjustment method based on position closed-loop control as claimed in claim 3, characterized in that: The rotary transformer is arranged on the side of the stepping motor, the rotatable part of the rotary transformer rotates synchronously with the stepping motor, and the rotation axis of the rotary transformer is the same as the rotation axis of the stepping motor.
5. The method for adaptive torque regulation of a stepping motor based on position closed-loop control according to claim 1, characterized in that: The number of lost steps is the difference between the theoretical position and the actual position of the stepper motor rotation.
6. A stepper motor adaptive torque adjustment method based on position closed-loop control as claimed in claim 1, characterized in that: By adjusting the first allowable range A and the second allowable range B, the monitoring sensitivity of the step-out caused by insufficient torque and the motor response speed are optimized.
Citation Information
Patent Citations
Rotation position control method and apparatus for switching reluctance motor
CN101359889A
Motor control method and motor control device
CN108631665A
Dual-auto-disturbance rejection control method for stepping motor type electrical-mechanical converter
CN110429878A
Motor driving method and system
CN111030526A
Driving circuit and driving method of stepping motor and electronic machine using the same
CN111628681A
