[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN111665872A - Two-axis two-frame stability control method based on equivalent transformation - Google Patents

Two-axis two-frame stability control method based on equivalent transformation Download PDF

Info

Publication number
CN111665872A
CN111665872A CN202010475775.XA CN202010475775A CN111665872A CN 111665872 A CN111665872 A CN 111665872A CN 202010475775 A CN202010475775 A CN 202010475775A CN 111665872 A CN111665872 A CN 111665872A
Authority
CN
China
Prior art keywords
frame
azimuth
axis
value
control method
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010475775.XA
Other languages
Chinese (zh)
Other versions
CN111665872B (en
Inventor
王新伟
韩瑞
张璟玥
陆红强
杜言鲁
巩全成
徐飞飞
王明超
李涛
赵博
陈红
康婷颋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xian institute of Applied Optics
Original Assignee
Xian institute of Applied Optics
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Xian institute of Applied Optics filed Critical Xian institute of Applied Optics
Priority to CN202010475775.XA priority Critical patent/CN111665872B/en
Publication of CN111665872A publication Critical patent/CN111665872A/en
Application granted granted Critical
Publication of CN111665872B publication Critical patent/CN111665872B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • G05D3/20Control of position or direction using feedback using a digital comparing device
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention belongs to the technical field of servo control, and particularly relates to a two-axis two-frame stable control method based on equivalent transformation. According to the invention, the three-axis integrated inertia measurement element is directly and rigidly connected with the aiming line, so that the measurement error and the mathematical transformation error can be reduced, the inertial speed of the aiming line can be directly reflected, and the measurement precision can be effectively improved; the control method of the two-frame system is subjected to mathematical transformation, and a linear link and a nonlinear link which influence the overhead stability of the two-frame system are distinguished, so that the full working range stability of the two-axis system is realized through a stable azimuth motor shaft, the nonlinear speed disturbance of an aiming line caused by the roll disturbance of an azimuth frame rotor is compensated through a feedforward mode, and the complete stable control of the azimuth of the aiming line can be realized through the combined action of the two links.

Description

Two-axis two-frame stability control method based on equivalent transformation
Technical Field
The invention belongs to the technical field of servo control, and particularly relates to a two-axis two-frame stability control method based on equivalent transformation.
Background
With the popularization of unmanned aerial vehicle technology in military and civil fields in recent years, photoelectric stabilized platforms based on unmanned aerial vehicle systems are widely applied. Install the photoelectricity stabilized platform on unmanned aerial vehicle, its main use is that keep apart the machine-carried disturbance, provides better dynamic operational environment for inside photoelectricity load, continues to output stable clear regional image to the user, realizes functions such as observation, shooting, tracking, location to the target. For a small-sized fixed wing or multi-rotor unmanned platform, the unmanned platform is limited by various factors such as takeoff weight, endurance, cost control and the like, most photoelectric stabilized platforms adopt a two-shaft two-frame system with simple and compact structural forms, and more size spaces and weights are distributed to photoelectric sensors, so that the optical performance of the photoelectric stabilized platform is improved.
The stable platform with two shafts and two frames usually adopts an azimuth-pitching type universal frame, an inertia measuring element and a photoelectric load are installed on the pitching frame together, and the measuring element directly senses the inertia motion of an optical shaft, so that the visual axis stability can be completed by utilizing the output signal of the measuring element to form negative feedback control. The sensitive shaft and the driving shaft of the aiming line pitching shaft are coaxial all the time, and the motion control of the aiming line pitching shaft is free from problems; limited by the characteristics of the structural form, the non-linear relation exists between the sighting line azimuth sensitive shaft and the driving shaft due to the change of the pitch angle: when the pitch angle is 0, the two are coaxial, so that the optimal control performance can be ensured; as the pitch angle increases, the gain between the drive shaft and the sensitive shaft becomes smaller and smaller, and when the gain is zero at-90 degrees, the system will open loop, i.e. there is a frame lock in the over-top position. Theoretically, attenuation of gain can be compensated through secant transformation, but the secant compensation can amplify system noise, and when the angle is large, the signal-to-noise ratio is reduced sharply, and the system cannot work normally.
Patent 'a two-axis two-frame gyro stabilizing device' with application number 201220639363.6 discloses a stabilizing control method for two frames, which installs an azimuth gyro on an azimuth motor shaft and a pitch gyro on a pitch motor shaft, so that a sensitive shaft and a motor execution shaft are always coaxial, and the stability problem under a pitch high angle does not exist. However, an obvious defect of the method is that the roll motion of the azimuth rotor in the inertial space is not sensed by the azimuth gyroscope, but the roll motion has a projection component to the azimuth motion of the aiming line, so that the method can only realize the inertial stability of a motor shaft and cannot realize the inertial stability of the aiming line;
the patent with application number 201710771960.1 discloses a method for compensating the aiming line precision of a two-axis two-frame stable platform, which adopts three independent gyros respectively arranged on an azimuth base, a roll base and a pitch axis, and realizes the resolving and compensating of the aiming line through Euler transformation. The method has the problems that orthogonality cannot be guaranteed between the dispersedly installed gyros, and transformation errors are introduced; and the indirect measurement of the visual axis disturbance can cause larger error due to the problems of rotating shaft clearance and the like, and the quality of a control loop is not high.
Disclosure of Invention
Technical problem to be solved
The invention aims to solve the technical problems of how to avoid measurement and shafting orthogonal transmission resolving errors, how to realize system stability in the whole working angle range and simultaneously realize complete compensation for aiming lines.
(II) technical scheme
In order to solve the technical problem, the invention provides a two-axis two-frame stability control method based on equivalent transformation, which comprises the following steps:
step 1: the three-axis integral inertia measuring element is rigidly connected with a visual axis of the sensor to directly measure the three-axis inertia speed of the aiming line and obtain the current pitching inertia speed value of the aiming line
Figure BDA0002515781160000021
Roll inertia velocity value
Figure BDA0002515781160000022
Azimuthal inertial velocity value
Figure BDA0002515781160000023
Step 2: value of pitch inertia velocity
Figure BDA0002515781160000024
After the difference value between the command of the pitching frame and the command of the pitching frame is modulated by a PID controller, a motor of the pitching frame is driven to eliminate the difference value, and a closed-loop control system of the pitching frame can be formed to realize the stability of the pitching direction of the aiming line;
and step 3: calculating roll disturbance of azimuth frame rotor
Figure BDA0002515781160000025
Figure BDA0002515781160000031
Wherein θ is a pitch frame angle measurement;
delta theta is a deviation correction angle between a pitching zero position and a gyro installation zero position;
and 4, step 4: calculating an azimuth disturbance amount of an azimuth frame rotor
Figure BDA0002515781160000032
Figure BDA0002515781160000033
And 5: disturbance of azimuth frame rotor
Figure BDA0002515781160000034
After the instruction difference value of the azimuth frame rotor is modulated by a PID controller, an azimuth frame motor is driven to eliminate the control error, and an azimuth frame closed-loop control system can be formed to realize the inertial stability of the azimuth frame, and the bandwidth of the azimuth frame closed-loop control system is set to be omegaB
Step 6: calculating the speed disturbance quantity of the roll disturbance of the azimuth frame rotor to the azimuth direction of the sight line
Figure BDA0002515781160000035
Figure BDA0002515781160000036
And 7: using second-order low-pass filter to disturb speed
Figure BDA0002515781160000037
Filtering is carried out with a transfer function of
Figure BDA0002515781160000038
wherein ,
Figure BDA0002515781160000039
the filtered velocity disturbance quantity, ξ the damping coefficient, omegalpIs the filter cut-off frequency;
and 8: the filtered velocity disturbance quantity
Figure BDA00025157811600000310
Taking the inverse, inputting the inverse as a feedforward correction signal into the azimuth frame closed-loop control system, namely compensating the speed disturbance in the step 6
Figure BDA00025157811600000311
And realizing the inertial stability of the direction of the sight line.
Wherein the Δ θ value is determined experimentally by:
under the condition of a static base, the azimuth frame rotor is rotated, and the value of delta theta is adjusted to ensure that
Figure BDA00025157811600000312
When 0, this value is the correct mounting deviation correction angle Δ θ.
Wherein xi is set between 0.5 and 0.7.
Wherein, the ω islpIs the cut-off frequency of the filter, the value of which is equal to the bandwidth omega of the closed loop of the motor shaft of the azimuth axisBAnd current pitch angle (θ + Δ θ):
if (theta + delta theta)>θfωlp=αωB
If (theta + delta theta)<θfωlp=0.1~αωB
Wherein α is frequency coefficient, thetafTo compensate for the critical angle.
Wherein the value of alpha is between 0.7 and 0.9.
Wherein, the thetafDetermined by the test method:
will be provided with
Figure 1
Inputting the signal as a feedforward correction signal into an azimuth frame closed-loop control system, rotating a pitching frame, moving the pitching frame from a zero position to a direction of minus 90 degrees until the azimuth frame is in critical oscillation, wherein the angle (theta + delta theta) of the pitching frame is thetaf
The three-axis integrated inertia measurement element is a three-axis integrated MEMS gyroscope.
The three-axis integrated inertial measurement unit is a three-axis integrated IMU inertial measurement unit.
(III) advantageous effects
In order to solve the problems in the prior art, the invention provides a two-axis two-frame stability control method based on equivalent transformation, which has no measurement and shafting orthogonal transmission resolving errors, can realize system stability in the whole working angle range, and can realize complete compensation for a sight line.
Compared with the prior art, the invention has the following beneficial effects:
(1) the invention adopts inertia measurement elements such as a triaxial integrated gyroscope or IMU and the like and is directly and rigidly connected with the aiming line, thereby reducing the measurement error and mathematical transformation error caused by axial installation deviation, axial clearance, scale factors, environmental temperature difference and the like, directly reflecting the inertial speed of the aiming line and effectively improving the measurement precision;
(2) the control method of the two-frame system is subjected to mathematical transformation, and a linear link and a nonlinear link which influence the overhead stability of the two-frame system are distinguished, so that on one hand, the full working range stability of the two-axis system is realized through a stable azimuth motor shaft, on the other hand, the nonlinear speed disturbance of an aiming line caused by the roll disturbance of an azimuth frame rotor is compensated through a feedforward mode, and the combined action of the two can realize the complete stable control of the azimuth of the aiming line;
(3) the invention can keep the performance consistency of the control loop in the full working range, and the related key parameters can be obtained by a simple test method, thereby having better project realizability;
(4) the specific implementation of the technical scheme of the invention can be directly realized through codes, the invention is suitable for most of two-frame systems in the azimuth-pitch form, and the mathematical idea can be popularized to the two-frame system adopting the roll-pitch or azimuth-roll form gimbal, so that the invention has good portability and wide application value.
Drawings
Fig. 1 is a schematic block diagram of a stabilization control method according to an embodiment of the present invention.
Fig. 2 is a schematic view of the roll disturbance compensation principle of the azimuth frame rotor of the present invention.
Detailed Description
In order to make the objects, contents, and advantages of the present invention clearer, the following detailed description of the embodiments of the present invention will be made in conjunction with the accompanying drawings and examples.
In order to solve the problems in the prior art, the invention provides a two-axis two-frame stability control method based on equivalent transformation, as shown in fig. 1 and 2, comprising the following steps:
step 1: the three-axis integral inertia measuring element is rigidly connected with a visual axis of the sensor to directly measure the three-axis inertia speed of the aiming line and obtain the current pitching inertia speed value of the aiming line
Figure BDA0002515781160000051
Roll inertia velocity value
Figure BDA0002515781160000052
Azimuthal inertial velocity value
Figure BDA0002515781160000053
Step 2: value of pitch inertia velocity
Figure BDA0002515781160000054
After the difference value between the command of the pitching frame and the command of the pitching frame is modulated by a PID controller, a motor of the pitching frame is driven to eliminate the difference value, and a closed-loop control system of the pitching frame can be formed to realize the stability of the pitching direction of the aiming line;
and step 3: calculating roll disturbance of azimuth frame rotor
Figure BDA0002515781160000055
Figure BDA0002515781160000056
Wherein θ is a pitch frame angle measurement;
delta theta is a deviation correction angle between a pitching zero position and a gyro installation zero position;
and 4, step 4: calculating an azimuth disturbance amount of an azimuth frame rotor
Figure BDA0002515781160000057
Figure BDA0002515781160000058
And 5: disturbance of azimuth frame rotor
Figure BDA0002515781160000059
After the instruction difference value of the azimuth frame rotor is modulated by a PID controller, an azimuth frame motor is driven to eliminate the control error, and an azimuth frame closed-loop control system can be formed to realize the inertial stability of the azimuth frame, and the bandwidth of the azimuth frame closed-loop control system is set to be omegaB
Step 6: calculating the speed disturbance quantity of the roll disturbance of the azimuth frame rotor to the azimuth direction of the sight line
Figure BDA0002515781160000061
Figure BDA0002515781160000062
And 7: using second-order low-pass filter to disturb speed
Figure BDA0002515781160000063
Filtering is carried out, and the transfer function is:
Figure BDA0002515781160000064
wherein ,
Figure BDA0002515781160000065
the filtered velocity disturbance quantity, ξ the damping coefficient, omegalpIs the filter cut-off frequency;
and 8: the filtered velocity disturbance quantity
Figure BDA0002515781160000066
Taking the inverse, inputting the inverse as a feedforward correction signal into the azimuth frame closed-loop control system, namely compensating the speed disturbance in the step 6
Figure BDA0002515781160000067
And realizing the inertial stability of the direction of the sight line.
Wherein the Δ θ value is determined experimentally by:
under the condition of a static base, the azimuth frame rotor is rotated, and the value of delta theta is adjusted to ensure that
Figure BDA0002515781160000068
When 0, this value is the correct mounting deviation correction angle Δ θ.
Wherein xi is set between 0.5 and 0.7.
Wherein, the ω islpIs the cut-off frequency of the filter, the value of which is equal to the bandwidth omega of the closed loop of the motor shaft of the azimuth axisBAnd current pitch angle (θ + Δ θ):
if (theta + delta theta)>θfωlp=αωB
If (theta + delta theta)<θfωlp=0.1~αωB
Wherein α is frequency coefficient, thetafTo compensate for the critical angle.
Wherein the value of alpha is between 0.7 and 0.9.
Wherein, the thetafDetermined by the test method:
will be provided with
Figure 100002_2
Inputting the signal as a feedforward signal into a position frame closed-loop control system, rotating a pitching frame, moving the pitching frame from a zero position to a direction of minus 90 degrees until the position frame is in critical oscillation, wherein the angle (theta + delta theta) of the pitching frame is thetaf
The three-axis integrated inertia measurement element is a three-axis integrated MEMS gyroscope.
The three-axis integrated inertial measurement unit is a three-axis integrated IMU inertial measurement unit.
Example 1
The embodiment is a certain type of two-shaft two-frame photoelectric pod, which is hung on a certain unmanned aerial vehicle platform, adopts an azimuth-pitching type universal frame, integrates a photoelectric imaging sensor and an electromechanical element in the azimuth-pitching type universal frame, adopts a three-shaft integrated MEMES gyro STIM210 as an inertial measurement element, and adopts an embedded computer as an MCU unit to realize a control algorithm. In order to solve the problems of overhead stability and gain attenuation of a two-frame system, the method disclosed by the invention is adopted to stably control the aiming line.
As shown in fig. 1 and fig. 2, the present invention is further detailed below by combining with the specific implementation of the stability control algorithm and the parameter tuning:
step 1: the three-axis integrated MEMS gyroscope STIM210 is rigidly connected with a visual axis of the sensor, directly measures the inertial velocity of a sighting line, the embedded computer receives and decodes the output signal of the gyroscope through a serial port, and the instantaneous values of the pitching, rolling and azimuth inertial velocities of the sighting line are
Figure BDA0002515781160000071
Step 2: programming programs and PID controllers in embedded computers
Figure BDA0002515781160000072
After the difference value between the command of the pitching frame and the command of the pitching frame is modulated by a PID controller, a motor of the pitching frame is driven to eliminate the difference value and form a closed-loop control system of the pitching frame, so that the pitching direction stability of the aiming line can be realized;
and step 3: calculating roll disturbance of azimuth frame rotor
Figure BDA0002515781160000073
Figure BDA0002515781160000074
Rotating the azimuth frame rotor under static base conditions, observing
Figure BDA0002515781160000075
Real-time calculating the result and continuously adjusting the value of delta theta
Figure BDA0002515781160000076
When the angle is 0, the installation deviation correction angle delta theta is-0.0454 radian, which indicates that the position difference between the currently defined zero position of the pitching frame and the physical zero position of the gyroscope is 2.6 degrees;
and 4, step 4: calculating the orientation disturbance of the rotor in the orientation frame
Figure BDA0002515781160000077
Figure BDA0002515781160000078
And 5: programming programs and PID controllers in embedded computers
Figure BDA0002515781160000079
After the difference value of the direction frame command and the direction frame command is modulated by a PID controller, a direction frame motor is driven to eliminate the difference value and form a direction frame closed-loop control system, so that the direction frame can be stably controlled, the controller parameters are adjusted, and the control bandwidth is 35 Hz;
step 6: calculating the speed disturbance quantity of the roll disturbance of the azimuth frame rotor to the azimuth direction of the sight line
Figure BDA0002515781160000081
Figure BDA0002515781160000082
And 7: will be provided with
Figure BDA0002515781160000083
Inputting the signal as feedforward correction into a closed-loop control system of the azimuth frame, rotating the pitching frame, moving from a zero position to a direction of-90 degrees, and oscillating the azimuth frame about-70 degrees, namely compensating a critical angle thetaf-1.222 radians;
filter cut-off frequency omegalpThe variation with pitch angle is planned as follows:
if (theta + delta theta) > -1.222
ωlp=0.707ωB=0.707*35*2*pi=24.7Hz=155.2rad
If (theta + delta theta) < -1.222
ωlp=(0.3+(θ+Δθ+3.1415)/20*24.4)*2*pi
Filtering out azimuth frame closed-loop control system unresponsiveness before compensating for critical angle
Figure BDA0002515781160000084
The hysteresis cut-off frequency of the compensation critical angle is linearly attenuated to 0.3Hz along with the change of the pitch angle;
using second-order low-pass filter to disturb speed
Figure BDA0002515781160000085
Filtering, wherein the expression is as follows:
Figure BDA0002515781160000086
discretizing the filter by adopting bilinear transformation, and writing codes to realize:
temp=4+4*e*w*t+w*t*w*t;
b0=w*t*w*t/temp;
b1=2*w*t*w*t/temp;
b2=b0;
a1=(8-2*w*t*w*t)/temp;
a2=-(4-4*e*w*t+w*t*w*t)/temp;
Figure BDA0002515781160000087
Figure BDA0002515781160000088
ink2=ink1;
Figure BDA0002515781160000091
outk2=outk1;
Figure BDA0002515781160000092
wherein temp is an intermediate variable, e is a damping coefficient xi, and is set to be 0.6, so that the phase and amplitude of the low-frequency signal before the inflection point of the cut-off frequency can be ensured not to be influenced;
t is the program run period, here 0.001 second;
w is the cut-off frequency omegalp
b0, b1, b2, a1 and a2 are filter parameters after bilinear transformation;
ink1 and outk1 are respectively input and output of the last 1 operation period, and ink2 and outk2 are respectively input and output of the last 2 operation periods;
and 8: the filtered velocity disturbance quantity
Figure BDA0002515781160000093
Taking the inverse, inputting the inverse as a feedforward correction signal into the azimuth frame closed-loop control system, namely compensating the speed disturbance in the step 6
Figure BDA0002515781160000094
And the stability of the direction of the sight line is realized.
The above description is only a preferred embodiment of the present invention, and it should be noted that, for those skilled in the art, several modifications and variations can be made without departing from the technical principle of the present invention, and these modifications and variations should also be regarded as the protection scope of the present invention.

Claims (8)

1. A two-axis two-frame stability control method based on equivalent transformation is characterized by comprising the following steps:
step 1: the three-axis integral inertia measuring element is rigidly connected with the visual axis of the sensor to directly measure the three-axis inertia speed of the aiming line and obtain the aiming lineForward pitch inertial velocity value
Figure FDA0002515781150000011
Roll inertia velocity value
Figure FDA0002515781150000012
Azimuthal inertial velocity value
Figure FDA0002515781150000013
Step 2: value of pitch inertia velocity
Figure FDA0002515781150000014
After the difference value between the command of the pitching frame and the command of the pitching frame is modulated by a PID controller, a motor of the pitching frame is driven to eliminate the difference value, and a closed-loop control system of the pitching frame can be formed to realize the stability of the pitching direction of the aiming line;
and step 3: calculating roll disturbance of azimuth frame rotor
Figure FDA0002515781150000015
Figure FDA0002515781150000016
Wherein θ is a pitch frame angle measurement;
delta theta is a deviation correction angle between a pitching zero position and a gyro installation zero position;
and 4, step 4: calculating an azimuth disturbance amount of an azimuth frame rotor
Figure FDA0002515781150000017
Figure FDA0002515781150000018
And 5: disturbance of azimuth frame rotor
Figure FDA0002515781150000019
After the instruction difference value of the azimuth frame rotor is modulated by a PID controller, an azimuth frame motor is driven to eliminate the control error, and an azimuth frame closed-loop control system can be formed to realize the inertial stability of an azimuth frame, and the bandwidth of the azimuth frame closed-loop control system is set to be omegaB
Step 6: calculating the speed disturbance quantity of the roll disturbance of the azimuth frame rotor to the azimuth direction of the sight line
Figure FDA00025157811500000110
Figure FDA00025157811500000111
And 7: using second-order low-pass filter to disturb speed
Figure FDA00025157811500000112
Filtering is carried out, and the transfer function is:
Figure FDA00025157811500000113
wherein ,
Figure FDA00025157811500000114
the filtered velocity disturbance quantity, ξ the damping coefficient, omegalpIs the filter cut-off frequency;
and 8: the filtered velocity disturbance quantity
Figure FDA0002515781150000021
Taking the inverse, inputting the inverse as a feedforward correction signal into the azimuth frame closed-loop control system, namely compensating the speed disturbance in the step 6
Figure FDA0002515781150000022
And realizing the inertial stability of the direction of the sight line.
2. A two-axis two-frame stability control method based on equivalent transformation as set forth in claim 1, wherein the Δ θ value is determined experimentally:
under the condition of a static base, the azimuth frame rotor is rotated, and the value of delta theta is adjusted to ensure that
Figure FDA0002515781150000023
When 0, this value is the correct mounting deviation correction angle Δ θ.
3. The two-axis two-frame stability control method based on equivalent transformation as set forth in claim 1, wherein ξ is set between 0.5 and 0.7.
4. The equivalent transformation-based two-axis two-frame stability control method of claim 1, wherein ω is ωlpIs the filter cut-off frequency, the value of which is related to the azimuth frame closed loop system bandwidth omegaBAnd current pitch angle (θ + Δ θ):
if (theta + delta theta)>θfωlp=αωB
If (theta + delta theta)<θfωlp=0.1~αωB
Wherein α is frequency coefficient, thetafTo compensate for the critical angle.
5. The two-axis two-frame stability control method based on equivalent transformation as claimed in claim 4, wherein the value of α is between 0.7 and 0.9.
6. The equivalent transformation-based two-axis two-frame stability control method of claim 4, wherein θ isfDetermined by the test method:
will be provided with
Figure 2
As a feed-forward correction signal into the azimuth frame closed-loop control system, the pitch frame is rotatedThe zero position moves towards the direction of minus 90 degrees until the azimuth frame is in critical oscillation, and the angle (theta + delta theta) of the pitching frame is thetaf
7. The two-axis two-frame stability control method based on equivalent transformation as claimed in claim 1, wherein the three-axis integrated inertial measurement unit is a three-axis integrated MEMS gyroscope.
8. A two-axis two-frame stability control method based on equivalent transformation as claimed in claim 1, wherein the three-axis integrated inertial measurement unit is a three-axis integrated IMU inertial measurement unit.
CN202010475775.XA 2020-05-29 2020-05-29 Two-axis two-frame stable control method based on equivalent transformation Active CN111665872B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010475775.XA CN111665872B (en) 2020-05-29 2020-05-29 Two-axis two-frame stable control method based on equivalent transformation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010475775.XA CN111665872B (en) 2020-05-29 2020-05-29 Two-axis two-frame stable control method based on equivalent transformation

Publications (2)

Publication Number Publication Date
CN111665872A true CN111665872A (en) 2020-09-15
CN111665872B CN111665872B (en) 2023-05-02

Family

ID=72385283

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010475775.XA Active CN111665872B (en) 2020-05-29 2020-05-29 Two-axis two-frame stable control method based on equivalent transformation

Country Status (1)

Country Link
CN (1) CN111665872B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114859984A (en) * 2022-04-27 2022-08-05 西安应用光学研究所 Pitching stabilization method under high-speed rotation of two-axis photoelectric search system of moving platform
CN114879748A (en) * 2022-04-11 2022-08-09 西北工业大学 Method for increasing stability of inertially stabilized platform based on electronic image stabilization
CN116907542A (en) * 2023-07-14 2023-10-20 中国科学院长春光学精密机械与物理研究所 Calibration system and calibration method for orthogonal position of triaxial inertial stabilized platform

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090089001A1 (en) * 2007-08-14 2009-04-02 American Gnc Corporation Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
RU2008127531A (en) * 2008-07-07 2010-01-20 Открытое акционерное общество "Научно-производственное предприятие "Конверсия" (ОАО "НПП "Конверсия") (RU) METHOD FOR FORMING SIGNALS inertial control toward the mirror antenna device stationary object SIGHT WITH SIMULTANEOUS signal generation Autonomous HOMING carrier mobility stationary objects SIGHT IN circular rotation of the antenna device installed INSIDE ROTATING HARD roll carrier mobility, AND SYSTEM FOR CARRYING OUT
CN107607128A (en) * 2017-08-31 2018-01-19 天津航天中为数据系统科技有限公司 A kind of frame stability platform sight line precision compensation method of two axle two
CN110554603A (en) * 2019-08-05 2019-12-10 西安工业大学 photoelectric stabilized sighting platform control method based on disturbance observation fractional order controller

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090089001A1 (en) * 2007-08-14 2009-04-02 American Gnc Corporation Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
RU2008127531A (en) * 2008-07-07 2010-01-20 Открытое акционерное общество "Научно-производственное предприятие "Конверсия" (ОАО "НПП "Конверсия") (RU) METHOD FOR FORMING SIGNALS inertial control toward the mirror antenna device stationary object SIGHT WITH SIMULTANEOUS signal generation Autonomous HOMING carrier mobility stationary objects SIGHT IN circular rotation of the antenna device installed INSIDE ROTATING HARD roll carrier mobility, AND SYSTEM FOR CARRYING OUT
CN107607128A (en) * 2017-08-31 2018-01-19 天津航天中为数据系统科技有限公司 A kind of frame stability platform sight line precision compensation method of two axle two
CN110554603A (en) * 2019-08-05 2019-12-10 西安工业大学 photoelectric stabilized sighting platform control method based on disturbance observation fractional order controller

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李红光;纪明;吴玉敬;郭新胜;彭侠;: "大俯仰角度的两轴两框架平台稳定技术" *
邓科;丛爽;孔德杰;沈宏海;尚伟伟;: "陀螺稳定平台中速度环的非线性实验建模" *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114879748A (en) * 2022-04-11 2022-08-09 西北工业大学 Method for increasing stability of inertially stabilized platform based on electronic image stabilization
CN114879748B (en) * 2022-04-11 2024-04-30 西北工业大学 Electronic image stabilization-based inertial stabilization platform stabilization increasing method
CN114859984A (en) * 2022-04-27 2022-08-05 西安应用光学研究所 Pitching stabilization method under high-speed rotation of two-axis photoelectric search system of moving platform
CN114859984B (en) * 2022-04-27 2024-08-13 西安应用光学研究所 Pitching stabilization method of movable platform two-axis photoelectric search system under azimuth high-speed rotation
CN116907542A (en) * 2023-07-14 2023-10-20 中国科学院长春光学精密机械与物理研究所 Calibration system and calibration method for orthogonal position of triaxial inertial stabilized platform

Also Published As

Publication number Publication date
CN111665872B (en) 2023-05-02

Similar Documents

Publication Publication Date Title
US4393597A (en) Stabilized sighting devices for vehicles
CN111665872A (en) Two-axis two-frame stability control method based on equivalent transformation
Hilkert Inertially stabilized platform technology concepts and principles
Baerveldt et al. A low-cost and low-weight attitude estimation system for an autonomous helicopter
CN102749079B (en) Optical fiber strapdown inertial navigation double-shaft rotation modulation method and double-shaft rotation mechanism
US4443952A (en) Gyroscopic apparatus
CN101629826A (en) Coarse alignment method for fiber optic gyro strapdown inertial navigation system based on single axis rotation
CN103292809A (en) Single-shaft rotary type inertial navigation system and special error self-compensation method thereof
CN104101364B (en) Method improving precision of micro-mechanical gyroscope image stabling platform
Ansari et al. Fast steering and quick positioning of large field-of-regard, two-axis, four-gimbaled sight
Li et al. The internal model control design of three-axis inertially stabilized platform for airborne remote sensing
KR20200052705A (en) Line of sight stabilization system with canceling disturbance
CN111006664B (en) Triaxial inertial platform system based on atomic spin gyroscope
KR102381898B1 (en) Approach for control redistribution of coriolis vibratory gyroscope (cvg) for performance improvement
CN105806326A (en) Digital servo control system based on gyrocompass and processing method
CN113867423B (en) Servo turntable azimuth angle tracking control method and device
RU2102785C1 (en) Sighting line stabilizing system
Stockum et al. Electro-mechanical design for precision pointing and tracking systems
US20090296281A1 (en) Bearing Assembly Having a Flex Pivot to Limit Gimbal Bearing Friction for Use in a Gimbal Servo System
Zhou et al. An adaptive frequency disturbance rejection control for an inertial reference unit under unknown disturbance
CN116124180B (en) Gyro inertial navigation self-adaptive alignment method based on multistage temperature prediction
US20100039550A1 (en) Bearing Assembly for Use in a Gimbal Servo System
RU2260773C1 (en) Sight line stabilizer
Wang et al. Research on data drift suppression method of gyroscope sensor Based on First-order Inertia and Low Pass Filter
CN111624873B (en) Variable gain control method for servo loop of triaxial inertially stabilized platform system

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant