CN102494690A - Any eulerian angle step length orthogonal series approximation output method based on angular speed - Google Patents
Any eulerian angle step length orthogonal series approximation output method based on angular speed Download PDFInfo
- Publication number
- CN102494690A CN102494690A CN2011103882077A CN201110388207A CN102494690A CN 102494690 A CN102494690 A CN 102494690A CN 2011103882077 A CN2011103882077 A CN 2011103882077A CN 201110388207 A CN201110388207 A CN 201110388207A CN 102494690 A CN102494690 A CN 102494690A
- Authority
- CN
- China
- Prior art keywords
- cos
- angle
- integral
- eulerian
- formula
- 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.)
- Pending
Links
Abstract
The invention discloses a eulerian angle any step length orthogonal series approximation output method based on an angular speed, which is used for solving the technical problem that the eulerian angle output precision is poor when the existing aircraft maneuvers. The technical scheme is as follows: a plurality of parameters are introduced, the tumbling, the pitching and the jaw rate are developed and approximated by adopting the improved recurrence mode similar to Chebyshev orthogonal polynomial, according to the pitching angle, the tumbling angle and the yaw angle, the high-order approximate integration is conducted on the eulerian angle expression directly, the solution of the eulerian angle linear approximated linearly according to superlinearity, and the determination of the time update iterative computation accuracy of the eulerian angle can be ensured, so that the accuracy of the flight attitude output by inertia equipment can be improved.
Description
Technical field
The present invention relates to a kind of aircraft maneuvering flight and confirm method, particularly relate to the approximate output intent of any step-length orthogonal series of a kind of Eulerian angle based on angular velocity.
Background technology
Inertial equipment has vital role in movable body navigation and control; 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 wait like the flight test and adopts the attitude gyro to measure, but all has measurement such as angular velocity directly resolve output in the plurality of applications field; Main cause is because dynamic attitude sensor costs an arm and a leg, volume is big; Cause a lot of aircraft to adopt angular rate gyroscopes etc. to resolve three Eulerian angle; Make the attitude time upgrade output and become core contents such as navigation; Therefore it is become influences one of inertial navigation system accuracy factors, designs and adopts 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 adopted approximate Long Gekuta method to resolve (Sun Li, Qin Yongyuan; SINS attitude algorithm 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 are coupled mutually in the Eulerian equation, belong to nonlinear differential equation, different in different starting condition with error range under the different flight state, be difficult to guarantee the precision of actual engine request.
Summary of the invention
The problem of Eulerian angle output accuracy difference when overcoming existing aircraft maneuvering flight, the present invention provides any step-length orthogonal series of a kind of Eulerian angle based on angular velocity to be similar to output intent.This method is through introducing a plurality of parameters and adopting the recursive form of improved similar Chebyshev's orthogonal polynomial to launch to approach lift-over, pitching, yaw rate; Through according to finding the solution the angle of pitch, roll angle, crab angle successively; Directly the expression formula of Eulerian angle is carried out high-order approaches integration; Make finding the solution of Eulerian angle approach, thereby can guarantee to confirm the time renewal iterative computation precision of Eulerian angle and the output accuracy of inertance element according to ultralinear.
The technical solution adopted for the present invention to solve the technical problems is: any step-length orthogonal series of a kind of Eulerian angle based on angular velocity is similar to output intent, is characterized in may further comprise the steps:
1, (a) is according to Eulerian equation:
In the formula:
refers to lift-over, pitching, crab angle respectively; P, q, r are respectively lift-over, pitching, yaw rate; Parameter-definition is identical in full; The calculating of these three Eulerian angle is carried out according to the step of finding the solution the angle of pitch, roll angle, crab angle successively; Lift-over, pitching, yaw rate p, q, the n rank expansion of r is respectively
p(t)=[p
0?p
1?L?p
n-1?p
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
q(t)=[q
0?q
1?L?q
n-1?q
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
r(t)=[r
0?r
1?L?r
n-1?r
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
Wherein
Be the recursive form of Chebyshev (Chebyshev) orthogonal polynomial, a is any real number, and T is the sampling period;
(b) time of the angle of pitch upgrades and to find the solution formula and be:
In the formula:
a
1=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ}
2+0.25{[q
0?q
1?L?q
n-1?q
n]ζ}
2
-0.25{[r
0?r
1?L?r
n-1?r
n]ζ}
2
a
2=[q
0?q
1?L?q
n-1?q
n]ζ
-0.5[r
0?r
1?L?r
n-1?r
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
a
3=[r
0?r
1?L?r
n-1?r
n]ζ
+0.5[q
0?q
1?L?q
n-1?q
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
2, (a) under the situation of the known angle of pitch, the time of roll angle upgrades and to find the solution formula and be:
Wherein
a
4=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ(t)}
2-0.25{[r
0?r
1?L?r
n-1?r
n]ζ(t)}
2
-0.25{[q
0?q
1?L?q
n-1?q
n]ζ(t)}
2
a
5=[p
0?p
1?L?p
n-1?p
n]ζ
+0.5[r
0?r
1?L?r
n-1?r
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
a
6=[r
0?r
1?L?r
n-1?r
n]ζ
-0.5[p
0?p
1?L?p
n-1?p
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
(b) deposit under the angle of pitch, the roll angle known case, the formula of finding the solution of crab angle is:
In the formula:
The invention has the beneficial effects as follows: because through introducing a plurality of parameters and adopting the recursive form of improved similar Chebyshev's orthogonal polynomial to launch to approach lift-over, pitching, yaw rate; Through according to finding the solution the angle of pitch, roll angle, crab angle successively; Directly the expression formula of Eulerian angle is carried out high-order approaches integration; Make finding the solution of Eulerian angle approach, thereby guaranteed the time renewal iterative computation precision of definite Eulerian angle and the output accuracy of inertance element according to ultralinear.
Below in conjunction with embodiment the present invention is elaborated.
Embodiment
1, (a) is according to rigid body attitude equation (Eulerian equation):
Wherein:
refers to lift-over, pitching, crab angle respectively; P, q, r are respectively lift-over, pitching, yaw rate; Parameter-definition is identical in full; The calculating of these three Eulerian angle is carried out according to the step of finding the solution the angle of pitch, roll angle, crab angle successively; Lift-over, pitching, yaw rate p, q, the n rank expansion of r is respectively
p(t)=[p
0?p
1?L?p
n-1?p
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
q(t)=[q
0?q
1?L?q
n-1?q
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
r(t)=[r
0?r
1?L?r
n-1?r
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
Wherein
Be the recursive form of Chebyshev (Chebyshev) orthogonal polynomial, a is any real number, and T is the sampling period;
(b) time of the angle of pitch upgrades and to find the solution formula and be:
In the formula:
a
1=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ}
2+0.25{[q
0?q
1?L?q
n-1?q
n]ζ}
2
-0.25{[r
0?r
1?L?r
n-1?r
n]ζ}
2
a
2=[q
0?q
1?L?q
n-1?q
n]ζ
-0.5[r
0?r
1?L?r
n-1?r
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
a
3=[r
0?r
1?L?r
n-1?r
n]ζ
+0.5[q
0?q
1?L?q
n-1?q
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
2, (a) under the situation of the known angle of pitch, the time of roll angle upgrades and to find the solution formula and be:
Wherein
a
4=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ(t)}
2-0.25{[r
0?r
1?L?r
n-1?r
n]ζ(t)}
2
-0.25{[q
0?q
1?L?q
n-1?q
n]ζ(t)}
2
a
5=[p
0?p
1?L?p
n-1?p
n]ζ
+0.5[r
0?r
1?L?r
n-1?r
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
a
6=[r
0?r
1?L?r
n-1?r
n]ζ
-0.5[p
0?p
1?L?p
n-1?p
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
(b) under the angle of pitch, roll angle known case, the formula of finding the solution of crab angle is:
In the formula:
When inertial equipment is directly exported lift-over, pitching, yaw rate p, q, r adopt three rank to approach when describing, and the gained result is also near O (T
3), the O (T of methods such as comparing the direct method of approximation of Eulerian equation or adopt that approximate Long Gekuta method is resolved
2) precision will height.
Claims (1)
1. any step-length orthogonal series of the Eulerian angle based on angular velocity is similar to output intent, it is characterized in that may further comprise the steps:
Step 1, (a) are according to Eulerian equation:
In the formula:
refers to lift-over, pitching, crab angle respectively; P, q, r are respectively lift-over, pitching, yaw rate; Parameter-definition is identical in full; The calculating of these three Eulerian angle is carried out according to the step of finding the solution the angle of pitch, roll angle, crab angle successively; Lift-over, pitching, yaw rate p, q, the n rank expansion of r is respectively
p(t)=[p
0?p
1?L?p
n-1?p
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
q(t)=[q
0?q
1?L?q
n-1?q
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
r(t)=[r
0?r
1?L?r
n-1?r
n][ξ
0(t)?ξ
1(t)?L?ξ
n-1(t)?ξ
n(t)]
T
Wherein
Be the recursive form of Chebyshev (Chebyshev) orthogonal polynomial, a is any real number, and T is the sampling period;
(b) time of the angle of pitch upgrades and to find the solution formula and be:
In the formula:
a
1=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ}
2+0.25{[q
0?q
1?L?q
n-1?q
n]ζ}
2
-0.25{[r
0?r
1?L?r
n-1?r
n]ζ}
2
a
2=[q
0?q
1?L?q
n-1?q
n]ζ
-0.5[r
0?r
1?L?r
n-1?r
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
a
3=[r
0?r
1?L?r
n-1?r
n]ζ
+0.5[q
0?q
1?L?q
n-1?q
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
Step 2, (a) are under the situation of the known angle of pitch, and the renewal of the time of roll angle is found the solution formula and is:
Wherein
a
4=1+[p
0?p
1?L?p
n-1?p
n]Ω[p
0?p
1?L?p
n-1?p
n]
T
+[q
0?q
1?L?q
n-1?q
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
+[r
0?r
1?L?r
n-1?r
n]Ω[r
0?r
1?L?r
n-1?r
n]
T
+0.25{[p
0?p
1?L?p
n-1?p
n]ζ(t)}
2-0.25{[r
0?r
1?L?r
n-1?r
n]ζ(t)}
2
-0.25{[q
0?q
1?L?q
n-1?q
n]ζ(t)}
2
a
5=[p
0?p
1?L?p
n-1?p
n]ζ
+0.5[r
0?r
1?L?r
n-1?r
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
a
6=[r
0?r
1?L?r
n-1?r
n]ζ
-0.5[p
0?p
1?L?p
n-1?p
n]Ω[q
0?q
1?L?q
n-1?q
n]
T
(b) under the angle of pitch, roll angle known case, the formula of finding the solution of crab angle is:
In the formula:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011103882077A CN102494690A (en) | 2011-11-30 | 2011-11-30 | Any eulerian angle step length orthogonal series approximation output method based on angular speed |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011103882077A CN102494690A (en) | 2011-11-30 | 2011-11-30 | Any eulerian angle step length orthogonal series approximation output method based on angular speed |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102494690A true CN102494690A (en) | 2012-06-13 |
Family
ID=46186534
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2011103882077A Pending CN102494690A (en) | 2011-11-30 | 2011-11-30 | Any eulerian angle step length orthogonal series approximation output method based on angular speed |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102494690A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854501A (en) * | 2012-09-03 | 2013-01-02 | 西北工业大学 | Method for detecting distance and speed based on orthogonal baseband signals with any step length |
CN108534774A (en) * | 2018-03-21 | 2018-09-14 | 上海交通大学 | Rigid-body attitude calculation method and system based on function iteration integral |
-
2011
- 2011-11-30 CN CN2011103882077A patent/CN102494690A/en active Pending
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854501A (en) * | 2012-09-03 | 2013-01-02 | 西北工业大学 | Method for detecting distance and speed based on orthogonal baseband signals with any step length |
CN102854501B (en) * | 2012-09-03 | 2014-12-31 | 西北工业大学 | Method for detecting distance and speed based on orthogonal baseband signals with any step length |
CN108534774A (en) * | 2018-03-21 | 2018-09-14 | 上海交通大学 | Rigid-body attitude calculation method and system based on function iteration integral |
WO2019178887A1 (en) * | 2018-03-21 | 2019-09-26 | 上海交通大学 | Function iterative integration-based rigid body attitude calculation method and system |
CN108534774B (en) * | 2018-03-21 | 2020-02-21 | 上海交通大学 | Rigid body attitude calculation method and system based on function iteration integral |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102937450B (en) | A kind of relative attitude defining method based on gyro to measure information | |
CN102645223B (en) | Serial inertial navigation vacuum filtering correction method based on specific force observation | |
CN102519466A (en) | Approximate output method of Eulerian angle Legendre index based on angular velocity | |
CN102494690A (en) | Any eulerian angle step length orthogonal series approximation output method based on angular speed | |
CN102519467A (en) | Approximate output method for eulerian angle Chebyshev index on basis of angular velocity | |
CN104613984B (en) | The robust filtering method of near space vehicle Transfer Alignment model uncertainty | |
CN102495828B (en) | Euler angle Hartley approximate output method based on angular speed | |
CN102435192B (en) | Angular speed-based Eulerian angle optional step length orthogonal series exponential type approximate output method | |
CN102519465B (en) | Angular velocity based Euler angle Fourier exponent approximate output method | |
CN102506870A (en) | Euler angle Hermite exponential approximation output method based on angular velocity | |
CN102519457A (en) | Angular velocity-based Euler angle Fourier approximate output method | |
CN102506873A (en) | Euler angle Laguerre approximate output method based on angle velocity | |
CN102495827B (en) | Euler angle Hermite approximate output method based on angular speed | |
CN102519464B (en) | Angular speed-based Hartley index approximate output method for Eulerian angles | |
CN102519462A (en) | Angular velocity based Euler angle exponent output method | |
CN102495826B (en) | Euler angle Chebyshev approximate output method based on angular speed | |
CN102564423B (en) | Euler angle Walsh approximate output method based on angular speed | |
CN102519468A (en) | Angular velocity based Euler angle Laguerre exponent approximate output method | |
CN102494689A (en) | Approximate output method of Euler angle polynomial class based on angular velocity | |
CN102506869A (en) | Euler angle polynomial class-index approximate output method on basis of angle velocity | |
CN102506874A (en) | Euler angle superlinearity output method based on angle velocity | |
CN102519461B (en) | Euler angle Walsh index approximate output method based on angular velocity | |
CN105260341B (en) | Eulerian angles Legendre's approximation output method based on angular speed | |
CN102506864B (en) | Method for approximately outputting quaternion numbers with arbitrary step size in orthogonal series during extreme flight of aircraft | |
CN102506866B (en) | Angle speed-based Chebyshev approximate output method of quaternion numbers in ultimate flight of aircraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20120613 |
|
RJ01 | Rejection of invention patent application after publication |