Orthogonality automatic calibration method of photoelectric sight-stabilizing system
By automatically controlling the rotation of the azimuth/pitch frame of the photoelectric stabilization system, collecting coupling speed data and calculating calibration coefficients, the problem of orthogonal coupling error in the photoelectric stabilization system is solved, and fast and effective automatic orthogonal calibration is achieved. Improve the direction accuracy of the optoelectronic system.
Patent Information
- Application Number
- CN202411025073.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-29
- Publication Date
- 2024-11-12
AI Technical Summary
The existing photoelectric steady-sight system has orthogonal coupling errors in the azimuth pitch control loop, which leads to difficulty in precise direction. The existing orthogonality testing methods are complex and time-consuming, and it is impossible to fully measure the coupling between the rolling pair of azimuth and pitch axis.
By designing an automated program flow, the azimuth/pitch frame of the photoelectric steady-sight system is controlled to rotate at a constant speed, collect coupling speed data, calculate coupling calibration coefficients, and complete compensation control through correction control commands to achieve automatic orthogonal calibration.
The orthogonal calibration of the optoelectronic system can be quickly completed without external equipment, improving the direction accuracy, simplifying the measurement process, and having high efficiency, realization and versatility.
Smart Images

Figure CN118936238A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of automatic control and relates to an automatic orthogonality calibration method for an optoelectronic stabilization aiming system. Background Art
[0002] The electro-optical stabilized aiming system is an observation and aiming system composed of an azimuth and elevation gimbal support structure, an optical sensor assembly, an image processing unit and a servo control unit. By controlling the azimuth and elevation frame movement of the system and switching the electro-optical sensors through the joystick, it can complete the target search, identification, aiming, tracking, laser ranging and illumination tasks during the day and night. Therefore, it is very important to ensure that the system accurately aims and points to the target.
[0003] As a key unit for target aiming and pointing, the servo control unit in the optoelectronic stabilized aiming system generally uses a rate gyro as an inertial angular velocity measurement sensor, and completes the closed-loop control of the control loop through a motor and a drive circuit. Due to the influence of the gyro installation error and the system axis installation error, the azimuth and pitch control loops will be coupled, that is, when the azimuth (or pitch) moves, signals will be introduced to the gyros in other orthogonal directions, causing the orthogonal direction to be involved, thereby affecting the precise pointing of the optoelectronic stabilized aiming system. The above-mentioned orthogonal coupling error is generally reduced by improving the machining accuracy and assembly accuracy, but it cannot be completely eliminated, so it is necessary to measure and compensate through the orthogonality test method.
[0004] At present, the commonly used orthogonality test method is manual calibration, that is, the optoelectronic system is installed on a three-degree-of-freedom swing table, and the calibration is performed by swinging in different directions and measuring the gyro outputs in the other two directions. Since this method requires the use of external equipment, the measurement process is complicated and time-consuming; Patent CN108375997B proposes an orthogonality compensation method for a two-axis servo control system for a vehicle-mounted optoelectronic sighting system. This method calculates the coupled angular velocity by rotating the azimuth (or pitch) axis to measure the angular position of the pitch (or azimuth) axis. Although it is feasible, the method is not simple enough and cannot measure the coupling of the roll to the azimuth and pitch axes. Summary of the invention
[0005] (I) Purpose of the invention
[0006] The purpose of the present invention is to provide an automatic calibration method for the orthogonality of an optoelectronic stabilization system, so as to quickly and effectively measure and compensate for the non-orthogonality of the control of various degrees of freedom caused by mechanical processing and axis system adjustment, thereby improving the pointing accuracy of the optoelectronic system to the target.
[0007] (II) Technical solution
[0008] In order to solve the above technical problems, the present invention provides an automatic orthogonality calibration method for an electro-optical stabilization system, comprising the following steps:
[0009] S1: Initialize the starting calibration position of the electro-optical stabilization system to reserve a sufficient angle range for the subsequent rotation calibration process;
[0010] S2: Control the azimuth / elevation frame of the electro-optical stabilization system to rotate at a uniform speed in sequence to collect coupled velocity data;
[0011] S3: Calculate the coupling calibration coefficient according to the coupling speed data collected in step S2;
[0012] S4: Calculate the compensation command after the calibrated stable control loop and complete the compensation control.
[0013] The implementation process of step S1 is:
[0014] After the electro-optical stabilized aiming system is powered on and working normally, lock the azimuth and elevation frames of the electro-optical stabilized aiming system to the 0 degree position respectively.
[0015] The implementation process of step S2 is:
[0016] The first step is to control the azimuth axis with ω cmd_az =A (degrees / second) rotation, and lock the pitch axis at 0 degrees. Generally, A=10~30 (degrees / second);
[0017] The second step is to start recording the pitch gyro velocity ω coupled to the azimuth axis motion when the azimuth axis scan reaches a uniform speed. a_el And last for T seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows:
[0018] |ω cmd_az -ω g_az |<ε
[0019] Where: g_az is the gyro output speed during azimuth frame scanning; ε is the set stable scanning control deviation, here ε=0.05·ω g_az ;
[0020] Here T is generally selected as 2-4 seconds according to the movement speed and range of motion;
[0021] The third step is to control the pitch axis with ω cmd_el =A (degrees / second) rotation, while locking the azimuth axis at 0 degrees, generally A = 10 ~ 30 (degrees / second);
[0022] Step 4: When the pitch axis scan reaches a uniform speed, start recording the azimuth gyro velocity ω coupled with the pitch motion az_e And last for T seconds; the judgment conditions for the pitch axis to reach the uniform speed scanning state are as follows:
[0023] |ω cmd_el -ωg_el |<ε
[0024] Where: g_el is the gyro output speed when the pitch frame is scanned;
[0025] ε is the set stable scanning control deviation, here ε=0.05·ω g_el ;
[0026] Step 5: Lock the azimuth axis to 0 degrees and the pitch axis to 90 degrees.
[0027] Step 6: Control the azimuth axis with ω cmd_az =A (degrees / second) rotation, and lock the pitch axis at 90 degrees. Generally, A=10~30 (degrees / second);
[0028] Step 7: When the azimuth axis scan reaches a uniform speed, record the azimuth gyro velocity ω coupled with the roll axis motion az_r and the pitch gyro velocity ω el_r And last for T seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows:
[0029] |ω cmd_az -ω g_roll |<ε
[0030] Where: g_roll is the roll gyro output speed during azimuth frame scanning;
[0031] ε is the set stable scanning control deviation, here ε=0.05·ω g_roll .
[0032] The implementation process of step S3 is:
[0033] The first step is to calculate the average coupling speed based on the collected coupling data. and The average speed can be calculated by arithmetic mean algorithm or least squares algorithm. Here, arithmetic mean is used:
[0034]
[0035] In the second step, the coupling coefficient is calculated according to the following formula:
[0036]
[0037] Where: K 12 ——coupling coefficient of azimuth axis motion to elevation axis;
[0038] K 21 ——coupling coefficient of pitch axis motion to azimuth axis;
[0039] K 31 ——coupling coefficient of roll axis motion to azimuth axis;
[0040] K 32 ——The coupling coefficient of the roll axis motion to the pitch axis.
[0041] The implementation process of step S4 is:
[0042] Calculate the control commands of the stable control loop:
[0043] ω' cmd_az =ω cmd_az +K 21 \ω g_el +K 31 ·ω g_roll
[0044] ω' cmd_el =ω cmd_el +K 12 ·ω g_az +K 32 \ω g_roll
[0045] Where: ω' cmd_az ——Corrected azimuth and speed control commands;
[0046] ω' cmd_el ——Corrected pitch speed control command.
[0047] (III) Beneficial effects
[0048] The most commonly used orthogonality test method is manual calibration, which is to install the optoelectronic system on a three-degree-of-freedom swing table, and calibrate by swinging in different directions and measuring the gyro outputs in the other two directions. Since this method requires the use of external equipment, the measurement process is complicated and time-consuming. Compared with the existing method, the present invention has the following beneficial effects:
[0049] (1) Compared with the existing calibration method, the technical solution of the present invention does not rely on external calibration equipment. By designing an automated program flow to control the rotation of the electro-optical stabilization system, the orthogonality calibration of the electro-optical system can be quickly completed, and the calibration efficiency is high;
[0050] (2) The present invention can calibrate the mutual coupling between the three directions of azimuth, pitch and roll, and fully complete the motion decoupling between the three degrees of freedom;
[0051] (3) The technical solution of the present invention can be implemented through software without adding additional hardware resources. It has high feasibility, versatility and portability and can be used on different types of optoelectronic stabilization platforms. BRIEF DESCRIPTION OF THE DRAWINGS
[0052] Figure 1 Flow chart of the method of the present invention. DETAILED DESCRIPTION
[0053] In order to make the purpose, content and advantages of the present invention more clear, the specific implementation methods of the present invention are further described in detail below in conjunction with the drawings and examples.
[0054] The main working principle of the present invention is to allow the azimuth axis (or pitch axis) of the electro-optical stabilization system to rotate at a uniform speed and lock the pitch axis (or azimuth axis) at the same time. During this period, the motion coupling speed of the pitch (or azimuth) during the azimuth (or pitch) rotation is calculated through the locking control command, and the coupling amount is applied to the corresponding servo control loop through reverse compensation, thereby completing the automatic calibration and compensation of orthogonality.
[0055] Example 1
[0056] This embodiment is a two-axis two-frame electro-optical stabilization system on a certain type of helicopter. The three-axis angular velocity gyro is installed together with the optical sensor on the optical stand, and the optical stand is installed on the universal joint composed of the azimuth and pitch frames. The processor in the servo control unit collects the gyro and encoder signals as angular velocity and angular position feedback, and generates control deviation by subtracting the speed / position control command, and generates drive commands through servo control algorithm conditioning, thereby driving the electro-optical stabilization system to realize speed closed loop and position closed loop. In order to realize the automatic calibration of orthogonality described in this patent, the implementation process is as follows: Figure 1 As shown, perform the following steps:
[0057] S1: Initialize the starting calibration position of the electro-optical stabilization system to reserve sufficient angle range for the subsequent rotation calibration process;
[0058] S2: Control the azimuth / elevation frame of the electro-optical stabilization system to rotate at a uniform speed in sequence to collect coupled velocity data;
[0059] S3: Calculate the coupling calibration coefficient based on the coupling data collected in S2;
[0060] S4: Calculate the compensation command after the calibrated stable control loop and complete the compensation control.
[0061] The implementation process of step S1 is:
[0062] After the electro-optical stabilized aiming system is powered on and working normally, lock the azimuth and elevation frames of the electro-optical stabilized aiming system to the 0 degree position respectively.
[0063] The implementation process of step S2 is:
[0064] The first step is to apply a scanning control command ω to the input of the azimuth stabilization control loop. cmd_az=30 (degrees / second), drive the azimuth frame to rotate at a constant speed, and lock the pitch axis at 0 degrees;
[0065] The second step is to start recording the pitch gyro velocity ω coupled to the azimuth axis motion when the azimuth axis scan reaches a uniform speed. a_el And last for T seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows:
[0066] |ω cmd_az -ω g_az |<ε
[0067] Where: g_az is the gyro output speed during azimuth frame scanning;
[0068] ε is the set stable scanning control deviation, and in this embodiment, ε=0.05\ω g_az =1.5 (degrees / second);
[0069] T is generally selected to be 2-4 seconds according to the movement speed and range of motion, and T is taken as 2 seconds here;
[0070] The third step is to apply the scanning control command ω at the input of the pitch stabilization control loop. cmd_el =30 (degrees / second), drive the pitch frame to rotate at a constant speed, and lock the azimuth axis at 0 degrees;
[0071] Step 4: When the pitch axis scan reaches a uniform speed, start recording the azimuth gyro velocity ω coupled with the pitch motion az_e And lasts for T = 2 seconds; the judgment conditions for the pitch axis to reach the uniform speed scanning state are as follows:
[0072] |ω cmd_el -ω g_el |<ε
[0073] Where: g_el is the gyro output speed when the pitch frame is scanned;
[0074] ε is the set stable scanning control deviation, and in this embodiment, ε=0.05\ω g_el =1.5 (degrees / second);
[0075] Step 5: Lock the azimuth axis to 0 degrees and the pitch axis to 90 degrees.
[0076] Step 6: Apply the scanning control command ω to the input of the azimuth stability control loop cmd_az =30 (degrees / second), drive the azimuth frame to rotate at a constant speed, and lock the pitch axis at 90 degrees;
[0077] Step 7: When the azimuth axis scan reaches a uniform speed, record the azimuth gyro velocity ω coupled with the roll axis motion az_rand the pitch gyro velocity ω el_r And lasts for T = 2 seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows:
[0078] |ω cmd_az -ω g_roll |<ε
[0079] Where: g_roll is the roll gyro output speed during azimuth frame scanning;
[0080] ε is the set stable scanning control deviation, and in this embodiment, ε=0.05\ω g_roll =1.5 (degrees / second).
[0081] The implementation process of step S3 is:
[0082] The first step is to calculate the average coupling speed based on the collected data and The average speed in this embodiment is calculated using the arithmetic average algorithm:
[0083]
[0084] In the second step, the coupling coefficient is calculated according to the following formula:
[0085]
[0086]
[0087] Where: K 12 ——The coupling coefficient of the azimuth motion to the elevation motion;
[0088] K 21 ——coupling coefficient of pitch direction motion to azimuth direction;
[0089] K 31 ——coupling coefficient of rolling motion to azimuth motion;
[0090] K 32 ——coupling coefficient of rolling motion to pitch motion;
[0091] In this embodiment, the above coefficients are measured to be: K 12 =-0.02, K 21 =0.003, K 31 =0.012, K 12 =-0.001.
[0092] The implementation process of step S4 is:
[0093] Calculate the control commands of the stable control loop:
[0094] ω' cmd_az =ω cmd_az +K 21 ·ω g_el +K 31 ·ω g_roll
[0095] ω' cmd_el =ω cmd_el +K 12 ·ω g_az +K 32 \ω g_roll
[0096] Where: ω' cmd_az ——Corrected azimuth and speed control commands;
[0097] ω' cmd_el ——Corrected pitch speed control command.
[0098] The above is only a preferred embodiment of the present invention. The present invention is also applicable to optoelectronic stabilization systems with two-axis three-frame, two-axis four-frame and other structural forms equipped with a three-axis gyroscope. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the technical principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.
Claims
1. A method for automatic orthogonality calibration of an electro-optical stabilization system, characterized in that: include: S1: Initialize the starting calibration position of the electro-optical stabilization system to reserve enough angle range for the subsequent rotation calibration process; S2: Control the azimuth / elevation frame of the electro-optical stabilization system to rotate at a uniform speed in sequence to collect coupled velocity data; S3: Calculate the coupling calibration coefficient according to the coupling speed data collected in step S2; S4: Calculate the compensation command after the calibrated stable control loop and complete the compensation control.
2. The automatic orthogonality calibration method of the electro-optical stabilization system according to claim 1, characterized in that: The implementation process of step S1 is: after the electro-optical stabilization system is powered on and works normally, the azimuth and elevation frames of the electro-optical stabilization system are locked to the 0 degree position respectively.
3. The automatic orthogonality calibration method of the electro-optical stabilization system according to claim 2, characterized in that: The implementation process of step S2 is: S21, control the azimuth axis with ω cmd_az =A rotation, unit: (degrees / second), while locking the pitch axis at 0 degrees; S22, when the azimuth axis scan reaches a uniform speed, start recording the pitch gyro velocity ω coupled during the azimuth axis motion a_el And last for T seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows: |oh cmd_az -oh g_az |<e Where: g_az is the gyro output speed during azimuth frame scanning; ε is the set stable scanning control deviation; S23, control the pitch axis to ω cmd_el =A rotates, while locking the azimuth axis at 0 degrees; S24, when the pitch axis scan reaches a uniform speed, start recording the azimuth gyro velocity ω coupled with the pitch motion az_e And last for T seconds; the judgment conditions for the pitch axis to reach the uniform speed scanning state are as follows: |oh cmd_el -oh g_el |<e Where: g_el is the gyro output speed during pitch frame scanning; ε is the set stable scanning control deviation; S25, control the azimuth axis to lock to 0 degrees, and the pitch axis to lock to 90 degrees; S26, control the azimuth axis with ω cmd_az =A (rotate and lock the pitch axis at 90 degrees; S27, when the azimuth axis scan reaches a uniform speed, record the azimuth gyro velocity ω coupled with the roll axis motion az_r and the pitch gyro velocity ω el_r And last for T seconds; the judgment conditions for the azimuth axis to reach the uniform scanning state are as follows: |oh cmd_az -oh g_roll |<e Where: g_roll is the roll gyro output speed during azimuth frame scanning; ε is the set stable scanning control deviation.
4. The automatic orthogonality calibration method of the electro-optical stabilization system according to claim 3, characterized in that: In step S2, A=10-30 (degrees / second) and T=2-4 seconds are selected.
5. The automatic orthogonality calibration method of the electro-optical stabilization system according to claim 4, characterized in that: In step S22, ε is set to 0.05 times the gyro output speed during the azimuth frame scan.
6. The method for automatically calibrating the orthogonality of an electro-optical stabilization system according to claim 5, characterized in that: In step S24, ε is set to 0.05 times the gyro output speed during the pitch frame scan.
7. The automatic orthogonality calibration method of the electro-optical stabilization system according to claim 6, characterized in that: In step S27, ε is set to 0.05 times the output speed of the rolling gyro during the azimuth frame scan.
8. The method for automatically calibrating the orthogonality of an electro-optical stabilization system as claimed in claim 7, characterized in that: The implementation process of step S3 is: Step S31, calculating the average coupling speed based on the collected coupling data and The average speed is calculated using the arithmetic mean algorithm or the least squares algorithm. The result obtained by the arithmetic mean is: Step S32, calculating the coupling coefficient according to the following formula: Where: K 12 ——coupling coefficient of azimuth axis motion to elevation axis; K 21 ——coupling coefficient of pitch axis motion to azimuth axis; K 31 ——coupling coefficient of roll axis motion to azimuth axis; K 32 ——The coupling coefficient of the roll axis motion to the pitch axis.
9. The method for automatically calibrating the orthogonality of an electro-optical stabilization system as claimed in claim 8, characterized in that: The implementation process of step S4 is: Calculate the control commands of the stable control loop: oh cmd_az =ω cmd_az +K 21 ·oh g_el +K 31 ·oh g_roll oh cmd_el =ω cmd_el +K 12 ·oh g_az +K 32 ·oh g_roll Where: ω' cmd_az ——Corrected azimuth and velocity control commands; ω' cmd_el ——Corrected pitch speed control command.
10. Application of an automatic orthogonality calibration method for an electro-optical stabilization system according to any one of claims 1 to 9 in the field of automatic control technology.
Citation Information
Patent Citations
Method for orthogonality compensation of two-axis servo control system for vehicle-mounted photoelectric observing and aiming system
CN108375997A
Inclinometer orthogonality evaluation method based on pitch axis and transverse roller relative angle
CN108917789A
Digital compensation method for installation error of gyroscope in servo sight-stabilizing product
CN114264317A
Calibration system and calibration method for orthogonal position of three-axis inertially stabilized platform
CN116907542A
Method for calibrating the stiffness deviation and / or quadrature of a vibrating inertial sensor
FR3115101A1
