High-stability solar wing drive mechanism control system based on linear active disturbance rejection

Through the combination of linear self-immunity control strategy and linear expansion state observer, the problems of slow response speed and difficult parameter adjustment in the permanent magnet synchronous motor drive system are solved, and higher stability and immunity are achieved , the speed stability is significantly improved.

CN118672123BActive Publication Date: 2024-11-26NANJING UNIV OF AERONAUTICS & ASTRONAUTICS
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410693053.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-05-30
Publication Date
2024-11-26
Estimated Expiration
2044-05-30

AI Technical Summary

Technical Problem

Traditional PI control is difficult to effectively resist nonlinear interference in permanent magnet synchronous motor drive system, and the response speed is low and parameter adjustment is inconvenient, resulting in insufficient stability and immunity of the solar wing drive system.

Method used

Using a linear self-immune disturbance control strategy, by establishing a closed-loop SADA model and designing a linear expansion state observer, the unknown perturbation of the system is observed and compensated in real time, and combined with PI control, the performance of the speed loop and current loop is optimized.

Benefits of technology

The robustness and stability of the system are improved, the speed stability reaches the order of 0.001, the response speed is faster, and the disturbance can be better suppressed, and the speed stability reaches 5.65×10-3 (3σ).

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118672123B_ABST
    Figure CN118672123B_ABST
Patent Text Reader

Abstract

The invention discloses a high-stability solar wing drive mechanism control system based on linear anti-disturbance control, and specifically relates to the technical field of solar wing drive mechanism control. The control system adopts a permanent magnet synchronous motor as an executive component of SADA, forms an electromechanical interface between a solar wing and a satellite body and is installed on the satellite body, and an SADA output shaft is directly connected to a solar wing rotation shaft; the control system also includes an outer speed loop, an inner current loop, a motor driver and a solar wing load, and uses a motor angle encoder to obtain an actual rotation speed through speed resolution, and the error between the actual rotation speed and a reference rotation speed is used as the input of a speed controller to realize an outer loop closure; the inner loop uses a current sensor to sample and obtain a three-phase current, and uses the output of the speed controller as the input of the current loop, and then uses the motor driver to make the actual voltage applied to the permanent magnet synchronous motor the terminal voltage given by the control link, and then the permanent magnet synchronous motor drives the solar wing load to rotate.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of solar wing drive mechanism control, and in particular to a high-stability solar wing drive mechanism control system based on linear self-disturbance rejection. Background Art

[0002] With the widespread use of small satellites, more and more payloads that work for a long time and consume a lot of power, such as communications and navigation, are installed on small satellites. However, driving flexible accessories such as solar panels by motors will seriously affect the pointing accuracy of the payload. Therefore, it is necessary to study a drive system (SADA) that can perform high-precision speed tracking so that the payload always points to the mission direction. The key to achieving stable operation of the SADA system is to perform high-precision speed control on the motor. Factors that affect control accuracy include the motor itself, control algorithm, etc.

[0003] In terms of drive source, stepper motors will inevitably generate vibrations during operation, while permanent magnet synchronous motors (PMSMs) are directly connected to the load, omitting the intermediate transmission mechanism and improving reliability. With the development of digitalization of electrical systems, PMSM drive technology has made great progress.

[0004] In order to improve the stability requirements of the SADA system, "A TS fuzzy composite controller for a high-stability sailboard drive system [J]. Journal of Astronautics, 2016, 37 (03): 307-315" proposed a control method combining TS fuzzy control and correction network to reduce the excitation effect of SADA on the flexible mode of the solar sailboard, reduce the overshoot and nonlinear friction of the system, and effectively suppress the vibration of the solar sailboard. "Modeling for solar array drive assembly system and compensating for the rotating speed fluctuation. Aerospace Science and Technology, 84, 131-142" studied the fluctuation compensation problem of speed and vibration suppression through sliding mode control (SMC) and input shaping (IS) technology, designed a coordinated compensation scheme, and found that the system performance using the SMC method and IS technology is significantly better than the non-vibration suppression method. "Active control technology for flexible solar array disturbance suppression. Aerospace Science and Technology, 106, 106148" adopted a phase compensation control strategy for PMSM driving large inertia flexible loads to achieve high stability control of the solar wing driven by the Gaofen-7 satellite. "Modeling and simulation of solar array drive assembly disturbance driving a flexible load. Applied Mechanics and Materials, 565, 67-73" mainly studies the disturbance characteristics of SADA driving flexible loads. "Sliding mode servo control of large flexible solar cell wing drive device for space station[J]. Vibration and Shock, 2020, 39(03): 211-218+288" Aiming at the high-stability solar tracking drive control problem of large flexible solar cell wing of space station, a nonlinear fast terminal sliding mode servo control scheme with motion planning and vibration suppression is proposed, which can achieve higher driving speed stability and better tracking performance.

[0005] The performance of the speed loop will affect the performance of the permanent magnet synchronous motor speed control system. Any disturbance may affect the performance of the speed loop, so the control of the speed loop is very necessary. The traditional double closed-loop PI control is difficult to effectively resist the nonlinear interference in the PMSM, while the active disturbance rejection control can not only balance the rapidity and overshoot, but also provide higher control accuracy and anti-interference ability [8]. Among them, a linear active disturbance rejection control (LADRC) method was proposed. This method simplifies the structure of the active disturbance rejection controller and reduces the shortcomings of the traditional active disturbance rejection controller with many parameters and difficult setting. However, it still has the problems of low response speed and inconvenient parameter adjustment. Summary of the invention

[0006] Based on the above background, the present invention takes driving flexible solar wings as the research object and improving the speed stability as the research goal. A SADA driving model is established, a linear anti-disturbance control strategy is designed, and the effect is compared with PI and nonlinear anti-disturbance control algorithms on the Matlab / Simulink platform. The current loop adopts PI control. The simulation results show that the linear anti-disturbance control algorithm can improve the robustness of the system, and the stability of the SADA system reaches the order of 0.001, so as to solve the problems raised in the background technology.

[0007] The present invention provides the following technical solutions: a high-stability solar wing drive mechanism control system based on linear self-disturbance rejection, the control system adopts a permanent magnet synchronous motor as an actuator of SADA, forms an electromechanical interface between the solar wing and the satellite body and is installed on the satellite body, and the SADA output shaft is directly connected to the solar wing rotation shaft;

[0008] The control system also includes an outer speed loop, an inner current loop, a motor driver and a solar wing load. The motor angle encoder is used to obtain the actual speed through speed resolution, and the error between the actual speed and the reference speed is used as the input of the speed controller to realize the outer loop closure. The inner loop uses the current sensor to sample the three-phase current, and the output of the speed controller is used as the input of the current loop. Then, the motor driver is used to make the actual voltage applied to the permanent magnet synchronous motor the terminal voltage given by the control link, and then the permanent magnet synchronous motor drives the solar wing load to rotate.

[0009] A closed-loop SADA model with a permanent magnet synchronous motor as the driving source and the dynamic equations of the flexible solar wing load coupling are established; considering the influence of the flexible solar wing, the speed loop of the permanent magnet synchronous motor driving the solar wing load is controlled by the improved PI control; in order to achieve a balance between dynamic performance and stability of PI control, a linear active disturbance rejection controller is designed to observe and compensate for unknown disturbances to the system in real time, and ultimately suppress the disturbance.

[0010] Preferably, the closed-loop SADA model modeling steps are as follows:

[0011] Assume that the permanent magnet flux linkage of the permanent magnet synchronous motor rotor unchanged, using a surface-mounted permanent magnet synchronous motor, that is, the d-axis inductance L d and q-axis inductance L q The size is equal, and the mathematical model of the permanent magnet synchronous motor in the dq two-phase rotating coordinate system is expressed as:

[0012]

[0013] Where: u d 、u q Represents the d and q axis components of the stator voltage; represents the permanent magnet flux; ω represents the rotor mechanical angular velocity; R s represents the stator resistance; i d 、i q represents the d and q axis components of the stator current; p represents the number of motor pole pairs; L represents the inductance of the synchronous motor; J represents the moment of inertia; T L Indicates load torque; T e Represents electromagnetic torque.

[0014] Preferably, the driving torque of the solar wing is the load torque T in formula (1): L , the motor speed and angle are equal to those of the solar wing. Considering the coupling effect of the solar wing's flexible vibration and the star's drive, the solar wing dynamic equation is expressed as:

[0015]

[0016] Where: J s represents the moment of inertia of the solar wing around the rotation axis; F represents the coupling coefficient of the rotation and flexibility of the solar wing; θ represents the mechanical angle of the solar wing; q represents the modal coordinates of the solar wing; K represents the modal stiffness; D represents the modal damping; ω f represents the modal frequency; ζ represents the damping coefficient.

[0017] Preferably, when designing the speed loop, the influence of the current loop is not considered, and the speed loop in the permanent magnet synchronous motor driving the solar wing load is constructed using PI control.

[0018] The first link is the speed loop PI regulator Feedback speed ω r and given speed The difference between them is used as the input of the speed loop PI regulator, and the output of the speed loop PI regulator is the given value of the current loop. The influence of the current loop is not considered at this time; the second link is the torque and current conversion part in the permanent magnet synchronous motor The third link is the transfer function of the solar wing load The solar panels are driven to rotate by permanent magnet synchronous motors;

[0019] The closed-loop transfer function of the speed loop PI control is:

[0020]

[0021] Where: r Indicates the actual speed; Indicates the reference speed; k p represents the proportional coefficient; τ represents the integral time constant.

[0022] Preferably, considering that PI control achieves a balance between dynamic performance and stability, the total disturbance d e With solar wing load The actual output speed ω r The linear state observer LESO estimates the system state z1 and the expanded state z2 in real time. z1 is used to track the given speed. The linear error feedback control law converts the system states estimated by LESO into proportional controller K p The virtual control quantity u0 is obtained after disturbance compensation b0. It is the total control quantity output by the speed loop LADRC controller;

[0023] According to the moment equation in formula (1), it can be rewritten as follows:

[0024]

[0025] Where: d e represents the internal and external disturbances of the system; b e Indicates the actual gain of the moment of inertia, which is 1 / J;

[0026] Define angular velocity ω r As the state variable x1, the disturbance is expanded a(t) into a new state variable x2, b0 is used as the system control gain, and the state equation of the permanent magnet synchronous motor speed is expressed as:

[0027]

[0028] According to the state equation, a linear extended state observer is established:

[0029]

[0030] Where: z1 represents the tracking signal of x1; e1 represents the error signal between z1 and x1; z2 represents the observation signal of the total disturbance a(t); β1 and β2 represent the gains of LESO, and their values ​​are related to the bandwidth of the observer;

[0031] The control input adopts proportional control, K p is the proportionality coefficient, then

[0032]

[0033] Where: Represents the input given signal; ω r Indicates feedback signal;

[0034] Combining equations (5) and (7), the equation after disturbance compensation is:

[0035]

[0036] The present invention has the following advantages:

[0037] The present invention uses PMSM as the driving source for closed-loop control. However, due to the flexibility of the solar panels, the bandwidth capacity of the SADA system is limited. It is difficult for traditional PI control to increase the stiffness of the system by increasing the gain, resulting in a weakened ability of the system to suppress speed fluctuations. To address this problem, the present invention adopts a linear anti-disturbance control method. The linear anti-disturbance control can better balance the steady-state performance and dynamic performance of the system. On the Matlab / Simulink platform, the linear anti-disturbance control algorithm is compared with traditional PI control and nonlinear anti-disturbance control. The simulation results show that the linear anti-disturbance control has a faster response speed and can better suppress SADA system disturbances. The speed stability reaches 5.65×10 -3 (3σ). BRIEF DESCRIPTION OF THE DRAWINGS

[0038] Figure 1 The SADA drive system control block diagram provided by the present invention;

[0039] Figure 2 The speed loop control block diagram provided by the present invention;

[0040] Figure 3 The PI control Bode diagram provided by the present invention;

[0041] Figure 4 The structural block diagram of the speed loop LADRC control provided by the present invention;

[0042] Figure 5 The Matlab / Simulink simulation model provided by the present invention;

[0043] Figure 6 A comparison diagram of the speed curve provided by the present invention;

[0044] Figure 7 A comparison diagram of the stable speed curve provided by the present invention;

[0045] Figure 8 A stator current curve diagram provided by the present invention;

[0046] Fig. 9 This is a graph of the motor output torque provided by the present invention. DETAILED DESCRIPTION

[0047] The following is a description of the implementation of the present invention by specific embodiments. People familiar with the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0048] SADA is the electromechanical interface between the solar array and the satellite body, connecting the solar wing and the overall structure of the satellite and driving the solar wing to rotate relative to the satellite body according to a certain rule. The driving principle of the solar tracking drive system is that when the solar wing is basically oriented to the sun, SADA will enter the tracking mode, at which time the solar wing will rotate continuously at an ultra-low speed of about the angular velocity of the sun-synchronous orbit satellite.

[0049] The motor is the core component of SADA. In order to reduce the influence of the disturbance torque of the drive system, the present invention adopts a permanent magnet synchronous motor as the executive component of SADA to achieve smooth driving of the solar wing. The PMSM drive system uses an encoder to measure the angle and calculate the speed, and at the same time, the motor current is sampled at high speed and high precision through a high-precision current sampling circuit, thereby achieving dual closed-loop control of speed and current. The schematic diagram of the SADA drive system is shown in Figure 1.

[0050] This embodiment provides a high-stability solar wing drive mechanism control system based on linear self-disturbance rejection. The control system uses a permanent magnet synchronous motor as an actuator of SADA to form an electromechanical interface between the solar wing and the satellite body and is installed on the satellite body. The SADA output shaft is directly connected to the solar wing rotation shaft.

[0051] The control system also includes an outer speed loop, an inner current loop, a motor driver and a solar wing load. The motor angle encoder is used to obtain the actual speed through speed resolution, and the error between the actual speed and the reference speed is used as the input of the speed controller to realize the outer loop closure. The inner loop uses the current sensor to sample the three-phase current, and the output of the speed controller is used as the input of the current loop. Then, the motor driver is used to make the actual voltage applied to the permanent magnet synchronous motor the terminal voltage given by the control link, and then the permanent magnet synchronous motor drives the solar wing load to rotate.

[0052] A closed-loop SADA model with a permanent magnet synchronous motor as the driving source and the dynamic equations of the flexible solar wing load coupling are established; considering the influence of the flexible solar wing, the speed loop of the permanent magnet synchronous motor driving the solar wing load is controlled by the improved PI control; in order to achieve a balance between dynamic performance and stability of PI control, a linear active disturbance rejection controller is designed to observe and compensate for unknown disturbances to the system in real time, and ultimately suppress the disturbance.

[0053] The steps for building a closed-loop SADA model are as follows:

[0054] According to the principle of SADA system driving solar panels, it can be known that the motor is driven at ultra-low speed

[13] . Therefore, the present invention adopts a permanent magnet synchronous motor vector control scheme based on rotor magnetic field orientation to drive the SADA system to ensure high-performance magnetic field positioning. PMSM vector control usually adopts a mathematical model in a coordinate system. Assume that the permanent magnet flux of the permanent magnet synchronous motor rotor is unchanged, using a surface-mounted permanent magnet synchronous motor, that is, the d-axis inductance L d and q-axis inductance L q The size is equal, and the mathematical model of the permanent magnet synchronous motor in the dq two-phase rotating coordinate system is expressed as:

[0055]

[0056] Where: u d 、u q Represents the d and q axis components of the stator voltage; represents the permanent magnet flux; ω represents the rotor mechanical angular velocity; R s represents the stator resistance; i d 、i q represents the d and q axis components of the stator current; p represents the number of motor pole pairs; L represents the inductance of the synchronous motor; J represents the moment of inertia; T L Indicates load torque; T e Represents electromagnetic torque.

[0057] SADA is an electromechanical component that connects the solar wing to the satellite body. It is installed on the satellite body. The output shaft of SADA is directly connected to the rotation axis of the solar wing. Therefore, when a permanent magnet synchronous motor is used to drive SADA, the driving torque of the solar wing is the load torque T in formula (1): L , the motor speed and angle are equal to the solar wing speed and angle; because the flexibility of the solar wing is very obvious, it is easy to cause the system to vibrate. The vibration that affects the flexibility of the SADA system is mainly the first-order torsional mode, and the influence of other high-order modes on the system is relatively small. For the convenience of analysis, only the first-order torsional mode of the drive system is considered. Considering the coupling effect of the solar wing's flexible vibration and the star on the drive, the solar wing dynamic equation is expressed as:

[0058]

[0059] Where: J s represents the moment of inertia of the solar wing around the rotation axis; F represents the coupling coefficient of the rotation and flexibility of the solar wing; θ represents the mechanical angle of the solar wing; q represents the modal coordinates of the solar wing; K represents the modal stiffness; D represents the modal damping; ω f represents the modal frequency; ζ represents the damping coefficient.

[0060] Affected by the flexible solar wing, the system bandwidth is limited. It is difficult to increase the stiffness of the system by increasing the gain when using PI control in the speed loop, which leads to a weakened ability to suppress speed fluctuations. Therefore, when facing a SADA drive system with solar wings, PI control is difficult to achieve a good control effect. When designing the speed loop, the influence of the current loop is not considered. The control block diagram of the speed loop using PI control in the permanent magnet synchronous motor driving the solar wing load is as follows: Figure 2 shown.

[0061] The first link is the speed loop PI regulator Feedback speed ω r and given speed The difference between them is used as the input of the speed loop PI regulator, and the output of the speed loop PI regulator is the given value of the current loop. The influence of the current loop is not considered at this time; the second link is the torque and current conversion part in the permanent magnet synchronous motor The third link is the transfer function of the solar wing load The solar panels are driven to rotate by permanent magnet synchronous motors;

[0062] Depend on Figure 2 It can be seen that the closed-loop transfer function of the speed loop PI control is:

[0063]

[0064] Where: r Indicates the actual speed; Indicates the reference speed; k p represents the proportional coefficient; τ represents the integral time constant.

[0065] The frequency characteristics of the PI-controlled SADA system are shown in the Bode diagram. Figure 3 As shown. Figure 3 It can be seen that the oscillation frequency of the solar wing is close to the frequency bandwidth of the speed loop. If K is increased continuously p The value will cause the bandwidth frequency of the control system to couple with the natural frequency of the system, thus causing resonance. pIt is difficult to achieve the effect of suppressing vibration by increasing the system damping. In addition, the phase margin of the system is low, only 9 degrees, and the system is very prone to instability. Therefore, it is difficult for PI control to achieve a balance between dynamic performance and stability, and there is no good control effect.

[0066] The permanent magnet synchronous motor control system is a complex system with many variables, strong coupling, and nonlinearity. Therefore, in the actual speed control process, the motor is subject to many disturbance sources, including motor parameter changes, external disturbances, friction coefficient, etc. In addition, the speed loop performance is a key indicator for measuring the performance of the permanent magnet synchronous motor speed control system. It is difficult to achieve high-performance speed control using traditional PI controllers, but the self-anti-disturbance technology can observe and compensate for unknown disturbances to the system in real time, and ultimately suppress the disturbance, thereby improving the system's anti-disturbance ability.

[0067] The linear active disturbance rejection controller is an improvement on the traditional PID controller. LADRC retains the characteristics of PID control. In speed control, LADRC has the specific advantage of timely estimating and compensating all uncertainties without the need for precise mathematical model expressions.

[0068] LADRC is mainly composed of a linear extended state observer (LESO) and a linear error feedback control law. In the first-order speed loop system, the total disturbance d e With solar wing load The actual output speed ω r The linear state observer LESO estimates the system state z1 and the expanded state z2 in real time. z1 is used to track the given speed. The linear error feedback control law converts the system states estimated by LESO into proportional controller K p The virtual control quantity u0 is obtained after disturbance compensation b0. is the total control quantity output by the speed loop LADRC controller; the control structure of the speed loop LADRC is as follows: Figure 4 As shown in the figure, the optimized LADRC is used to design the speed loop of the PMSM control system. The speed loop is a first-order system and mainly adopts the first-order LADRC. The parameter adjustment is simpler and the response speed is faster.

[0069] According to the moment equation in formula (1), it can be rewritten as follows:

[0070]

[0071] Where: d e represents the internal and external disturbances of the system; b e Indicates the actual gain of the moment of inertia, which is 1 / J;

[0072] Define angular velocity ωr As the state variable x1, the disturbance is expanded a(t) into a new state variable x2, b0 is used as the system control gain, and the state equation of the permanent magnet synchronous motor speed is expressed as:

[0073]

[0074] According to the state equation, a linear extended state observer is established:

[0075]

[0076] Where: z1 represents the tracking signal of x1; e1 represents the error signal between z1 and x1; z2 represents the observation signal of the total disturbance a(t); β1 and β2 represent the gains of LESO, and their values ​​are related to the bandwidth of the observer;

[0077] The control input adopts proportional control, K p is the proportionality coefficient, then

[0078]

[0079] Where: Represents the input given signal; ω r Indicates feedback signal;

[0080] Combining equations (5) and (7), the equation after disturbance compensation is:

[0081]

[0082] In order to verify the effect of linear active disturbance rejection applied to the SADA system, based on the design of the above controller, under the condition of given additional speed, the present invention performs simulation analysis and verification on the Simulink platform. Figure 4 The speed loop LADRC block diagram is built based on the Matlab / Simulink simulation model. The specific structure is as follows Figure 5 As shown, the main parameters of the motor and solar wing load are shown in Table 1 and Table 2.

[0083] Table 1 Motor parameters

[0084] Table 1 Motor parameters

[0085]

[0086]

[0087] Table 2 Solar wing simulation load parameters

[0088] Table 2 Solar array simulation load parameters

[0089]

[0090] The simulation parameters of the speed loop and current loop controller are shown in Table 3.

[0091] Table 3 Simulation parameters

[0092] Table 3 Simulation parameters

[0093]

[0094] The principle of parameter selection is: when the observer bandwidth ω0 and the controller bandwidth ω c Achieving good dynamic characteristics can achieve the best LADRC performance. The bandwidth of the controller is a key factor affecting the performance of LESO. If the bandwidth is wide enough within the appropriate range, the rise and adjustment time can be effectively shortened. The tracking ability of LESO is affected by the bandwidth of the observer, so it has a faster response speed. However, if the bandwidth of the controller and observer is too large, the high-frequency bandwidth gain of the system will increase, and the high noise of the system will become more obvious. Therefore, the ratio of the two needs to be considered when making adjustments.

[0095] In the adjustment process, in order to ensure performance, first ensure the bandwidth of the controller ω c unchanged, and then gradually increase ω0 until the noise interference can no longer meet the requirements, then stop adjusting ω0, and as ω c As ω0 increases, the output waveform of the system will change, so it is necessary to reduce ω0 to achieve better control effect. According to most engineering practices, ω0 = (3 ~ 5)ω c is the appropriate range of parameter adjustment. Through multiple optimization of parameters, it can be found that when the bandwidth of the system observer is about 4 times that of the controller, its performance is excellent. This method is also very consistent with the parameter experience in engineering practice. The relationship between the observer bandwidth ω0 and the parameters β1 and β2 can be expressed as

[0096]

[0097] The simulation process lasted for 0.5s. When the SADA drives the solar wing to switch from zero speed to rated speed under simulated load conditions, the motor speed tracking curve is as follows: Figure 6 As shown, Figure 7 Indicates the speed tracking curve in stable state. Figure 6 and Figure 7It can be seen that when switching to the rated speed, the speed curve of the linear active disturbance rejection control can return to stability in a short time, and can track the given speed, which has strong robustness. When the double closed-loop PI control and nonlinear active disturbance rejection control are switched to the rated speed, the speed curve overshoot of the nonlinear active disturbance rejection control is larger than that of the other two control methods, and the deviation between the actual speed and the reference speed is the largest when the control is in a stable state. Although the PI control has no overshoot, the adjustment time is longer, and it takes about 0.25s to return to stability.

[0098] The motor stator current waveform is as follows: Figure 8 As shown, a 、i b and i c is the three-phase stator current. When the flexible solar wing changes from zero speed to rated speed, there is no obvious impact on the stator current. It can be seen from the figure that the current will adjust quickly with the load speed switching, without overshoot current, and will soon be in a stable state.

[0099] The motor output torque curve is as follows: Fig. 9 As shown in , the control system motor output torque demand increases at the moment of speed change. Fig. 9 As shown in the figure, the output torque increases to varying degrees. The output torque of the speed loop using linear ADRC controller changes less than that of PI control and nonlinear control, and recovers stability faster than PI and nonlinear ADRC, indicating that linear ADRC has better robustness.

[0100] For the SADA system, when the solar wing basically completes the sun orientation work, the solar wing will rotate continuously at the angular velocity of the sun-synchronous orbit satellite, so the working speed is generally constant. The present invention sets the reference speed to 0.065° / s, uses a 500ms sampling period to measure the SADA output speed change, and calculates the speed stability according to formula (10):

[0101]

[0102] After calculation, the standard deviation is 3.6758×10 -4 The rated speed is 0.065° / s, and the speed stability reaches 5.65×10 -3 (3σ), which can ensure the high stability requirement of the SADA system.

[0103] In view of the problem that the harmonic torque of the stepper motor is large and SADA easily excites the solar wing to cause vibration, the present invention uses PMSM as the driving source for closed-loop control. However, due to the flexibility of the solar panels, the bandwidth capacity of the SADA system is limited. It is difficult for traditional PI control to increase the stiffness of the system by increasing the gain, resulting in a weakening of the system's ability to suppress speed fluctuations. To address this problem, the present invention adopts a linear active disturbance rejection control method. Linear active disturbance rejection control can better balance the steady-state performance and dynamic performance of the system. On the Matlab / Simulink platform, the linear active disturbance rejection control algorithm is compared with traditional PI control and nonlinear active disturbance rejection control. The simulation results show that the linear active disturbance rejection control has a faster response speed and can better suppress SADA system disturbances. The speed stability reaches 5.65×10 -3 (3σ).

[0104] Although the present invention has been described in detail above by general description and specific embodiments, it is obvious to those skilled in the art that some modifications or improvements can be made to the present invention. Therefore, these modifications or improvements made without departing from the spirit of the present invention all belong to the scope of protection claimed by the present invention.

Claims

1. A high-stability solar wing drive mechanism control system based on linear self-disturbance rejection, characterized by: The control system uses a permanent magnet synchronous motor as the actuator of SADA, which forms the electromechanical interface between the solar wing and the satellite body and is installed on the satellite body. The output shaft of SADA is directly connected to the rotation shaft of the solar wing. The control system also includes an outer speed loop, an inner current loop, a motor driver and a solar wing load. The motor angle encoder is used to obtain the actual speed through speed resolution, and the error between the actual speed and the reference speed is used as the input of the speed controller to realize the outer loop closure. The inner loop uses the current sensor to sample the three-phase current, and the output of the speed controller is used as the input of the current loop. Then, the motor driver is used to make the actual voltage applied to the permanent magnet synchronous motor the terminal voltage given by the control link, and then the permanent magnet synchronous motor drives the solar wing load to rotate. A closed-loop SADA model with a permanent magnet synchronous motor as the driving source and the dynamic equations of the flexible solar wing load coupling are established; considering the influence of the flexible solar wing, the speed loop of the permanent magnet synchronous motor driving the solar wing load is controlled by PI control through the improved PI control; in order to achieve a balance between the dynamic performance and stability of PI control, a linear anti-disturbance controller is designed to observe and compensate for the unknown disturbances to the system in real time, and finally suppress the disturbance; The steps for building a closed-loop SADA model are as follows: Assume that the permanent magnet flux linkage of the permanent magnet synchronous motor rotor unchanged, using a surface-mounted permanent magnet synchronous motor, that is, the d-axis inductance L d and q-axis inductance L q The size is equal, and the mathematical model of the permanent magnet synchronous motor in the dq two-phase rotating coordinate system is expressed as: Where: u d 、u q Represents the d and q axis components of the stator voltage; represents the permanent magnet flux; ω represents the rotor mechanical angular velocity; R s represents the stator resistance; i d 、i q represents the d and q axis components of the stator current; p represents the number of motor pole pairs; L represents the inductance of the synchronous motor; J represents the moment of inertia; T L Indicates load torque; T e represents electromagnetic torque; When designing the speed loop, the influence of the current loop is not considered, and the speed loop of the permanent magnet synchronous motor driving the solar wing load is constructed using PI control; The first link is the speed loop PI regulator Feedback speed ω r and given speed The difference between them is used as the input of the speed loop PI regulator, and the output of the speed loop PI regulator is the given value of the current loop. The influence of the current loop is not considered at this time; the second link is the torque and current conversion part in the permanent magnet synchronous motor The third link is the transfer function of the solar wing load The solar panels are driven to rotate by permanent magnet synchronous motors; The closed-loop transfer function of the speed loop PI control is: Where: r Indicates the actual speed; Indicates the reference speed; k p represents the proportional coefficient; τ represents the integral time constant.

2. The high-stability solar wing drive mechanism control system based on linear auto-disturbance rejection according to claim 1 is characterized in that: The driving torque of the solar wing is the load torque T in equation (1): L , the motor speed and angle are equal to those of the solar wing. Considering the coupling effect of the solar wing's flexible vibration and the star's drive, the solar wing dynamic equation is expressed as: Where: J s represents the moment of inertia of the solar wing around the rotation axis; F represents the coupling coefficient of the solar wing rotation and flexibility; θ represents the mechanical angle of the solar wing rotation; q represents the modal coordinates of the solar wing; K represents the modal stiffness; D represents the modal damping; ω f represents the modal frequency; ζ represents the damping coefficient.

3. The high-stability solar wing drive mechanism control system based on linear auto-disturbance rejection according to claim 1 is characterized in that: Considering that PI control achieves a balance between dynamic performance and stability, the total disturbance d e With solar wing load The actual output speed ω r The linear state observer LES0 estimates the system state z1 and the expanded state z2 in real time. z1 is used to track the given speed. The linear error feedback control law converts the system states estimated by LES0 into proportional controllers K p The virtual control quantity u0 is obtained after disturbance compensation b0. It is the total control quantity output by the speed loop LADRC controller; According to the moment equation in formula (1), it can be rewritten as follows: Where: d e represents the internal and external disturbances of the system; b e Indicates the actual gain of the moment of inertia, which is 1 / J; Define angular velocity ω r As the state variable x1, the disturbance is expanded a(t) into a new state variable x2, b0 is used as the system control gain, and the state equation of the permanent magnet synchronous motor speed is expressed as: According to the state equation, a linear extended state observer is established: Where: z1 represents the tracking signal of x1; e1 represents the error signal between z1 and x1; z2 represents the observation signal of the total disturbance a(t); β1 and β2 represent the gains of LESO, and their values ​​are related to the bandwidth of the observer; The control input adopts proportional control, K p is the proportionality coefficient, then Where: Represents the input given signal; ω r Indicates feedback signal; Combining equations (5) and (7), the equation after disturbance compensation is: