A permanent magnet synchronous motor position control method
By introducing feedforward control into the position control of permanent magnet synchronous motors and combined with position ring proportional control, the problem of large inertia of the entire container truck is solved, the position control accuracy and dynamic performance are improved, and the parking efficiency is improved.
Patent Information
- Application Number
- CN202210345009.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-03-31
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2042-03-31
AI Technical Summary
Due to the large inertia of the entire vehicle, it is difficult to control the parking accuracy by artificial operations, resulting in a long parking time and reducing lifting efficiency.
Feedforward control is introduced in the position control of permanent magnet synchronous motor. By using the given rate of change of position as compensation for velocity and acceleration, a feedforward-proportional control structure is formed in combination with the position ring proportional controller to improve the dynamic performance of position control.
It effectively improves the vehicle position control accuracy and dynamic performance, overcomes the problem of large inertia, reduces overshoot and oscillation, and improves parking efficiency.
Smart Images

Figure CN114679094B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of permanent magnet synchronous motors, and in particular relates to a position control method for a permanent magnet synchronous motor. Background Art
[0002] At present, the trucks carrying container trucks at ports are generally pure electric trucks. In order to improve the efficiency of lifting containers, the parking positioning accuracy of the trucks is required to be within 10 cm. The container trucks on the market generally adjust the position of the vehicle by accelerating and braking. Due to the large inertia of the vehicle, it is difficult to control the parking accuracy by manual acceleration and deceleration, and the parking time is long, which reduces the efficiency of container lifting.
[0003] There are also container trucks that use automatic driving. Their electric drive systems use permanent magnet synchronous motors. The control method is shown in the figure. Usually, a cascade control structure is adopted in which the inner loop is the current loop, the middle loop is the speed loop, and the outermost loop is the position loop.
[0004] The function of the position loop is to generate a corresponding speed command according to the form of the position command, so that the motor rotor position can accurately follow the command signal to reach the given position to achieve the function of rapid positioning. The position loop often uses position deviation and regulator to generate the corresponding control voltage. When the motor is just started, the rotor position deviates greatly from the command, and a large control voltage can be generated to make the current reach the limit value and start quickly with the maximum current. When approaching the given small deviation process, a reverse braking current command is generated to gradually reduce the speed to stop, and finally complete the positioning process.
[0005] The general position controller uses a proportional (P) controller, which amplifies the position deviation to generate a control voltage. Due to the heavy weight and large inertia of container trucks, a single proportional (P) control is prone to overshoot and cannot meet the transient response requirements of the position control process. Summary of the invention
[0006] The purpose of the present invention is to solve the shortcomings of the above-mentioned background technology, provide a permanent magnet synchronous motor position control method, propose to add feedforward control, through which the rate of change of the position given quantity is used as compensation for the speed and acceleration given quantities, overcome the problem of large inertia of the whole vehicle, and improve the dynamic performance of position control.
[0007] The technical solution adopted by the present invention is: a permanent magnet synchronous motor position control method, characterized in that it includes the following steps:
[0008] Step 1, obtaining the real-time angle and speed of the permanent magnet synchronous motor rotor through a position and speed detector, inputting the difference between the reference angle and the measured angle into a position loop proportional controller, and inputting the reference angle into a feedforward controller at the same time, and adding the output value of the position loop proportional controller to the output value of the feedforward controller to obtain an input reference value of the speed loop;
[0009] Step 2: In the speed loop, the difference between the input reference value and the measured speed is input into the speed loop proportional integral controller, and the output value of the speed loop proportional integral controller will be used as the input reference value of the q-axis current loop;
[0010] Step 3, sampling to obtain the phase current value of the permanent magnet synchronous motor and the real-time angle of the permanent magnet synchronous motor rotor, and obtaining the q-axis current reference value and the d-axis current reference value through Clarke and Park transformation; the d-axis current reference value and the measured value are input into the d-axis PI controller as the difference, and the q-axis current reference value and the measured value are input into the q-axis PI controller as the difference;
[0011] Step 4, perform inverse Clarke transformation on the output values of the d-axis PI controller and the q-axis PI controller in step 3 and the real-time angle of the permanent magnet synchronous motor rotor to obtain the voltage value of the αβ plane, and input it into the SVPWM module to obtain the duty cycle of controlling the six-phase inverter, thereby realizing closed-loop control of the permanent magnet synchronous motor.
[0012] In the above technical solution, in step 1, the feedforward controller and the position loop proportional controller are combined to form a position loop control structure under feedforward-proportional control to improve the dynamic process of position control.
[0013] In the above technical solution, in step 1, the difference between the reference angle and the measured angle is calculated by the position loop proportional controller using a proportional gain factor, and then added to the reference angle by the calculation result of the feedforward closed-loop function of the feedforward controller and calculated by the speed closed-loop function. The calculation result is the q-axis current reference value.
[0014] In the above technical solution, in step 1, since the speed loop bandwidth is usually much higher than the position loop, the speed closed loop transfer function G n (s) can be expressed as:
[0015]
[0016] Where: T ω is the inverse of the speed loop bandwidth, K ω is the proportional gain of the speed loop bandwidth.
[0017] In the above technical solution, in step 1, under feedforward-proportional control, the closed-loop transfer function of the position loop proportional controller is expressed as:
[0018]
[0019] Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller.
[0020] In the above technical solution, in step 1, the error transfer function of the position loop is:
[0021]
[0022] Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller.
[0023] In the above technical solution, in step 1, when the numerator is 0, the error of the system following the signal is 0, and the transfer function of the feedforward controller is:
[0024]
[0025] Among them, A1 and A2 are velocity feedforward compensation term and acceleration feedforward compensation term respectively.
[0026] In the above technical solution, in step 1, the speed feedforward compensation of the transfer function of the feedforward controller is:
[0027]
[0028] Among them, K w is the proportional gain of the speed loop bandwidth.
[0029] In the above technical solution, in step 1, the acceleration feedforward compensation of the transfer function of the feedforward controller is:
[0030]
[0031] Among them, T w K is the inverse of the speed loop bandwidth; w is the proportional gain of the speed loop bandwidth.
[0032] The present invention also provides a computer-readable storage medium, characterized in that: the computer-readable storage medium stores a permanent magnet synchronous motor position control method program, and when the permanent magnet synchronous motor position control method program is executed by a vehicle controller, the steps of the permanent magnet synchronous motor position control method in the above technical solution are implemented.
[0033] The beneficial effects of the present invention are as follows: Due to the heavy weight and large inertia of container trucks, it is difficult to control the parking position accuracy of the whole vehicle by manually operating the accelerator and brake. When a general motor position controller is used, that is, the position deviation is amplified to generate a control voltage, overshoot and oscillation are prone to occur. In order to meet the transient response requirements, this patent proposes to add feedforward control, through which the rate of change of the position given quantity is used as compensation for the speed and acceleration given quantity, to overcome the problem of large inertia of the whole vehicle and improve the dynamic performance of position control. In order to solve the problem of position control of container trucks, a feedforward controller is introduced into the motor position control proportional (P) controller to improve the dynamic process of position control. Acceleration compensation is used to compensate for the large inertia of the whole vehicle. This compensation can effectively improve the position control accuracy and dynamic performance of the whole vehicle. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Figure 1 is a schematic diagram of the present invention;
[0035] Figure 2 It is a block diagram of the position loop control structure under the feedforward-proportional control of the present invention. DETAILED DESCRIPTION
[0036] The present invention will be further described in detail below in conjunction with the accompanying drawings and specific embodiments to facilitate a clear understanding of the present invention, but they do not constitute a limitation on the present invention.
[0037] like Figure 1 As shown, the present invention provides a permanent magnet synchronous motor position control method, which is characterized by comprising the following steps:
[0038] Step 1, the real-time angle of the permanent magnet synchronous motor rotor is transmitted to the position and speed detector through the position sensor; the angle and speed of the permanent magnet synchronous motor rotor are obtained through the position and speed detector; the position and speed detector sends the measured angle to the position loop proportional controller; the difference between the reference angle and the measured angle is input to the position loop proportional controller, and the reference angle is simultaneously input to the feedforward controller, and the output value of the position loop proportional controller is added to the output value of the feedforward controller to obtain the input reference value of the speed loop;
[0039] Step 2, the position and speed detector sends the measured speed to the speed loop; in the speed loop, the input reference value and the measured speed are input into the speed loop proportional integral controller as a difference, and the output value of the speed loop proportional integral controller will be used as the input reference value of the q-axis current loop;
[0040] Step 3, sampling to obtain the phase current value of the permanent magnet synchronous motor and the real-time angle of the permanent magnet synchronous motor rotor, and obtaining the q-axis current reference value and the d-axis current reference value through Clarke and Park transformation; the d-axis current reference value and the measured value are input into the d-axis PI controller as a difference, and the q-axis current reference value and the input reference value of the q-axis current loop are input into the q-axis PI controller as a difference;
[0041] Step 4, perform inverse Clarke transformation on the output values of the d-axis PI controller and the q-axis PI controller in step 3 and the real-time angle of the permanent magnet synchronous motor rotor to obtain the voltage value of the αβ plane, input it into the SVPWM module to obtain the duty cycle of controlling the six-phase inverter and output it to the three-phase inverter, and realize closed-loop control of the permanent magnet synchronous motor through the three-phase inverter.
[0042] In the above technical solution, in step 1, the feedforward controller and the position loop proportional controller are combined to form a position loop control structure under feedforward-proportional control to improve the dynamic process of position control.
[0043] In the above technical solution, in step 1, the difference between the reference angle and the measured angle is calculated by the position loop proportional controller using a proportional gain factor, and then added to the reference angle by the calculation result of the feedforward closed-loop function of the feedforward controller and calculated by the speed closed-loop function. The calculation result is the q-axis current reference value.
[0044] In the above technical solution, in step 1, since the speed loop bandwidth is usually much higher than the position loop, the speed closed loop transfer function G n (s) can be expressed as:
[0045]
[0046] Where: T ω is the inverse of the speed loop bandwidth, K ω is the proportional gain of the speed loop bandwidth.
[0047] In the above technical solution, in step 1, under feedforward-proportional control, the closed-loop transfer function of the position loop proportional controller is expressed as:
[0048]
[0049] Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller.
[0050] In the above technical solution, in step 1, the error transfer function of the position loop is:
[0051]
[0052] Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller.
[0053] In the above technical solution, in step 1, when the numerator is 0, the error of the system following the signal is 0, and the transfer function of the feedforward controller is:
[0054]
[0055] Among them, A1 and A2 are velocity feedforward compensation term and acceleration feedforward compensation term respectively.
[0056] In the above technical solution, in step 1, the speed feedforward compensation of the transfer function of the feedforward controller is:
[0057]
[0058] Among them, K w is the proportional gain of the speed loop bandwidth.
[0059] In the above technical solution, in step 1, the acceleration feedforward compensation of the transfer function of the feedforward controller is:
[0060]
[0061] Among them, T w K is the inverse of the speed loop bandwidth; w is the proportional gain of the speed loop bandwidth.
[0062] In order to solve the problem of position control of container trucks, this patent introduces a feedforward controller into the motor position control proportional (P) controller to improve the dynamic process of position control. The block diagram of the position loop control structure under the feedforward-proportional control is as follows: Figure 2 As shown. F (s) is the feedforward closed loop function, K p is the proportional magnification factor, G n (s) is the speed closed loop function.
[0063] Since the speed loop bandwidth is usually much higher than the position loop bandwidth, the speed closed loop function can be expressed as:
[0064]
[0065] Where: T ω is the inverse of the speed loop bandwidth, K ω is the proportional gain of the speed loop bandwidth.
[0066] Under feedforward-proportional control, the closed-loop function of the position loop can be expressed as:
[0067]
[0068] The error transfer function of the position loop is:
[0069]
[0070] From formula 3, we can see that when the numerator is 0, the error of the system following the signal is 0, and the transfer function of the feedforward controller can be obtained as:
[0071]
[0072] In the formula
[0073] They are velocity feedforward compensation term and acceleration feedforward compensation term respectively. Acceleration compensation is the compensation for the large inertia of the whole vehicle. By compensating for this term, the position control accuracy and dynamic performance of the whole vehicle can be effectively improved.
[0074] Due to the heavy weight and high inertia of container trucks, it is difficult to control the parking position accuracy of the whole vehicle by manually operating the accelerator and brake. The general motor position controller is used, that is, the position deviation is amplified to generate the control voltage, which is prone to overshoot and oscillation. In order to meet the transient response requirements, this patent proposes to add feedforward control, through which the rate of change of the position given quantity is used as compensation for the speed and acceleration given quantity, to overcome the problem of large inertia of the whole vehicle and improve the dynamic performance of position control.
[0075] The present invention also provides a computer-readable storage medium, characterized in that: a permanent magnet synchronous motor position control method program is stored on the computer-readable storage medium, and when the permanent magnet synchronous motor position control method program is executed by a vehicle controller, the steps of the permanent magnet synchronous motor position control method described in the above technical solution are implemented.
[0076] Those skilled in the art will appreciate that embodiments of the present invention may be provided as methods, systems, or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0077] The present invention is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0078] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0079] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0080] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention rather than to limit its protection scope. Although the present invention has been described in detail with reference to the above embodiments, ordinary technicians in the field should understand that after reading the present invention, those skilled in the art can still make various changes, modifications or equivalent substitutions to the specific implementation methods of the invention, but these changes, modifications or equivalent substitutions are all within the protection scope of the pending claims of the invention.
Claims
1. A permanent magnet synchronous motor position control method, Features: The following steps are involved: Step 1, obtaining the real-time angle and speed of the permanent magnet synchronous motor rotor through a position and speed detector, inputting the difference between the reference angle and the measured angle into a position loop proportional controller, and inputting the reference angle into a feedforward controller at the same time, and adding the output value of the position loop proportional controller to the output value of the feedforward controller to obtain an input reference value of the speed closed loop; The error transfer function of the position loop is: Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller; Under feedforward-proportional control, the closed-loop transfer function of the position loop proportional controller is expressed as: Among them, K p is the proportional magnification factor, G n (s) is the speed closed-loop transfer function, G F (s) Transfer function of the feedforward controller; When the numerator is 0, the error of the system following the signal is 0, and the transfer function of the feedforward controller is: Among them, A 1 and A 2 They are velocity feedforward compensation term and acceleration feedforward compensation term respectively; The transfer function of the feedforward controller for speed feedforward compensation is: Among them, K w is the proportional gain of the speed loop bandwidth; The transfer function of the feedforward controller for acceleration feedforward compensation is: Among them, T w K is the inverse of the speed loop bandwidth; w is the proportional gain of the speed loop bandwidth; Step 2: In the speed closed loop, the difference between the input reference value and the measured speed is input into the speed closed loop proportional integral controller, and the output value of the speed closed loop proportional integral controller will be used as the input reference value of the q-axis current loop; Step 3, sampling to obtain the phase current value of the permanent magnet synchronous motor and the real-time angle of the permanent magnet synchronous motor rotor, and obtaining the q-axis current reference value and the d-axis current reference value through Clarke and Park transformation; the d-axis current reference value and the measured value are input into the d-axis PI controller as the difference, and the q-axis current reference value and the measured value are input into the q-axis PI controller as the difference; Step 4, perform inverse Clarke transformation on the output values of the d-axis PI controller and the q-axis PI controller in step 3 and the real-time angle of the permanent magnet synchronous motor rotor to obtain the voltage value of the αβ plane, and input it into the SVPWM module to obtain the duty cycle of controlling the six-phase inverter, thereby realizing closed-loop control of the permanent magnet synchronous motor.
2. A permanent magnet synchronous motor position control method according to claim 1, Features: In step 1, the feedforward controller and the position loop proportional controller are combined to form a position loop control structure under feedforward-proportional control to improve the dynamic process of position control.
3. A permanent magnet synchronous motor position control method according to claim 2, Features: In step 1, the difference between the reference angle and the measured angle is calculated by the position loop proportional controller using a proportional gain factor, and then added to the reference angle by the calculation result of the feedforward closed-loop function of the feedforward controller and calculated by the speed closed-loop function. The calculation result is the q-axis current reference value.
4. A permanent magnet synchronous motor position control method according to claim 1, Features: Speed closed loop transfer function G n (s) is expressed as: Where: T ω K is the inverse of the speed loop bandwidth, ω is the proportional gain of the speed loop bandwidth.
5. A computer-readable storage medium, Features: The computer-readable storage medium stores a permanent magnet synchronous motor position control method program, and when the permanent magnet synchronous motor position control method program is executed by a vehicle controller, the steps of the permanent magnet synchronous motor position control method as described in any one of claims 1 to 4 are implemented.
Citation Information
Cited By
Acceleration continuous real-time position planning control method
CN116382361A
A real-time position planning and control method with continuous acceleration
CN116382361B
