CN102495831B - Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight - Google Patents
Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight Download PDFInfo
- Publication number
- CN102495831B CN102495831B CN201110366775.7A CN201110366775A CN102495831B CN 102495831 B CN102495831 B CN 102495831B CN 201110366775 A CN201110366775 A CN 201110366775A CN 102495831 B CN102495831 B CN 102495831B
- Authority
- CN
- China
- Prior art keywords
- centerdot
- quaternion
- cos
- sin
- 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
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000005096 rolling process Methods 0.000 claims abstract description 17
- 239000011159 matrix material Substances 0.000 claims abstract description 11
- 238000005070 sampling Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 abstract description 3
- 239000013598 vector Substances 0.000 description 7
- 238000013459 approach Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
Landscapes
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a quaternion Hermitian approximate output method based on angular velocities for an aircraft during extreme flight, which is used for solving the technical problem of poor precision of quaternion outputted by existing inertial equipment when an aircraft is in extreme flight. The technical scheme includes that approximate prescription for a rolling angular velocity p, a pitching angular velocity q and a yawing angular velocity r is realized by the aid of a Hermitian orthogonal polynomial, a quaternion state transition matrix is directly obtained, and accordingly iterative computation precision of quaternion is guaranteed. The quaternion Hermitian approximate output method has the advantages that orders of the Hermitian orthogonal polynomial for the rolling angular velocity p, the pitching angular velocity q and the yawing angular velocity r can be determined according to the requirement of engineering precision, superlinear approximation for a quaternion state equation transition matrix phie[(k+1)T, kT] is realized, iterative computation precision of specified quaternion is guaranteed, and accordingly output precision of inertial equipment is improved when the aircraft is in extreme flight.
Description
Technical field
The present invention relates to a kind of attitude output intent of air craft carried inertial equipment, particularly hypercomplex number Emmett approximation output method when 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, be that pitching, rolling and crab angle are described with three Eulerian angle conventionally, conventionally all resolve rear output by pitching in Airborne Inertial equipment, rolling and yaw rate.When rigid body is in the time that 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 calculating attitude matrix with direction cosine method 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 and recursive algorithm etc. on this basis.While studying rotating vector in document, it is all the algorithm that is output as angle increment based on rate gyro.But in Practical Project, the output of some gyros is angle rate signals, as optical fibre gyro, dynamic tuned gyroscope etc.In the time that 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, there is obvious minimizing than direction cosine attitude matrix differential equation calculated amount, can meet the requirement to real-time in engineering practice.Its conventional computing method have the card of finishing approximatioss, second order, fourth-order Runge-Kutta method and three rank Taylor expansions etc. (Paul G.Savage.A Unified MathematicalFramework for Strapdown Algorithm Design[J] .Journal of guidance, control, anddynamics, 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.Adopt fourth-order Runge-Kutta method while solving quaternion differential equation, along with the continuous accumulation of integral error, there will be exceed ± 1 phenomenon of trigonometric function value, disperse thereby cause calculating.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 Emmett approximation output method while the invention provides a kind of aircraft extreme flight based on angular velocity, the method adopts Emmett orthogonal polynomial to rolling, pitching, yaw rate p, q, r carries out close approximation description, can ensure to determine the iterative computation precision of hypercomplex number, thus inertial equipment output hypercomplex number precision while improving aircraft extreme flight;
The technical scheme that the present invention solves its technical matters employing is that hypercomplex number Emmett approximation output method when 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)
Wherein e=[e
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 Emmett orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0p
1…p
n-1p
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
q(t)=[q
0q
1…q
n-1q
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
r(t)=[r
0r
1…r
n-1r
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
h
12=0.5,h
23=0.25,
…
h
21=0.5,h
41=-1.5,
…
All the other h
ij=0.
The invention has the beneficial effects as follows: due to according to the requirement of engineering precision, determine rolling, pitching, yaw rate p, q, the order of r Emmett orthogonal polynomial, realizes hypercomplex number state equation transition matrix Ф
ethe ultralinear of [(k+1) T, kT] is approached, and has ensured the iterative computation precision of definite hypercomplex number, thus inertial equipment output accuracy while having improved aircraft extreme flight.
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)
Wherein e=[e
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
Emmett orthogonal polynomial is
For the recursive form of Emmett orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0p
1…p
n-1p
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
q(t)=[q
0q
1…q
n-1q
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
r(t)=[r
0r
1…r
n-1r
n][ξ
0(t)ξ
1(t)…ξ
n-1(t)ξ
n(t)]
T
h
12=0.5,h
23=0.25,
…
h
21=0.5,h
41=-1.5,
…
All the other h
ij=0;
When inertial equipment is directly exported to rolling, pitching, yaw rate p, q, r adopts three rank to approach while description, and acquired results also approaches O (T
3), compare the O (T that finishes the methods such as card approaches
2) precision will height.
Claims (1)
1. the hypercomplex number Emmett approximation output method when aircraft extreme flight based on angular velocity, is characterized in that comprising the following steps:
Hypercomplex number continuous state equation is
Discrete state equations is
e(k+1)=Φ
e[(k+1)T,kT]e(k),
Wherein e=[e
1, e
2, e
3, e
4]
t
e
1=cos(φ/2)cos(θ/2)cos(ψ/2)+sin(φ/2)sin(θ/2)sin(ψ/2),
e
2=sin(φ/2)cos(θ/2)cos(ψ/2)-cos(φ/2)sin(θ/2)sin(ψ/2),
e
3=cos(φ/2)sin(θ/2)cos(ψ/2)+sin(φ/2)cos(θ/2)sin(ψ/2),
e
4=cos(φ/2)cos(θ/2)cos(ψ/2)-sin(φ/2)sin(θ/2)cos(ψ/2),
Φ
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 approximate output valve of hypercomplex number Emmett;
Wherein
ξ(t)=[ξ
0(t) ξ
1(t) … ξ
n-1(t) ξ
n(t)]
T,
For the recursive form of Emmett orthogonal polynomial, rolling, pitching, yaw rate p, q, the expansion of r is respectively
p(t)=[p
0p
1… p
n-1p
n][ξ
0(t) ξ
1(t) … ξ
n-1(t) ξ
n(t)]
T
q(t)=[q
0q
1… q
n-1q
n][ξ
0(t) ξ
1(t) … ξ
n-1(t) ξ
n(t)]
T
r(t)=[r
0r
1… r
n-1r
n][ξ
0(t) ξ
1(t) … ξ
n-1(t) ξ
n(t)]
T
All the other h
ij=0.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366775.7A CN102495831B (en) | 2011-11-17 | 2011-11-17 | Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366775.7A CN102495831B (en) | 2011-11-17 | 2011-11-17 | Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102495831A CN102495831A (en) | 2012-06-13 |
CN102495831B true CN102495831B (en) | 2014-08-06 |
Family
ID=46187656
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110366775.7A Expired - Fee Related CN102495831B (en) | 2011-11-17 | 2011-11-17 | Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102495831B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104850127B (en) * | 2015-03-13 | 2017-11-21 | 哈尔滨工程大学 | It is a kind of can dynamic manipulation quadrotor method |
US20210404811A1 (en) * | 2017-04-21 | 2021-12-30 | Shanghai Jiao Tong University | Method for solving attitude of rigid body based on function iterative integration |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101196398A (en) * | 2007-05-25 | 2008-06-11 | 北京航空航天大学 | Spacecraft posture confirming method based on Euler-q algorithm and DD2 filtering |
CN101545778A (en) * | 2008-12-17 | 2009-09-30 | 中国人民解放军海军工程大学 | Initial alignment method of electric control compass based on nonlinear filtering |
-
2011
- 2011-11-17 CN CN201110366775.7A patent/CN102495831B/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101196398A (en) * | 2007-05-25 | 2008-06-11 | 北京航空航天大学 | Spacecraft posture confirming method based on Euler-q algorithm and DD2 filtering |
CN101545778A (en) * | 2008-12-17 | 2009-09-30 | 中国人民解放军海军工程大学 | Initial alignment method of electric control compass based on nonlinear filtering |
Also Published As
Publication number | Publication date |
---|---|
CN102495831A (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 | |
CN112198885B (en) | Unmanned aerial vehicle control method capable of meeting autonomous landing requirement of maneuvering platform | |
CN102589553B (en) | Switching method for building aircraft motion model | |
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 | |
CN102508819B (en) | Angular-speed-based quaternion Legendre approximate output method during extreme flying of aircraft | |
CN117389312A (en) | Model-based three-dimensional tracking control method for counter roll of underwater vehicle | |
CN102506865B (en) | Four-ary number polynomial approximate output method during extreme aerobat flight based on angular velocity | |
CN102506866B (en) | Angle speed-based Chebyshev approximate output method of quaternion numbers in ultimate flight of aircraft | |
CN102506864B (en) | Method for approximately outputting quaternion numbers with arbitrary step size in orthogonal series during extreme flight of aircraft | |
CN102323990B (en) | Method for modeling pneumatic model for rigid body space motion | |
CN102445202B (en) | Laguerre output method for rigid body space motion state | |
CN102495825B (en) | Quaternion superlinear output method based on angular velocities for aircraft during extreme flight | |
CN102494688B (en) | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle | |
CN102508818B (en) | Arbitrary-step orthogonal series output method of space motion state of rigid body | |
CN102495829B (en) | Quaternion Walsh approximate output method based on angular velocities for aircraft during extreme flight | |
CN102323992B (en) | Polynomial type output method for spatial motion state of rigid body | |
CN102346729B (en) | Legendre output method for space motion space of rigid body | |
CN102384747A (en) | Hartley output method of rigid body space motion states | |
CN102375803B (en) | Method for building air stream axle system model for rigid space motion | |
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 | |
CN102359789B (en) | Arbitrary order output method for rigid body space motion state | |
CN102384746B (en) | Chebyshev output method for space 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: 20140806 Termination date: 20191117 |