Motor control method for airborne optoelectronic pod

Through inductive FOC control and attitude sensor data calculation, combined with closed-loop control of PID and synovial observer, the stability problem of the photoelectric pod during low-speed and high torque operation is solved, the starting accuracy and stability are improved, and the cost is reduced. and error risk improve the overall performance of the photoelectric pod.

CN118677307BActive Publication Date: 2024-11-15长春长光博翔无人机有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411174414.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-26
Publication Date
2024-11-15
Estimated Expiration
2044-08-26

AI Technical Summary

Technical Problem

The existing brushless motor control methods are prone to errors or failures when ambient temperature changes, especially when low-speed and high torque operation, the invisible control effect is poor, resulting in insufficient stability and starting accuracy of the photoelectric pod.

Method used

The inductive FOC control method is adopted to obtain the Euler angle through the attitude sensor data solution of the photoelectric pod, calculate the actual angle of the motor, and perform closed-loop control in combination with PID and synovial observer to avoid high-frequency injection and improve startup and low-speed operation. stability.

Benefits of technology

It improves the motor start-up accuracy and stability, reduces system costs, avoids sensor errors and failure risks, enhances the stability and tracking capabilities of the photoelectric pod, and improves operating efficiency and battery life.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118677307B_ABST
    Figure CN118677307B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of airborne optoelectronic pod control, and specifically provides a motor control method for an airborne optoelectronic pod, which aims to improve the stability and operating efficiency of a brushless motor used in a small optoelectronic pod, perform attitude calculation through attitude sensor data, obtain the Euler angle information of the pod, and convert it into the actual angle of the motor, thereby avoiding the high-frequency injection required in the traditional sensorless starting method during the startup phase; during the motor's startup to closed-loop operation phase, the observed angular velocity of the motor is obtained through a sliding film observer, and when the observed angular velocity is greater than a set angular velocity threshold, the observed angle is used as the actual angle for closed-loop control. The present invention adopts a control method that combines sensorless and sensory control, and uses attitude sensor data to obtain the accurate actual angle of the motor rotor during the motor startup and low-speed operation phases, avoiding the reliance on high-frequency injection during the motor startup process in sensorless FOC control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of airborne optoelectronic pod control, and specifically provides a motor control method for an airborne optoelectronic pod. Background Art

[0002] At present, the main power source of small optoelectronic pods is brushless motors. A stable and reliable motor drive method can ensure the smooth operation of optoelectronic pods. FOC control, as the mainstream control method of brushless motors, is famous for its stable and efficient characteristics. Sensorless and sensory control are the two main branches of FOC. The method of obtaining the motor rotor position based on Hall sensors or encoders to accurately control the motor torque and speed is sensory control. Accuracy and efficiency are the advantages of sensory control, but whether it is Hall sensors or encoders, on the basis of increasing costs, they will also cause large errors or failures in sensors due to changes in ambient temperature. Sensorless control can avoid the above problems at the same time. Thanks to the emergence of various observer algorithms, sensorless control can estimate the position of the rotor by constructing various observers through current sampling, but sensorless control requires high-frequency injection and other methods to complete the motor start. At the same time, when running at low speed, the effect of the observer is not good. Most of the working states of optoelectronic pods require low-speed and high-torque operation in a stable state. Summary of the invention

[0003] In order to solve the above problems, the present invention provides a motor control method for an airborne optoelectronic pod. The motor is driven to start based on a sensorless FOC control method. The Euler angle of the optoelectronic pod is obtained by solving the attitude sensor data of the optoelectronic pod during the startup and low-speed operation stages. The actual angle of the motor in the optoelectronic pod is calculated by the Euler angle, which avoids the problem that high-frequency injection must be used in traditional sensorless starting methods and ensures the stability of the motor during startup and low-speed operation.

[0004] The motor control method of the airborne optoelectronic pod provided by the present invention comprises:

[0005] S1: When the angular velocity of the motor in the optoelectronic pod is 0, Solve and update the Euler angle of the optoelectronic pod, and convert the Euler angle into the actual angle of the optoelectronic pod. The actual angle includes the rotor angle of the pitch axis motor, the rotor angle of the roll axis motor, and the rotor angle of the yaw axis motor;

[0006] S2: Given a desired angle of the optoelectronic pod, the desired angle is subtracted from the actual angle to obtain an angle error, and the desired angular velocity of the optoelectronic pod is calculated using the first PID controller according to the angle error;

[0007] The actual angular velocity of the optoelectronic pod is obtained by an onboard gyroscope, the angular velocity error is obtained by subtracting the expected angular velocity from the actual angular velocity, and the expected current is obtained by calculating the angular velocity error using a second PID controller;

[0008] The three-phase current of the motor in the photoelectric pod is obtained through the sampling resistor, and the three-phase current is converted into the actual current in the coordinate system that rotates synchronously with the motor rotor. The current error is obtained by subtracting the expected current from the actual current. The expected voltage is obtained based on the current error using the PI controller. The voltage under the static coordinates is transformed, and the voltage under the static coordinates is modulated and demodulated by SVPWM to obtain the three-phase voltage, and the three-phase voltage is used to drive the motor of the optoelectronic pod to start;

[0009] S3: After the motor starts, the three-phase current The current is transformed into the current in the static coordinate system, and the current and voltage in the static coordinate system are used as the input of the sliding film observer, and the observation angle and the observation angular velocity of the motor rotor are obtained by using the sliding film observer;

[0010] When the observed angular velocity is less than or equal to the set angular velocity threshold, the actual angle is calculated by S1;

[0011] When the observed angular velocity is greater than the set angular velocity threshold, the observed angle is taken as the actual angle and the motor enters the closed-loop control stage.

[0012] Preferably, the Euler angle includes the pitch angle of the optoelectronic pod , Roll Angle and yaw angle , the calculation process of Euler angle is as follows:

[0013] The angular acceleration of the optoelectronic pod in the earth coordinate system is measured by an accelerometer; the magnetic field strength of the earth's magnetic field in the earth coordinate system is measured by a magnetometer; and the angular velocity of the optoelectronic pod in the earth coordinate system is measured by a gyroscope;

[0014] The initial Euler angle is calculated using the angular acceleration and magnetic field intensity components;

[0015] Initialize the quaternion using the initial Euler angle;

[0016] According to the angular acceleration, magnetic field strength and angular velocity, Update the quaternion and calculate the current Euler angle based on the updated quaternion.

[0017] Preferably, in S1, during the start-up phase of the optoelectronic pod, the motor speed is 0, and the actual angle is converted into:

[0018] ;

[0019] in, represents the pitch angle, represents the roll angle, represents the yaw angle, Indicates the rotor angle of the pitch axis motor. Indicates the rotor angle of the roll axis motor, Indicates the rotor angle of the yaw axis motor.

[0020] Preferably, in S2, the expected voltage is reflected Transformation, the calculation formula for the voltage under static coordinates is as follows:

[0021] ;

[0022] in, represents the expected voltage, represents the voltage in static coordinates, Indicates the electrical angle of the motor. When the angular velocity of the motor in the optoelectronic pod is 0, , P represents the number of pole pairs of the motor.

[0023] Preferably, in S3, the three-phase current The calculation formula for the current transformed into a static coordinate system is as follows:

[0024] ;

[0025] in, represents the current in the static coordinate system, Indicates the three-phase current of the motor measured through the sampling resistor.

[0026] Preferably, the synovial observer is expressed as:

[0027] ;

[0028] in, is the current observation value of the sliding membrane observer, represents the observed angular velocity, represents the stator resistance of the motor, represents the direct-axis inductance of the motor, represents the quadrature-axis inductance of the motor, represents the back EMF estimated by the synovial observer, , is the symbolic function, For synovial gain.

[0029] Preferably, the observed angular velocity is obtained by subtracting the equations of the sliding film observer and the motor in the static coordinate system to obtain the observed angular velocity And the motor rotor observation angle :

[0030] ;

[0031] ;

[0032] in, represents the back electromotive force of the motor, is the magnetic flux of the motor;

[0033] Electrical angle when the motor is running It is expressed as:

[0034] ;

[0035] in, represents the observation angle, Indicates the set angular velocity threshold;

[0036] Observation angle and electronic rotor observation angle The relationship is as follows:

[0037] ;

[0038] in, Indicates the observation angle of the pitch axis motor rotor, Indicates the observation angle of the roll axis motor rotor, Indicates the observation angle of the yaw-axis motor rotor.

[0039] Compared with the prior art, the present invention can achieve the following beneficial effects:

[0040] The present invention improves the motor starting accuracy, performs attitude calculation through attitude sensor data, obtains the current Euler angle information of the pod, and uses the attitude sensor data to obtain the accurate actual angle of the motor rotor during motor starting and low-speed operation, avoiding the problems caused by traditional sensorless starting methods such as high-frequency injection; in addition, the present invention avoids the use of Hall sensors or encoders, reduces system costs and reduces the risk of errors or failures caused by environmental changes, and adopts sensorless control to avoid motor operation failures due to large errors or failures of Hall sensors or encoders in harsh working environments.

[0041] The present invention adopts a control method that combines non-sensing and sensing. During the motor startup and low-speed operation stages, the actual angle is determined through attitude sensor data; when the observed angular velocity of the motor reaches the angular velocity threshold, the observed angle is used as the actual angle, and the angle, angular velocity and current of the optoelectronic pod are accurately controlled through a closed-loop control strategy; the present invention obtains rotor information with higher confidence from the motor startup to the closed-loop operation stage through a complementary fusion method of attitude sensors and sliding film observers, thereby completing the closed-loop control of the motor.

[0042] The control method of the present invention directly controls the torque, the motor responds quickly, and the rotation speed is guaranteed to be stable during operation, thereby greatly improving the stability and rapid tracking capability of the airborne optoelectronic pod.

[0043] The present invention uses FOC torque control technology to efficiently control the brushless motor of the airborne optoelectronic pod. The FOC torque control technology ensures that the motor can output the maximum torque at any working point by independently controlling the magnetic field and torque, and accurately controls the current at the same time, so that the coil current mainly contributes to the effective torque generation, thereby improving the operating efficiency of the motor, reducing energy waste, and increasing the overall flight time of the UAV. BRIEF DESCRIPTION OF THE DRAWINGS

[0044] Figure 1 is a motor control principle diagram of an airborne optoelectronic pod provided according to an embodiment of the present invention;

[0045] Figure 2 It is a schematic diagram of a motor starting process of an airborne optoelectronic pod provided according to an embodiment of the present invention. DETAILED DESCRIPTION

[0046] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In the following description, the same modules are represented by the same reference numerals. In the case of the same reference numerals, their names and functions are also the same. Therefore, the detailed description thereof will not be repeated.

[0047] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and do not constitute a limitation of the present invention.

[0048] like Figure 1 and Figure 2 As shown, the embodiment of the present invention improves a motor control method for an airborne optoelectronic pod, which is optimized based on the traditional sensorless FOC motor control method, and divides the click start process into: motor start phase, motor low-speed operation phase and motor closed-loop control phase. The motor angular velocity in the motor start phase is 0, the motor angular velocity in the motor low-speed operation phase is less than or equal to the preset angular velocity threshold, and the motor angular velocity in the motor closed-loop control phase is greater than the preset angular velocity threshold. The specific motor control process is as follows:

[0049] S1: During the start-up phase of the optoelectronic pod, the attitude information of the drone is obtained through the onboard attitude sensor (IMU). Since the optoelectronic pod is mounted on the drone, the attitude information obtained by the attitude sensor can be regarded as the attitude information of the optoelectronic pod. The attitude sensor mainly includes an accelerometer, a magnetometer, and a gyroscope. The accelerometer can measure the angular acceleration of the optoelectronic pod on the three spatial axes in the earth coordinate system. The magnetometer can measure the magnetic field strength of the earth's magnetic field at the location of the optoelectronic pod on the three spatial axes in the earth's coordinate system. The gyroscope can be used to measure the angular velocity of the optoelectronic pod on the three spatial axes in the earth coordinate system. .

[0050] pass The process of solving and updating the Euler angles of the optoelectronic pod is as follows:

[0051] S11: Based on the initially collected angular acceleration and magnetic field strength , the initial Euler angle can be calculated, which includes the pitch angle of the optoelectronic pod , Roll Angle and yaw angle , specifically, the initial Euler angle calculation formula is as follows:

[0052] .

[0053] In order to ensure the stability of Euler angle calculation and update and reduce error accumulation, the quaternion method is used to describe the attitude information of the optoelectronic pod. First, the quaternion is initialized according to the initial Euler angle. :

[0054] ;

[0055] S12: In the process of calculating and updating the Euler angle, in order to facilitate the calculation, the angular acceleration measured by the accelerometer should be Perform normalization processing, the process of normalization processing is:

[0056] First, calculate the angular acceleration The vector norm of :

[0057] ;

[0058] To normalize the angular acceleration vector, we can use the angular acceleration Divide by Perform normalization and use a temporary variable to store the normalized result:

[0059] .

[0060] After the angular acceleration is normalized, the component of the gravity vector is extracted from the normalized angular acceleration data. This is to use the gravity vector to correct the attitude of the optoelectronic pod in subsequent steps. The calculation formula of the gravity vector is as follows:

[0061] .

[0062] in, represents the acceleration component of gravity on the x-axis, represents the acceleration component of gravity on the y-axis, Represents the acceleration component of gravity on the z-axis.

[0063] After calculating the gravity vector, the error between the currently displayed posture and the actual posture due to the influence of gravity acceleration is obtained by calculating the cross product of the gravity vector and the normalized angular acceleration:

[0064] ;

[0065] in, represents the component of the attitude error on the x-axis, represents the component of the attitude error on the y-axis, Represents the component of the attitude error on the z-axis.

[0066] S13: Magnetic field strength Perform normalization processing, the process of normalization processing is:

[0067] First, calculate the magnetic field strength The vector norm of :

[0068] ;

[0069] In order to normalize the magnetic field intensity vector, the magnetic field intensity Divide by Normalize and the result is:

[0070] .

[0071] After the magnetic field intensity is normalized, the reference direction is obtained by right-multiplying the quaternion direction matrix with the normalized magnetic field intensity:

[0072] ;

[0073] in, represents the component of the reference direction on the x-axis, represents the component of the reference direction on the y-axis, Represents the component of the reference direction on the z-axis.

[0074] Since the y-axis of the earth coordinate system is perpendicular to the earth's magnetic field, the geomagnetic coordinates of the optoelectronic pod are expressed as ,in, , , then an estimated direction can be calculated based on the reference direction and quaternion, and the direction error can be calculated using this estimated direction. The calculation formula for the estimated direction is:

[0075] ;

[0076] in, Represents the component of the estimated direction on the x-axis, Represents the component of the estimated direction on the y-axis, Represents the component of the estimated direction on the z-axis.

[0077] By cross-multiplying the estimated direction with the normalized magnetic field intensity, the direction error between the estimated direction and the actual geomagnetic intensity direction is calculated as:

[0078] ;

[0079] in, represents the component of the directional error on the x-axis, represents the component of the directional error on the y-axis, Represents the component of the directional error on the z-axis, based on , and Eliminate directional errors.

[0080] S14: Update the angular velocity of the gyroscope according to the components of the attitude error on the three axes :

[0081] ;

[0082] ;

[0083] Among them, In the process of solving the Euler angle, the process of updating the gyroscope angular velocity is actually an assignment process. First, , and is an iterative variable that represents the integral of the components of the attitude error on the x, y, and z axes, which is equivalent to introducing a temporary variable equal to , and then assign the value of the temporary variable to , represents the integral gain, which is used to control the strength of the error integral term. Represents the proportional gain, which is used to control the strength of the error term itself.

[0084] Similarly, the updated gyroscope angular velocity calculated in the above formula is also assigned to the angular velocity ,Will Assign to ,Will Assign to ,Will Assign to ,Right now:

[0085] ;

[0086] In subsequent calculations Both represent the angular velocity after the updated assignment. The above updating of the angular velocity of the gyroscope is consistent with the actual execution process of the program.

[0087] Then, according to the updated gyroscope angular velocity, the updated calculation formula of the quaternion is obtained:

[0088] .

[0089] in, represents the quaternion at any time t, Indicates that after any time t, the time interval has passed Update the obtained quaternion.

[0090] pass Recalculate the Euler angle based on the updated quaternion formula. The current Euler angle calculation formula is:

[0091] ;

[0092] in, , , and All are updated The value in .

[0093] During the start-up phase of the optoelectronic pod, since the angular velocity of the motor in the optoelectronic pod is 0, The obtained Euler angle is converted into the actual angle of the optoelectronic pod, namely:

[0094] ;

[0095] in, Indicates the rotor angle of the pitch axis motor. Indicates the rotor angle of the roll axis motor, Indicates the rotor angle of the yaw axis motor.

[0096] S2: The overall control method of the optoelectronic pod in the embodiment of the present invention adopts three-loop control, the outermost loop is the angle loop, and the inner loops are the speed loop and the current loop. Specifically, given a desired angle , when the motor starts, the default , the desired angle The actual angle The angle error is obtained by difference, and the first PID controller is used to calculate the desired angular velocity of the optoelectronic pod according to the angle error. The specific first PID controller design and PID control belong to the prior art and are common control methods in this field.

[0097] The actual angular velocity of the optoelectronic pod is obtained by the onboard gyroscope , the expected angular velocity The actual angular velocity The angular velocity error is obtained by subtracting, and the desired current is obtained by using the second PID controller according to the angular velocity error. The specific second PID controller design and PID control belong to the prior art and are common control methods in this field. When the motor starts, usually .

[0098] The three-phase current of the motor in the photoelectric pod is obtained through the sampling resistor, and the three-phase current is converted into the actual current in the coordinate system that rotates synchronously with the motor rotor. When the motor starts, the three-phase current is 0. After the motor is powered on, the specific current value can be directly sampled through the sampling resistor. The current error is obtained by subtracting the expected current from the actual current, and the expected voltage is calculated based on the current error using the PI controller. Specific PI controller design and PI control belong to the prior art and are common control methods in this field. Conduct counter Transformation, get the voltage under static coordinates ,opposite The transformation is as follows:

[0099] ;

[0100] in, Represents the electrical angle of the motor, and its calculation formula is:

[0101] ;

[0102] in, represents the observed angular velocity of the synovial observer, Indicates the set angular velocity threshold. Indicates the observation angle of the sliding film observer. When the angular velocity of the motor in the optoelectronic pod is 0, , P represents the number of pole pairs of the motor, and the observation value of the sliding film observer is not applied when the motor starts.

[0103] Get the voltage under static coordinates After that, through SVPWM Modulation and demodulation to obtain three-phase voltage , using the three-phase voltage obtained at startup The motor is powered on, and the motor of the optoelectronic pod is started through the motor drive, and begins to rotate with an actual angular velocity.

[0104] S3: After the motor is started, the motor is in the low-speed rotation stage. The three-phase current of the motor can be collected through the sampling resistor. Transformed into the current in the static coordinate system, the calculation formula is as follows:

[0105] ;

[0106] in, represents the current in the static coordinate system, Indicates the three-phase current of the motor measured through the sampling resistor.

[0107] The current in the static coordinate system and voltage As the input of the synovial observer, the design of the synovial observer belongs to the prior art. In this embodiment, the synovial observer is expressed as:

[0108] ;

[0109] in, is the current observation value of the sliding membrane observer, represents the observed angular velocity, represents the back EMF estimated by the synovial observer, ;

[0110] represents the stator resistance of the motor, represents the direct-axis inductance of the motor, represents the quadrature-axis inductance of the motor, is the symbolic function, For synovial gain.

[0111] Solving for the observed angular velocity When , it is necessary to make a difference between the equation of the sliding film observer and the equation of the motor in the static coordinate system, where the equation of the motor in the static coordinate system is:

[0112] ;

[0113] in, Indicates the actual back electromotive force of the motor.

[0114] Then the equations of the sliding film observer and the motor in the static coordinate system are subtracted to obtain:

[0115] ;

[0116] in, is the current observation error, .

[0117] The sliding surface function s of the sliding film observer is defined as:

[0118] .

[0119] The required synovial gain h is:

[0120] .

[0121] When the sliding surface function s converges and is 0, then:

[0122] .

[0123] At this time, the observed angular velocity and the observed angular velocity can be obtained through the synovial observer, where the calculation formula of the observed angular velocity is:

[0124] ,in, is the magnetic flux of the motor, which is a basic physical property.

[0125] Motor rotor observation angle The calculation formula is:

[0126] .

[0127] Due to the electrical angle when the motor is running for:

[0128] ;

[0129] in, represents the observation angle, Indicates the set angular velocity threshold;

[0130] So the observation angle is the same as the electronic rotor observation angle The relationship is as follows:

[0131] ;

[0132] in, Indicates the observation angle of the pitch axis motor rotor, Indicates the observation angle of the roll axis motor rotor, Indicates the observation angle of the yaw-axis motor rotor.

[0133] When observing the angular velocity Less than or equal to the set angular velocity threshold When , the actual angle obtained by Euler angle conversion in S1 is used as the actual angle of each axis of the motor rotor;

[0134] When observing the angular velocity Greater than the set angular velocity threshold When As the actual angle of each shaft of the motor rotor, the motor now enters the closed-loop control stage.

[0135] Although the embodiments of the present invention have been shown and described above, it is understood that the above embodiments are exemplary and cannot be understood as limiting the present invention. Those skilled in the art may change, modify, replace and modify the above embodiments within the scope of the present invention.

[0136] The above specific implementations of the present invention do not constitute a limitation on the protection scope of the present invention. Any other corresponding changes and modifications made based on the technical concept of the present invention should be included in the protection scope of the claims of the present invention.

Claims

1. A motor control method for an airborne optoelectronic pod, characterized in that: The following steps are involved: S1: When the angular velocity of the motor in the optoelectronic pod is 0, Solving and updating the Euler angle of the optoelectronic pod, and converting the Euler angle into the actual angle of the optoelectronic pod, wherein the actual angle includes the pitch axis motor rotor angle, the roll axis motor rotor angle and the yaw axis motor rotor angle; S2: Given a desired angle of the optoelectronic pod, subtract the desired angle from the actual angle to obtain an angle error, and use a first PID controller to calculate the desired angular velocity of the optoelectronic pod according to the angle error; The actual angular velocity of the optoelectronic pod is obtained by an onboard gyroscope, an angular velocity error is obtained by subtracting the desired angular velocity from the actual angular velocity, and a desired current is obtained by calculating the angular velocity error using a second PID controller; The three-phase current of the motor in the photoelectric pod is obtained through a sampling resistor, and the three-phase current is converted into an actual current in a coordinate system that rotates synchronously with the motor rotor, the current error is obtained by subtracting the expected current from the actual current, and the expected voltage is calculated according to the current error using a PI controller; The expected voltage is reflected The voltage under the static coordinates is converted to obtain the voltage under the static coordinates, the voltage under the static coordinates is modulated and demodulated by SVPWM to obtain the three-phase voltage, and the three-phase voltage is used to drive the motor of the photoelectric pod to start; S3: After the motor starts, the three-phase current transforming the current into a static coordinate system, using the current and voltage in the static coordinate system as inputs of a sliding film observer, and using the sliding film observer to obtain an observation angle and an observation angular velocity of the motor rotor; When the observed angular velocity is less than or equal to the set angular velocity threshold, the actual angle is calculated by the method of S1; When the observed angular velocity is greater than the set angular velocity threshold, the observed angle is used as the actual angle, and the motor enters a closed-loop control stage.

2. The motor control method of the airborne optoelectronic pod according to claim 1, characterized in that: The Euler angle includes the pitch angle of the optoelectronic pod , Roll Angle and yaw angle , the calculation process of the Euler angle is as follows: The angular acceleration of the optoelectronic pod in the earth coordinate system is measured by an accelerometer; the magnetic field strength of the earth's magnetic field in the earth coordinate system is measured by a magnetometer; and the angular velocity of the optoelectronic pod in the earth coordinate system is measured by a gyroscope; The initial Euler angle is calculated using the angular acceleration and magnetic field intensity components; Initialize the quaternion using the initial Euler angle; According to the angular acceleration, magnetic field strength and angular velocity, Update the quaternion and calculate the current Euler angle based on the updated quaternion.

3. The motor control method of the airborne optoelectronic pod according to claim 1, characterized in that: In S1, when the angular velocity of the motor in the optoelectronic pod is 0, the actual angle is converted into: ; in, represents the pitch angle, represents the roll angle, represents the yaw angle, Indicates the rotor angle of the pitch axis motor. Indicates the rotor angle of the roll axis motor, Indicates the rotor angle of the yaw axis motor.

4. The motor control method of the airborne optoelectronic pod according to claim 1, characterized in that: In S2, the expected voltage is reflected Transformation, the calculation formula for the voltage under static coordinates is as follows: ; in, represents the expected voltage, represents the voltage in static coordinates, Indicates the electrical angle of the motor. When the angular velocity of the motor in the optoelectronic pod is 0, , P represents the number of pole pairs of the motor.

5. The motor control method of the airborne optoelectronic pod according to claim 1, characterized in that: In S3, the three-phase current The calculation formula for the current transformed into a static coordinate system is as follows: ; in, represents the current in the static coordinate system, It indicates that the three-phase current of the motor is measured by the sampling resistor.

6. The motor control method of the airborne optoelectronic pod according to claim 1, characterized in that: The synovial observer is expressed as: ; in, is the current observation value of the synovial observer, represents the observed angular velocity, represents the stator resistance of the motor, represents the direct-axis inductance of the motor, represents the quadrature-axis inductance of the motor, represents the back EMF estimated by the synovial observer, , is the symbolic function, is the synovial gain, represents the voltage in the static coordinate system, and represents the current in the static coordinate system.