CN102494688B - Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle - Google Patents
Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle Download PDFInfo
- Publication number
- CN102494688B CN102494688B CN201110366738.6A CN201110366738A CN102494688B CN 102494688 B CN102494688 B CN 102494688B CN 201110366738 A CN201110366738 A CN 201110366738A CN 102494688 B CN102494688 B CN 102494688B
- Authority
- CN
- China
- Prior art keywords
- centerdot
- angular speed
- quaternion
- laguerre
- pitching
- 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
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
The invention discloses a quaternion Laguerre approximate output method based on an angular speed used during extreme flight of a flying vehicle, which is used for solving the technical problem of poor quaternion output accuracy of inertia equipment during extreme flight of the conventional flying vehicle. In a technical scheme, approximate approach description is performed on a rolling angular speed, a pitching angular speed and a yawing angular speed p, q and r by adopting a Shifted Lagnuerre orthogonal polynomial to directly obtain a quaternion state transfer matrix, so that the iterative computation accuracy of a determined quaternion is ensured. Shifted Lagnuerre orthogonal polynomial orders for the rolling angular speed, the pitching angular speed and the yawing angular speed p, q and r can be determined according to engineering accuracy, so that ultra-linear approximation for a quaternion state equation transfer matrix phie[(k+1)T, kT] is realized, the iterative computation accuracy of the determined quaternion is ensured, and the output accuracy of the inertia equipment during extreme flight of the flying vehicle is increased.
Description
Technical field
The present invention relates to a kind of attitude output intent of air craft carried inertial equipment, particularly hypercomplex number Laguerre approximation output method during a kind of aircraft extreme flight based on angular velocity.
Background technology
Conventionally, the acceleration of rigid motion, angular velocity and attitude etc. all depend on inertial equipment output, and the output accuracy that therefore improves inertial equipment has clear and definite practical significance.The spatial movements such as aircraft, torpedo, spacecraft in most of the cases all adopt the rigid motion differential equation; And the differential equation of portraying rigid body attitude is core wherein, with three Eulerian angle, be that pitching, rolling and crab angle are described conventionally, all pitching in Airborne Inertial equipment, rolling and yaw rate are resolved rear output conventionally.When rigid body is when the angle of pitch is ± 90 °, roll angle and crab angle cannot definite values, and it is excessive that the region of simultaneously closing on this singular point solves error, causes intolerable error in engineering and can not use; For fear of this problem, people adopt the method for restriction angle of pitch span, and this degenerates equation, attitude work entirely, thereby be difficult to be widely used in engineering practice.For this reason, pitching, rolling and the yaw rate direct measured value of people based in Airborne Inertial equipment, and adopted the output flight attitudes such as direction cosine method, Rotation Vector, Quaternion Method.
Direction cosine method has been avoided Euler method " unusual " phenomenon, and with direction cosine method, calculating attitude matrix does not have equation degenerate problem, attitude work entirely, but need to solve nine differential equations, calculated amount is larger, and real-time is poor, cannot meet engineering practice requirement.Rotation Vector is as list sample recursion, Shuangzi sample gyration vector, three increment gyration vectors and four increment rotating vector methods and various correction algorithms on this basis and recursive algorithm etc.While studying rotating vector in document, be all based on rate gyro, to be output as the algorithm of angle increment.Yet in Practical Project, the output of some gyros is angle rate signals, as optical fibre gyro, dynamic tuned gyroscope etc.When rate gyro is output as angle rate signal, the Algorithm Error of rotating vector method obviously increases.Hypercomplex number method is the most widely used method, the method is that the function of four Eulerian angle of definition calculates boat appearance, can effectively make up the singularity of Euler method, as long as separate four differential equation of first order formula groups, than direction cosine attitude matrix differential equation calculated amount, there is obvious minimizing, can meet the requirement to real-time in engineering practice.Its conventional computing method have finish card approximatioss, second order, fourth-order Runge-Kutta method and three rank Taylor expansions etc. (Paul G.Savage.A Unified Mathematical Framework for Strapdown Algorithm Design[J] .Journal of guidance, control, and dynamics, 2006,29 (2): 237-248).Finishing card approximatioss essence is list sample algorithm, and what limited rotation was caused can not compensate by exchange error, and the algorithm drift under high current intelligence in attitude algorithm can be very serious.While adopting fourth-order Runge-Kutta method to solve quaternion differential equation, along with the continuous accumulation of integral error, there will be exceed ± 1 phenomenon of trigonometric function value, thereby cause calculating, disperse.Taylor expansion is also because the deficiency of computational accuracy is restricted, particularly for aircraft maneuvering flight, attitude orientation angular speed is conventionally all larger, and the estimated accuracy of attitude has been proposed to requirements at the higher level, and the parameters such as hypercomplex number determine that the error of bringing makes said method in most cases can not meet engineering precision.
Summary of the invention
In order to overcome the large problem of existing hypercomplex number output error, hypercomplex number Laguerre approximation output method while the invention provides a kind of aircraft extreme flight based on angular velocity, the method adopts change Laguerre (Shifted Laguerre) orthogonal polynomial to rolling, pitching, yaw rate p, q, r carries out close approximation description, directly obtain hypercomplex number state-transition matrix, thereby can guarantee to determine the iterative computation precision of hypercomplex number.
The technical scheme that the present invention solves its technical matters employing is that hypercomplex number Laguerre approximation output method during a kind of aircraft extreme flight based on angular velocity, is characterized in comprising the following steps:
According to hypercomplex number continuous state equation
And discrete state equations
e(k+1)=Φ
e[(k+1)T,kT]e(k)
E=[e wherein
1, e
2, e
3, e
4]
t
Φ
e[(k+1) T, kT] is A
estate-transition matrix, T is the sampling period, in full symbol definition is identical;
P, q, r is respectively rolling, pitching, yaw rate; Eulerian angle
θ, ψ refers to respectively rolling, pitching, crab angle;
State-transition matrix is according to approximant
And e (k+1)=Φ
e[(k+1) T, kT] e (k) obtains the time renewal value of hypercomplex number;
Wherein
ξ(t)=[ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
For the recursive form of Laguerre orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0?p
1…p
n-1?p
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
q(t)=[q
0?q
1…q
n-1?q
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
r(t)=[r
0?r
1…r
n-1?r
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
Work as p, q, when the high-order term n of expansion of r is odd number, m=4,6 ..., n+1, m=5 when high-order term n is even number, 7 ..., n+1.
The invention has the beneficial effects as follows: owing to adopting change Laguerre (Shifted Laguerre) orthogonal polynomial to rolling, pitching, yaw rate p, q, r carries out close approximation description, directly obtain hypercomplex number state-transition matrix, thereby guaranteed the iterative computation precision of definite hypercomplex number.
Below in conjunction with embodiment, the present invention is elaborated.
Embodiment
According to hypercomplex number continuous state equation
And discrete state equations
e(k+1)=Φ
e[(k+1)T,kT]e(k)
E=[e wherein
1, e
2, e
3, e
4]
t
Φ
e[(k+1) T, kT] is A
estate-transition matrix, T is the sampling period,
P, q, r is respectively rolling, pitching, yaw rate; Eulerian angle
θ, ψ refers to respectively rolling, pitching, crab angle;
State-transition matrix is according to approximant
And e (k+1)=Φ
e[(k+1) T, kT] e (k) obtains the time renewal value of hypercomplex number;
Wherein
ξ(t)=[ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
For the recursive form of Laguerre (Laguerre) orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0?p
1…p
n-1?p
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
q(t)=[q
0?q
1…q
n-1?q
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
r(t)=[r
0?r
1…r
n-1?r
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t))]
T
Work as p, q, when the high-order term n of expansion of r is odd number, m=4,6 ..., n+1, m=5 when high-order term n is even number, 7 ..., n+1.
Claims (1)
1. the hypercomplex number Laguerre approximation output method during aircraft extreme flight based on angular velocity, is characterized in that comprising the following steps:
According to hypercomplex number continuous state equation
And discrete state equations
e(k+1)=Φ
e[(k+1)T,kT]e(k)
E=[e wherein
1, e
2, e
3, e
4]
t
Φ
e[(k+1) T, kT] is A
estate-transition matrix, T is the sampling period;
P, q, r is respectively rolling, pitching, yaw rate; Eulerian angle
θ, Ψ refers to respectively rolling, pitching, crab angle;
State-transition matrix is according to approximant
And e (k+1)=Φ
e[(k+1) T, kT] e (k) obtains the time renewal value of hypercomplex number;
Wherein
ξ(t)=[ξ
0(t)?ξ
1(t)?…?ξ
n-1(t)?ξ
n(t)]
T
For the recursive form of Laguerre orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0?p
1?…?p
n-1?p
n][ξ
0(t)?ξ
1(t)?…?ξ
n-1(t)?ξ
n(t)]
T
q(t)=[q
0?q
1?…?q
n-1?q
n][ξ
0(t)?ξ
1(t)?…?ξ
n-1(t)?ξ
n(t)]
T
r(t)=[r
0?r
1?…?r
n-1?r
n][ξ
0(t)?ξ
1(t)?…?ξ
n-1(t)?ξ
n(t)]
T
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366738.6A CN102494688B (en) | 2011-11-17 | 2011-11-17 | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366738.6A CN102494688B (en) | 2011-11-17 | 2011-11-17 | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102494688A CN102494688A (en) | 2012-06-13 |
CN102494688B true CN102494688B (en) | 2014-02-26 |
Family
ID=46186532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110366738.6A Expired - Fee Related CN102494688B (en) | 2011-11-17 | 2011-11-17 | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102494688B (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1422380A (en) * | 2000-02-03 | 2003-06-04 | 独立技术有限责任公司 | Attitude estimation in tiltable body using modified quaternion data representation |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES2238936B1 (en) * | 2004-02-27 | 2006-11-16 | INSTITUTO NACIONAL DE TECNICA AEROESPACIAL "ESTEBAN TERRADAS" | SYSTEM AND METHOD OF FUSION OF SENSORS TO ESTIMATE POSITION, SPEED AND ORIENTATION OF A VEHICLE, ESPECIALLY AN AIRCRAFT. |
FR2955934B1 (en) * | 2010-01-29 | 2012-03-09 | Eurocopter France | ESTIMATION STABILIZED IN TURNING ANGLES OF PLATES OF AN AIRCRAFT |
-
2011
- 2011-11-17 CN CN201110366738.6A patent/CN102494688B/en not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1422380A (en) * | 2000-02-03 | 2003-06-04 | 独立技术有限责任公司 | Attitude estimation in tiltable body using modified quaternion data representation |
Also Published As
Publication number | Publication date |
---|---|
CN102494688A (en) | 2012-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102436437B (en) | Quaternion Fourier approximate output method in extreme flight of aircraft based on angular speed | |
CN102589553B (en) | Switching method for building aircraft motion model | |
CN117389312A (en) | Model-based three-dimensional tracking control method for counter roll of underwater vehicle | |
CN102508819B (en) | Angular-speed-based quaternion Legendre approximate output method during extreme flying of aircraft | |
CN102495831B (en) | Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight | |
CN102495830B (en) | Quaternion Hartley approximate output method based on angular velocities for aircraft during extreme flight | |
CN102506866B (en) | Angle speed-based Chebyshev approximate output method of quaternion numbers in ultimate flight of aircraft | |
CN102506865B (en) | Four-ary number polynomial approximate output method during extreme aerobat flight based on angular velocity | |
CN102445202B (en) | Laguerre output method for rigid body space motion state | |
CN102494688B (en) | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle | |
CN102495829A (en) | Quaternion Walsh approximate output method based on angular velocities for aircraft during extreme flight | |
CN102323990B (en) | Method for modeling pneumatic model for rigid body space motion | |
CN102506864B (en) | Method for approximately outputting quaternion numbers with arbitrary step size in orthogonal series during extreme flight of aircraft | |
CN102495825B (en) | Quaternion superlinear output method based on angular velocities for aircraft during extreme flight | |
CN102508818B (en) | Arbitrary-step orthogonal series output method of space motion state of rigid body | |
CN102346729B (en) | Legendre output method for space motion space of rigid body | |
CN102323992B (en) | Polynomial type output method for spatial motion state of rigid body | |
CN102384746B (en) | Chebyshev output method for space motion state of rigid body | |
CN102384747A (en) | Hartley output method of rigid body space motion states | |
CN102359789B (en) | Arbitrary order output method for rigid body space motion state | |
CN102508821B (en) | State output method for space motion of rigid body | |
CN102445203B (en) | Emmett output method for rigid body space motion state | |
CN102359790B (en) | Fourier outputting method for spatial movement state of rigid body | |
CN102375803B (en) | Method for building air stream axle system model for rigid space motion | |
CN102323991B (en) | Walsh output method for spatial motion state of rigid body |
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: 20140226 Termination date: 20191117 |