CN104848859B - A kind of control method of three axle stable inertia platforms and self-align orientation thereof - Google Patents
A kind of control method of three axle stable inertia platforms and self-align orientation thereof Download PDFInfo
- Publication number
- CN104848859B CN104848859B CN201410835098.2A CN201410835098A CN104848859B CN 104848859 B CN104848859 B CN 104848859B CN 201410835098 A CN201410835098 A CN 201410835098A CN 104848859 B CN104848859 B CN 104848859B
- Authority
- CN
- China
- Prior art keywords
- jerkmeter
- motor
- inner frame
- rate gyroscope
- platform
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 11
- 230000001133 acceleration Effects 0.000 claims abstract description 12
- 238000005259 measurement Methods 0.000 claims description 10
- 238000009434 installation Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 description 6
- 230000003287 optical effect Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
- 239000011435 rock Substances 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Navigation (AREA)
Abstract
The invention belongs to airborne remote sensing technical field, it relates to a kind of control method of three axle stable inertia platforms and self-align orientation thereof, the fields such as the method is applicable to air to surface observation of navigating, base surveying, ground scouting. The present invention adds strap-down navigation in the controls and resolves module, to through-rate gyro and accelerometer sensitive to the angular rate information of corresponding frame and linear acceleration information resolve and obtain accurate inner frame attitude angle information, thus reach the object following the tracks of geographical vertical line, break away from the present situation that three current axle stable inertia platforms need dependence POS to work.
Description
Technical field
The invention belongs to airborne remote sensing technical field, it relates to a kind of control method of three axle stable inertia platforms and self-align orientation thereof, the fields such as the method is applicable to air to surface observation of navigating, base surveying, ground scouting.
Background technology
In recent years, stable inertia platform technology develop rapidly, is widely applied to airborne remote sensing field. Navigate air to surface observation operation requirement high precision real time imagery, but is subject to the impact of various disturbance when flying due to carrier aircraft, can not ensure stable at the uniform velocity to fly, cause the camera optical axis being arranged in carrier aircraft to rock, and image quality declines. Stable inertia plateform system uses stabilizing gyroscope as camera frame, the various disturbance torques on torque compensation camera rack support axle are exported by motor, thus suppress carrier aircraft low frequency angular movement to the interference of camera, make the constant bearing in the relative inertia space of camera frame, ensure image quality.
When current stable inertia plateform system is used for remote sensing fields, need combined high precision position and attitude measuring system (positionandorientationsystem, POS), the closed loop of the angular rate information realization Controlling System position ring of frame relative in inertia space that the attitude angle information provided according to POS and rate gyroscope are measured and speed ring, follows the tracks of local geographical level and course keeps.
A kind of light-type airborne remote sensing three axle stable inertia plateform system described by Chinese patent CN201110078207.7, the geographical level of the platform body attitude angle information trace locality that Controlling System provides according to POS or two jerkmeter, when not receiving POS information, utilize the thicker camera attitude angle that jerkmeter provides, realize coarse adjustment to put down, but due to the impact by jerkmeter drift and carrier movement, a geographical level that tracking can be kept within the short period of time local. Three axle stable inertia platform Aerostab-2 of Germany's development self do not install jerkmeter, also exist and do not have POS to provide the inoperable problem of attitude benchmark.
Aerial remote sensing stable platform Controlling System comprises roll passage, pitching passage, azimuthal channel three separate subsystems, the effect of roll and pitching passage suppresses aircraft roll and pitch movement to the interference of camera, keeps camera optical axis to overlap with local ground vertical line as far as possible. The effect of azimuthal channel suppresses the motion of aircraft yawing angle to the interference of camera, keeps camera to be directed at a certain course as far as possible.
The control loop of three passages includes rate gyroscope stable loop and attitude angle (track angle) control loop. Rate gyroscope stable loop is interior loop, and effect is that isolation body angular movement is to the interference of camera. Attitude angle (track angle) control loop is external loop, and effect is the horizontal attitude benchmark and the reference course that drive platform platform volume tracing locality.
Summary of the invention
It is an object of the invention to overcome the deficiencies in the prior art, it is proposed to a kind of control method of three axle stable inertia platforms and self-align orientation thereof.
It is an object of the invention to be achieved through the following technical solutions.
The one three axle stable inertia platform of the present invention, this three axles stable inertia platform comprises platform support, platform platform body, inertial measurement cluster, platform driving unit and platform electronic box;
Platform support is in order to support platform platform body;
The useful load such as platform platform body comprises outside framework, middle frame and inner frame, and inner frame is orientation framework, carrying camera, middle frame is pitching framework, and outside framework is roll framework;
Inertial measurement cluster comprises the first rate gyroscope, the 2nd rate gyroscope, the 3rd rate gyroscope, the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter, first rate gyroscope, the 2nd rate gyroscope and the 3rd rate gyroscope are mutually orthogonal installation, and the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter are mutually orthogonal installation; First rate gyroscope, the 2nd rate gyroscope, the 3rd rate gyroscope, the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter are installed in inner frame; First rate gyroscope, the 2nd rate gyroscope and the 3rd rate gyroscope measurement obtain the inertia angular rate information in inner frame three directions, first jerkmeter, the 2nd jerkmeter and the 3rd accelerometer measures obtain the linear acceleration information in inner frame three directions, and the information obtained is supplied to electronic box;
The 3rd torque motor that the first torque motor is defined as middle frame motor, the 2nd torque motor of band deceleration device is defined as outside framework motor and band deceleration device that platform drives unit to comprise band deceleration device is defined as inner frame motor, and inner frame motor is arranged on middle frame and drives that inner frame rotates, middle frame motor is arranged on outside framework and drive that middle frame rotates, outside framework motor is arranged on platform support and drives outside framework to rotate;
Platform clectronic case comprises data acquisition module, strap-down navigation resolves module, power amplifier module and stable gesture stability module; The information of data collecting module collected first rate gyroscope, the 2nd rate gyroscope, the 3rd rate gyroscope, the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter; Strap-down navigation resolves module and follows according to the data that data collecting module collected arrives, and resolves through strap-down navigation and obtains accurate inner frame attitude angle information and positional information; Power amplifier module carries out power magnification rear drive motor towards designated parties to rotation the calculation result of stable gesture stability module; Stablizing gesture stability module reception strap-down navigation and resolve the accurate inner frame attitude angle information obtained, by poor to itself and attitude angle set(ting)value, difference result calculates through gesture stability device and generates angular rate set(ting)value, completes gesture stability loop; The gyro angular rate information that angular rate set(ting)value and data collecting module collected obtain is poor, and difference result calculates through angular rate controller and generates motor drive signal, completes angular rate stable loop; Motor drive signal is through power amplifier module rear drive middle frame motor, outside framework motor and inner frame electric machine rotation, it is achieved the stability contorting of inner frame and ground attitude level and course being kept; The effect stablizing gesture stability module suppresses aircraft pitch, roll, yawing angle motion to the interference of camera, keeps camera optical axis to overlap with local ground vertical line and to be directed at a certain course constant, it is achieved camera to ground attitude level and course maintenance.
Three axle stable inertia plateform systems are made up of three frameworks, outside framework is roll framework, middle frame is pitching framework, inner frame is orientation framework, orientation frame relative freely can rotate around orientation axle in pitching framework, pitching frame relative freely can rotate around pitching axle in roll framework, and roll frame relative freely can rotate around roll axle of bowing in pedestal, realizes the isolation of the motion of airframe track angle, pitch movement, roll angle motion respectively. inertial measurement cluster comprises three rate gyroscopes and three jerkmeters, orthogonal respectively it is arranged on the orientation framework of plateform system, the angular rate relative to inertia space of difference sensitive platforms three frameworks and linear acceleration, Controlling System according to rate gyroscope responsive to frame corners speed information and accelerometer sensitive to linear acceleration information resolve through strap-down navigation and to draw accurate inner frame attitude angle information and positional information, produce control signal, control signal exports control moment by power driver module driving moment motor, Reverse Turning Control corresponding frame is rotated, reach the object of the geographical vertical line of stable inner frame and the camera optical axis and tracking.
The control method of the self-align orientation of a kind of three axle stable inertia platforms of the present invention, step is:
(1) data gathering. Data collecting module collected three gyros and three jerkmeters obtain inner frame relative to the angular rate information in inertia space and linear acceleration information.
(2) strap-down navigation resolves. Strap-down navigation resolves module to carry out strap-down navigation according to the information of collect three gyros and three jerkmeters and resolves the accurate attitude angle information and positional information that obtain inner frame.
(3) stablize gesture stability to calculate. Stablize gesture stability module and carry out gesture stability calculating according to the attitude angle information of inner frame, carry out speed stability contorting calculating according to gyro angular rate information, obtain the actuate signal of motor.
(4) power magnification. Motor drive signal towards designated parties to rotation through power magnification rear drive three motors, reaches and keeps platform stance level and the stable object of gyro.
The present invention's advantage compared with prior art is:
Existing three axle stable inertia plateform systems need the object realizing the geographical vertical line of camera optical axis close tracking in conjunction with POS system, and POS system is arranged on platform inner frame together with camera, and platform receives the attitude angle information of POS, and then realizes attitude closed loop. When not having POS system, due to drift characteristic and the carrier movement of jerkmeter, platform only can rely on the rate gyroscope of self and jerkmeter to realize the tracking function of geographical vertical line in short-term. The present invention adds strap-down navigation in the controls and resolves module, to through-rate gyro and accelerometer sensitive to the angular rate information of corresponding frame and linear acceleration information resolve and obtain accurate inner frame attitude angle information, thus reach the object following the tracks of geographical vertical line, break away from the present situation that three current axle stable inertia platforms need dependence POS to work.
Accompanying drawing explanation
Fig. 1 is the structure block diagram of the present invention;
Fig. 2 is the Controlling System schematic diagram of the present invention;
The strap-down navigation that Fig. 3 is the present invention resolves schematic diagram.
Embodiment
Below in conjunction with drawings and Examples, the invention will be further described.
Embodiment
As shown in Figure 1, a kind of three axle stable inertia platforms, this three axles stable inertia platform comprises platform support 1, platform platform body, inertial measurement cluster, platform driving unit and platform electronic box;
Platform support 1 is in order to support platform platform body;
The useful load such as platform platform body comprises outside framework 2, middle frame 3 and inner frame 4, and inner frame 4 is orientation framework, carrying camera, middle frame 3 is pitching framework, and outside framework 2 is roll framework;
Inertial measurement cluster comprises the first rate gyroscope 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9, first rate gyroscope 5, the 2nd rate gyroscope 7 and the 3rd rate gyroscope 10 are mutually orthogonal installation, and the first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 are mutually orthogonal installation; First rate gyroscope 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 are installed in inner frame 4; The inertia angular rate information obtaining inner frame 4 three directions measured by first rate gyroscope 5, the 2nd rate gyroscope 7 and the 3rd rate gyroscope 10, the linear acceleration information obtaining inner frame 4 three directions measured by first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9, and the information obtained is supplied to electronic box 14;
The 3rd torque motor that the first torque motor is defined as middle frame motor 11, the 2nd torque motor of band deceleration device is defined as outside framework motor 12 and band deceleration device that platform drives unit to comprise band deceleration device is defined as inner frame motor 13, and inner frame motor 13 is arranged on middle frame 3 and drives that inner frame 4 rotates, middle frame motor 11 is arranged on outside framework 2 and drive that middle frame 3 rotates, outside framework motor 12 is arranged on platform support 1 and drives outside framework 2 to rotate;
Platform clectronic case 14 comprises data acquisition module, strap-down navigation resolves module, power amplifier module and stable gesture stability module; The information of data collecting module collected first rate gyroscope the 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9; Strap-down navigation resolves module and follows according to the data that data collecting module collected arrives, and resolves through strap-down navigation and obtains accurate inner frame 4 attitude angle information and positional information; Power amplifier module carries out power magnification rear drive electric machine rotation the calculation result of stable gesture stability module; Stablizing gesture stability module reception strap-down navigation and resolve the accurate inner frame 4 attitude angle information obtained, by poor to itself and attitude angle set-point, difference result calculates through gesture stability device and generates angular rate set-point, completes gesture stability loop; The gyro angular rate information that angular rate set-point and data collecting module collected obtain is poor, and difference result calculates through angular rate controller and generates motor drive signal, completes angular rate stable loop; Motor drive signal is rotated through power amplifier module rear drive middle frame motor 11, outside framework motor 12 and inner frame motor 13, it is achieved the stability contorting of inner frame 4 and ground attitude level and course being kept; The effect stablizing gesture stability module suppresses aircraft pitch, roll, yawing angle motion to the interference of camera, keeps camera optical axis to overlap with local ground vertical line and to be directed at a certain course constant, it is achieved camera to ground attitude level and course maintenance.
Data acquisition module in platform clectronic case 14, strap-down navigation are resolved module, power amplifier module and stable gesture stability module and are realized by numeral, analog hybrid system. Wherein, digital circuits section adopts DSP2812 and FPGA to combine as digital operation treater, and artificial circuit part comprises motor drive ic and peripheral circuit thereof. Wherein, data acquisition module completes primarily of FPGA, and strap-down navigation resolves module and stable gesture stability module completes primarily of DSP2812, and power amplifier module completes primarily of motor drive ic and peripheral circuit thereof.
A control method for the self-align orientation of three axle stable inertia platforms, as shown in Figure 2, step is:
(1) data gathering. FPGA gathers the information of first rate gyroscope 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 every 2ms, and by acquired data storage in inner register, wait the reading order of DSP2812.
(2) strap-down navigation resolves. DSP2812 reads the information of first rate gyroscope 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 every 2ms by address and data bus from FPGA, and carries out a strap-down navigation and resolve. Strap-down navigation resolves principle as shown in Figure 3, and system of coordinates wherein is defined as follows: inertial coordinates system o-xiyizi, inner frame system of coordinates o-xbybzb, terrestrial coordinates system o-xnynzn. The inertial measurement cluster being arranged on inner frame 4 records the angular rate of inner frame 4 relative to inertia spaceAnd accelerationAfter error compensation, with(terrestrial coordinates system is relative to the circular frequency in inertia space) synthesis obtains the angular rate of inner frame 4 relative to terrestrial coordinates systemAnd then resolved by attitude battle array and to obtain the pose transformation matrix that inner frame 4 coordinate is tied to terrestrial coordinates systemAnd the angle of pitchYawing angle (��), roll angle (��). The linear acceleration that first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 recordWarpRealize acceleration vector from inner frame 4 system of coordinates b converting to terrestrial coordinates system nSpeed, the positional information of platform inner frame 4 is obtained through navigation calculation.
Due to the output of the first rate gyroscope 5, the 2nd rate gyroscope 7, the 3rd rate gyroscope 10, first jerkmeter 6, the 2nd jerkmeter 8 and the 3rd jerkmeter 9 is moved except inner frame 4 circular frequency, except linear acceleration, still containing the various error signals self produced in the measurements, according to the error model of the rate gyroscope used, jerkmeter, output need to be done error compensation process. The output of the first rate gyroscope 5, the 2nd rate gyroscope 7 and the 3rd rate gyroscope 10 draws the angular velocity of satellite motion of inner frame 4 after error compensation, carries it into quaternion differential equation formula (formula 1),
Separate this differential equation, try to achieve 4 first q of instantaneous quaternion0��q1��q2��q3Value, thus can obtain pose transformation matrix(formula 2).
Known pose transformation matrixAfter, the platform body angle of pitch can be calculated by formula 3Yawing angle (��), roll angle (��).
(formula 3)
(3) stablize gesture stability to calculate. Stablizing gesture stability calculating and comprise gesture stability calculating and angular rate control calculating, wherein angular rate controls calculating every 2ms execution once, and gesture stability calculates every 10ms execution once. Stablizing gesture stability module and resolve the accurate inner frame 4 attitude angle information obtained according to strap-down navigation, by poor to itself and attitude angle set-point, difference result calculates through gesture stability device and generates angular rate set-point, completes gesture stability loop; The gyro angular rate information that angular rate set-point and data collecting module collected obtain is poor, and difference result calculates the actuate signal generating middle frame motor 11, outside framework motor 12 and inner frame motor 13 through angular rate controller, completes angular rate stable loop.
(4) power magnification. The actuate signal of middle frame motor 11, outside framework motor 12 and inner frame motor 13 is calculated by stable gesture stability every 2ms and regenerates and once enter power amplifier module afterwards, turn into after 28V level, driving middle frame motor 11 to drive middle frame 3, outside framework motor 12 to drive outside framework 2, inner frame motor 13 to drive inner frame 4 to rotate towards the direction reducing attitude angle difference respectively from 3.3V level through power magnification chip and peripheral circuit thereof, reach and keep platform stance level and the stable object of gyro.
The content not being described in detail in specification sheets of the present invention belongs to the known prior art of professional and technical personnel in the field.
Claims (2)
1. an axle stable inertia platform, it is characterised in that: this three axles stable inertia platform comprises platform support (1), platform platform body, inertial measurement cluster, platform driving unit and platform electronic box;
Platform support (1) is in order to support platform platform body;
Platform platform body comprises outside framework (2), middle frame (3) and inner frame (4), inner frame (4) is orientation framework, carrying camera useful load, middle frame (3) is pitching framework, and outside framework (2) is roll framework;
Inertial measurement cluster comprises the first rate gyroscope (5), the 2nd rate gyroscope (7), the 3rd rate gyroscope (10), the first jerkmeter (6), the 2nd jerkmeter (8) and the 3rd jerkmeter (9), first rate gyroscope (5), the 2nd rate gyroscope (7) and the 3rd rate gyroscope (10) are mutually orthogonal installation, and the first jerkmeter (6), the 2nd jerkmeter (8) and the 3rd jerkmeter (9) are mutually orthogonal installation; First rate gyroscope (5), the 2nd rate gyroscope (7), the 3rd rate gyroscope (10), the first jerkmeter (6), the 2nd jerkmeter (8) and the 3rd jerkmeter (9) are installed in inner frame (4); The inertia angular rate information obtaining inner frame (4) three directions measured by first rate gyroscope (5), the 2nd rate gyroscope (7) and the 3rd rate gyroscope (10), the linear acceleration information obtaining inner frame (4) three directions measured by first jerkmeter (6), the 2nd jerkmeter (8) and the 3rd jerkmeter (9), and the information obtained is supplied to electronic box (14);
The first torque motor that platform drives unit to comprise band deceleration device is defined as middle frame motor (11), the 3rd torque motor that the 2nd torque motor with deceleration device is defined as outside framework motor (12) and band deceleration device is defined as inner frame motor (13), inner frame motor (13) is arranged on middle frame (3) and goes up and drive inner frame (4) to rotate, middle frame motor (11) is arranged on outside framework (2) and goes up and drive middle frame (3) to rotate, outside framework motor (12) is arranged on platform support (1) and goes up and drive outside framework (2) to rotate,
Platform clectronic case (14) comprises data acquisition module, strap-down navigation resolves module, power amplifier module and stable gesture stability module; The information of data collecting module collected first rate gyroscope (5), the 2nd rate gyroscope (7), the 3rd rate gyroscope (10), the first jerkmeter (6), the 2nd jerkmeter (8) and the 3rd jerkmeter (9); Strap-down navigation resolves the data that module arrives according to data collecting module collected, resolves through strap-down navigation and obtains inner frame (4) attitude angle information and positional information; Power amplifier module carries out power magnification rear drive motor towards designated parties to rotation the calculation result of stable gesture stability module; Stablizing gesture stability module reception strap-down navigation and resolve inner frame (4) the attitude angle information obtained, by poor to itself and attitude angle set(ting)value, difference result calculates through gesture stability device and generates angular rate set(ting)value, completes gesture stability loop; The gyro angular rate information that angular rate set(ting)value and data collecting module collected obtain is poor, and difference result calculates through angular rate controller and generates motor drive signal, completes angular rate stable loop; Motor drive signal is rotated through power amplifier module rear drive middle frame motor (11), outside framework motor (12) and inner frame motor (13), it is achieved the stability contorting of inner frame (4) and ground attitude level and course being kept.
2. the control method of the self-align orientation of three axle stable inertia platforms as claimed in claim 1, it is characterised in that step is:
(1) information of data collecting module collected first rate gyroscope, the 2nd rate gyroscope, the 3rd rate gyroscope, the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter obtains inner frame relative to the angular rate information in inertia space and linear acceleration information;
(2) strap-down navigation resolves module and carries out strap-down navigation according to the information of the first rate gyroscope collected, the 2nd rate gyroscope, the 3rd rate gyroscope, the first jerkmeter, the 2nd jerkmeter and the 3rd jerkmeter and resolve the accurate attitude angle information and positional information that obtain inner frame;
(3) stablize gesture stability module and carry out gesture stability calculating according to the attitude angle information of inner frame, information according to the first rate gyroscope, the 2nd rate gyroscope, the 3rd rate gyroscope carries out angular rate stability contorting calculating, obtains the actuate signal of middle frame motor, outside framework motor and inner frame motor;
(4) actuate signal of frame motor, outside framework motor and inner frame motor is through power magnification rear drive middle frame driven by motor middle frame, outside framework driven by motor outside framework, inner frame driven by motor inner frame towards designated parties to rotation, reaches and keeps platform stance level and the stable object of gyro.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410835098.2A CN104848859B (en) | 2014-12-26 | 2014-12-26 | A kind of control method of three axle stable inertia platforms and self-align orientation thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410835098.2A CN104848859B (en) | 2014-12-26 | 2014-12-26 | A kind of control method of three axle stable inertia platforms and self-align orientation thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104848859A CN104848859A (en) | 2015-08-19 |
| CN104848859B true CN104848859B (en) | 2016-06-01 |
Family
ID=53848685
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410835098.2A Active CN104848859B (en) | 2014-12-26 | 2014-12-26 | A kind of control method of three axle stable inertia platforms and self-align orientation thereof |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104848859B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106052595A (en) * | 2016-05-25 | 2016-10-26 | 中国人民解放军国防科学技术大学 | Three-axis turntable axis perpendicularity detection method based on laser gyro strap-down inertial navigation |
Families Citing this family (21)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104949676A (en) * | 2015-05-20 | 2015-09-30 | 苏州科技学院 | Drift scanning camera synchronous satellite real-time orbit determination device |
| CN106094887B (en) * | 2016-07-13 | 2023-08-22 | 中北大学 | System integrating three-axis turntable function and stable platform function |
| CN106847005A (en) * | 2016-07-13 | 2017-06-13 | 中北大学 | A kind of microminiature inertial stabilized platform experiment teaching instrument |
| CN106075935A (en) * | 2016-07-15 | 2016-11-09 | 中北大学 | A kind of multi-functional household experiment porch educational toy based on stabilized platform |
| CN106643693B (en) * | 2016-10-14 | 2019-09-13 | 哈尔滨工业大学 | A kind of air-floating ball bearing three-dimensional attitude measuring |
| CN106527459B (en) * | 2016-11-24 | 2020-01-14 | 北京星网卫通科技开发有限公司 | Stable platform and control method thereof |
| CN106896820B (en) * | 2017-02-27 | 2020-05-29 | 北京星网卫通科技开发有限公司 | Inertially stabilized platform |
| CN106959708A (en) * | 2017-03-23 | 2017-07-18 | 南京航空航天大学 | The strapdown Three Degree Of Freedom of Driven by Ultrasonic Motors is from steady platform drive control device |
| CN107228665B (en) * | 2017-05-10 | 2019-08-09 | 北京航天控制仪器研究所 | A kind of hybrid Inertial Platform System |
| CN107315340A (en) * | 2017-05-27 | 2017-11-03 | 中国科学院上海技术物理研究所 | It is a kind of that the steady as device and control method of feedback is measured based on micro electromechanical IMU |
| CN107607114B (en) * | 2017-09-11 | 2020-08-14 | 北京航天控制仪器研究所 | Online frequency characteristic soft test method for digital gyroscope stabilization platform |
| CN107966171A (en) * | 2017-11-15 | 2018-04-27 | 北京无线电测量研究所 | Hollow three axis horizontal revolving table of high accuracy in a kind of heavy load |
| CN107941244B (en) * | 2017-12-21 | 2020-01-17 | 中国电子科技集团公司第二十六研究所 | Cross coupling debugging device and method for triaxial inertial system |
| CN108955680B (en) * | 2018-04-04 | 2022-12-02 | 天津航天中为数据系统科技有限公司 | Integrated design method for gyro stabilization platform and attitude reference |
| CN108896045B (en) * | 2018-06-25 | 2020-08-04 | 南京航空航天大学 | Inertial navigation system without accelerometer and navigation method |
| CN112304310A (en) * | 2019-07-23 | 2021-02-02 | 南京航空航天大学 | Inertial navigation method based on gyroscope information |
| CN110631580B (en) * | 2019-08-22 | 2021-10-01 | 北京航天控制仪器研究所 | Uniaxial inertial platform system based on atomic spin gyroscope |
| CN111141285B (en) * | 2020-01-06 | 2021-01-08 | 中国自然资源航空物探遥感中心 | Aviation gravity measuring device |
| CN112611379B (en) * | 2020-11-27 | 2022-08-16 | 武汉华之洋科技有限公司 | Inertial navigation stable platform and calibration and installation method thereof |
| CN114360309A (en) * | 2021-11-26 | 2022-04-15 | 江西中船航海仪器有限公司 | Total station simulator based on IMU gyroscope |
| CN114515228B (en) * | 2022-03-11 | 2023-05-23 | 上海新纪元机器人有限公司 | Active vibration reduction method and system and active vibration reduction stretcher |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5279483A (en) * | 1990-12-21 | 1994-01-18 | Aerospatiale Societe Nationale Industrielle | Attitude control system for a three-axis stabilized satellite especially a remote sensing satellite |
| CN202452059U (en) * | 2012-01-12 | 2012-09-26 | 西安市瑞特测控技术有限责任公司 | Gyroscope stable holder |
| CN103968840A (en) * | 2014-05-22 | 2014-08-06 | 北京航天控制仪器研究所 | All-digital control platform type inertial navigation system |
-
2014
- 2014-12-26 CN CN201410835098.2A patent/CN104848859B/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5279483A (en) * | 1990-12-21 | 1994-01-18 | Aerospatiale Societe Nationale Industrielle | Attitude control system for a three-axis stabilized satellite especially a remote sensing satellite |
| CN202452059U (en) * | 2012-01-12 | 2012-09-26 | 西安市瑞特测控技术有限责任公司 | Gyroscope stable holder |
| CN103968840A (en) * | 2014-05-22 | 2014-08-06 | 北京航天控制仪器研究所 | All-digital control platform type inertial navigation system |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106052595A (en) * | 2016-05-25 | 2016-10-26 | 中国人民解放军国防科学技术大学 | Three-axis turntable axis perpendicularity detection method based on laser gyro strap-down inertial navigation |
| CN106052595B (en) * | 2016-05-25 | 2017-04-05 | 中国人民解放军国防科学技术大学 | Three-axle table axis verticality detection method based on laser gyro strap down inertial navigation |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104848859A (en) | 2015-08-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104848859B (en) | A kind of control method of three axle stable inertia platforms and self-align orientation thereof | |
| CN103853156B (en) | A kind of small-sized four-rotor aircraft control system based on machine set sensor and method | |
| CN105094138A (en) | Low-altitude autonomous navigation system for rotary-wing unmanned plane | |
| CN103792957B (en) | A kind of light-duty two degrees of freedom camera stable platform apparatus | |
| Pfeifer et al. | Direct georeferencing with on board navigation components of light weight UAV platforms | |
| CN106017463A (en) | Aircraft positioning method based on positioning and sensing device | |
| CN109911188A (en) | The bridge machinery UAV system of non-satellite navigator fix environment | |
| CN107643762A (en) | The UAS and its air navigation aid of independent navigation | |
| CN103472503B (en) | Sonde and upper air wind finding method based on INS | |
| CN202452059U (en) | Gyroscope stable holder | |
| CN205540288U (en) | Unmanned aerial vehicle system with multi -functional ground satellite station | |
| CN102393201B (en) | Dynamic lever arm compensating method of position and posture measuring system (POS) for aerial remote sensing | |
| CN110007354B (en) | Device and method for measuring flight parameters of semi-aviation transient electromagnetic receiving coil of unmanned aerial vehicle | |
| CN102809377A (en) | Aircraft inertia/pneumatic model integrated navigation method | |
| CN105929836B (en) | Control method for quadrotor | |
| CN201955092U (en) | Platform type inertial navigation device based on geomagnetic assistance | |
| CN112986612B (en) | Low-altitude movable wind speed measurement method based on four-rotor unmanned aerial vehicle | |
| CN102768043B (en) | Integrated attitude determination method without external observed quantity for modulated strapdown system | |
| CN103363992A (en) | Method for solving attitude and heading reference system of four-rotor unmanned aerial vehicle based on gradient descent | |
| CN105973271A (en) | Self-calibration method of hybrid type inertial navigation system | |
| CN110017837A (en) | A kind of Combinated navigation method of the diamagnetic interference of posture | |
| CN105841698A (en) | AUV rudder angle precise real-time measurement system without zero setting | |
| CN104535048B (en) | A kind of unmanned vehicle remote sensing system and unmanned vehicle remote sensing technique | |
| Chan et al. | Sensor data fusion for attitude stabilization in a low cost Quadrotor system | |
| CN109581365A (en) | A kind of life-detection system based on multi-rotor unmanned aerial vehicle, method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| EXSB | Decision made by sipo to initiate substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |