CN102519462B - Angular velocity based Euler angle exponent output method - Google Patents
Angular velocity based Euler angle exponent output method Download PDFInfo
- Publication number
- CN102519462B CN102519462B CN 201110380566 CN201110380566A CN102519462B CN 102519462 B CN102519462 B CN 102519462B CN 201110380566 CN201110380566 CN 201110380566 CN 201110380566 A CN201110380566 A CN 201110380566A CN 102519462 B CN102519462 B CN 102519462B
- Authority
- CN
- China
- Prior art keywords
- angle
- integral
- formula
- pitch
- angular velocity
- 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.)
- Expired - Fee Related
Links
Landscapes
- Navigation (AREA)
Abstract
The invention discloses an angular velocity based Euler angle exponent output method, which is used for solving the technical problems that the Euler angle output precision is poor when the traditional aircraft maneuvers. The technical scheme is as follows: a pitch angle, a roll angle and a yaw angle is sequentially solved. The integral solution exponential type ultra-linear approximation of an Euler angle state equation is realized by defining a new parameter | Lambda |, and the determination of time updating iterative calculation accuracy of the Euler angle is ensured, and thus the accuracy of the output of a flight attitude of inertial equipment is improved.
Description
Technical field
The present invention relates to a kind of aircraft maneuvering flight and determine method, particularly relate to a kind of Eulerian angle index output intent based on angular velocity.
Background technology
Inertial equipment has vital role in the movable body navigation with in controlling; The acceleration of rigid motion, angular velocity and attitude etc. all depend on inertial equipment output usually, and the output accuracy that therefore improves inertial equipment has clear and definite practical significance; In inertial equipment, acceleration adopts accelerometer, angular velocity to adopt the direct metering system of angular rate gyroscope, the attitude accuracy of rigid body requires when very high to adopt attitude gyro to measure as the flight test waits, but in a lot of applications, has the measurement such as angular velocity directly to resolve output; Main cause is because dynamically attitude sensor is expensive, volume is large, cause a lot of aircraft to adopt angular rate gyroscopes etc. to resolve three Eulerian angle, make the attitude time upgrade output and become the core contents such as navigation, also make it become one of principal element that affects the inertial navigation system precision, therefore design and adopt the rational attitude time to upgrade the hot subject that output intent just becomes research; From the document of publishing, attitude output is mainly adopted the direct method of approximation of Eulerian equation based on angular velocity or adopts approximate Runge Kutta method to resolve (Sun Li, Qin Yongyuan, attitude algorithms of SINS relatively, China's inertial technology journal, 2006, Vol.14 (3): 6-10; Pu Li, Wang TianMiao, Liang JianHong, Wang Song, An Attitude Estimate Approach using MEMS Sensors for Small UAVs, 2006, IEEE International Conference on Industrial Informatics, 1113-1117); Because three Eulerian angle in Eulerian equation are coupled mutually, belong to nonlinear differential equation, different with the error range under different flight state in different starting condition, be difficult to guarantee the Practical Project permissible accuracy.
Summary of the invention
The poor problem of Eulerian angle output accuracy, the invention provides a kind of Eulerian angle index output intent based on angular velocity when overcoming existing aircraft maneuvering flight.The method is according to solving successively the angle of pitch, roll angle, crab angle, and introduce four parameters, directly the expression formula of Eulerian angle is carried out to high-order approaches integration, make solving according to ultralinear of Eulerian angle approach, thereby can guarantee to determine the time renewal iterative computation precision of Eulerian angle and the output accuracy of inertance element.
The technical solution adopted for the present invention to solve the technical problems is: a kind of Eulerian angle index output intent based on angular velocity is characterized in comprising the following steps:
1, (a) is according to Eulerian equation:
In formula:
refer to respectively rolling, pitching, crab angle; P, q, r is respectively rolling, pitching, yaw rate; Parameter-definition is identical in full; The calculating of these three Eulerian angle is carried out according to the step that solves successively the angle of pitch, roll angle, crab angle;
(b) time of the angle of pitch upgrades and to solve formula and be:
In formula:
T is the sampling period, lower same;
2,, in the situation that the known angle of pitch, the time of roll angle upgrades and solves formula and be:
3, under the angle of pitch, roll angle known case, being solved to of crab angle:
In formula:
The invention has the beneficial effects as follows: owing to solving successively the angle of pitch, roll angle, crab angle, and introduce four parameters, directly the expression formula of Eulerian angle is carried out to high-order approaches integration, make solving according to ultralinear of Eulerian angle approach, thereby guaranteed the time renewal iterative computation precision of definite Eulerian angle and the output accuracy of inertance element.
Below in conjunction with embodiment, the present invention is elaborated.
Embodiment
1, (a) is according to rigid body attitude equation (Eulerian equation):
In formula:
refer to respectively rolling, pitching, crab angle; P, q, r is respectively rolling, pitching, yaw rate; Parameter-definition is identical in full; The calculating of these three Eulerian angle is carried out according to the step that solves successively the angle of pitch, roll angle, crab angle;
(b) time of the angle of pitch upgrades and to solve formula and be:
In formula:
T is the sampling period, lower same;
2,, in the situation that the known angle of pitch, the time of roll angle upgrades and solves formula and be:
3, under the angle of pitch, roll angle known case, being solved to of crab angle:
In formula:
When inertial equipment is directly exported to rolling, pitching, yaw rate p, q, r adopts three rank to approach while describing, and acquired results also approaches O (T
3), compare the direct method of approximation of Eulerian equation or adopt approximate Runge Kutta method the O (T of method such as to resolve
2) precision will height.
Claims (1)
1. the Eulerian angle index output intent based on angular velocity is characterized in that comprising the following steps:
Step 1, (a) are according to Eulerian equation:
In formula:
refer to respectively rolling, pitching, crab angle; P, q, r is respectively rolling, pitching, yaw rate; The calculating of these three Eulerian angle is carried out according to the step that solves successively the angle of pitch, roll angle, crab angle;
(b) time of the angle of pitch upgrades and to solve formula and be:
In formula:
T is the sampling period;
Step 2, in the situation that the known angle of pitch, the time of roll angle upgrades and solves formula and be:
Step 3, under the angle of pitch, roll angle known case, being solved to of crab angle:
In formula:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110380566 CN102519462B (en) | 2011-11-25 | 2011-11-25 | Angular velocity based Euler angle exponent output method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110380566 CN102519462B (en) | 2011-11-25 | 2011-11-25 | Angular velocity based Euler angle exponent output method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102519462A CN102519462A (en) | 2012-06-27 |
CN102519462B true CN102519462B (en) | 2013-12-25 |
Family
ID=46290465
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110380566 Expired - Fee Related CN102519462B (en) | 2011-11-25 | 2011-11-25 | Angular velocity based Euler angle exponent output method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102519462B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105651285B (en) * | 2016-01-07 | 2018-08-10 | 北京电子工程总体研究所 | A kind of computational methods across quadrant attitude angle based on quaternary number |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101033973A (en) * | 2007-04-10 | 2007-09-12 | 南京航空航天大学 | Attitude determination method of mini-aircraft inertial integrated navigation system |
CN101706512A (en) * | 2009-11-25 | 2010-05-12 | 哈尔滨工业大学 | Method for estimating pseudo rate of spacecraft based on attitude measurement information of star sensors and angular momentum measurement information of flywheels |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2955934B1 (en) * | 2010-01-29 | 2012-03-09 | Eurocopter France | ESTIMATION STABILIZED IN TURNING ANGLES OF PLATES OF AN AIRCRAFT |
-
2011
- 2011-11-25 CN CN 201110380566 patent/CN102519462B/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101033973A (en) * | 2007-04-10 | 2007-09-12 | 南京航空航天大学 | Attitude determination method of mini-aircraft inertial integrated navigation system |
CN101706512A (en) * | 2009-11-25 | 2010-05-12 | 哈尔滨工业大学 | Method for estimating pseudo rate of spacecraft based on attitude measurement information of star sensors and angular momentum measurement information of flywheels |
Also Published As
Publication number | Publication date |
---|---|
CN102519462A (en) | 2012-06-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104655131B (en) | Inertial navigation Initial Alignment Method based on ISTSSRCKF | |
CN106052685B (en) | A kind of posture and course estimation method of two-stage separation fusion | |
CN108318038A (en) | A kind of quaternary number Gaussian particle filtering pose of mobile robot calculation method | |
CN103712598B (en) | Attitude determination method of small unmanned aerial vehicle | |
CN109724602A (en) | A kind of attitude algorithm system and its calculation method based on hardware FPU | |
CN102937450B (en) | A kind of relative attitude defining method based on gyro to measure information | |
CN104296745A (en) | 9-dof-sensor-group-based posture detection data fusion method | |
CN108344413A (en) | A kind of underwater glider navigation system and its low precision and high-precision conversion method | |
CN102519462B (en) | Angular velocity based Euler angle exponent output method | |
CN102519466A (en) | Approximate output method of Eulerian angle Legendre index based on angular velocity | |
CN102519467B (en) | Approximate output method for eulerian angle Chebyshev index on basis of angular velocity | |
CN102495828B (en) | Euler angle Hartley approximate output method based on angular speed | |
CN102506870B (en) | Euler angle Hermite exponential approximation output method based on angular velocity | |
CN102519465B (en) | Angular velocity based Euler angle Fourier exponent approximate output method | |
CN102506873B (en) | Euler angle Laguerre approximate output method based on angle velocity | |
CN105241453A (en) | Unmanned aerial vehicle navigation system and unmanned aerial vehicle | |
CN102519457B (en) | Angular velocity-based Euler angle Fourier approximate output method | |
CN102506874B (en) | Euler angle superlinearity output method based on angle velocity | |
CN102495827B (en) | Euler angle Hermite approximate output method based on angular speed | |
CN102494690A (en) | Any eulerian angle step length orthogonal series approximation output method based on angular speed | |
CN102519464B (en) | Angular speed-based Hartley index approximate output method for Eulerian angles | |
CN102519461B (en) | Euler angle Walsh index approximate output method based on angular velocity | |
CN102519468B (en) | Angular velocity based Euler angle Laguerre exponent approximate output method | |
CN102495826B (en) | Euler angle Chebyshev approximate output method based on angular speed | |
CN103162688B (en) | Based on the modeling method of the Inertial Measurement Unit Eulerian angle output model that angular velocity and Legendre are similar to |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20131225 Termination date: 20211125 |