CN102445202A - Laguerre output method for rigid body space motion state - Google Patents
Laguerre output method for rigid body space motion state Download PDFInfo
- Publication number
- CN102445202A CN102445202A CN2011102805961A CN201110280596A CN102445202A CN 102445202 A CN102445202 A CN 102445202A CN 2011102805961 A CN2011102805961 A CN 2011102805961A CN 201110280596 A CN201110280596 A CN 201110280596A CN 102445202 A CN102445202 A CN 102445202A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- phi
- laguerre
- rigid body
- output
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title abstract description 21
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 abstract description 7
- 238000004364 calculation method Methods 0.000 abstract description 2
- 230000007704 transition Effects 0.000 abstract 2
- 238000005096 rolling process Methods 0.000 abstract 1
- 239000013598 vector Substances 0.000 description 7
- 238000009825 accumulation Methods 0.000 description 1
- 230000000386 athletic effect Effects 0.000 description 1
- 210000003050 axon Anatomy 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The present invention discloses a Laguerre output method for a rigid body space motion state. According to the method, three velocity components of a machine shaft system and a three-ary number form linear differential equations by defining the three-ary number; a Laguerre orthogonal polynomial is adopted to proximately and closely depict a rolling angle p, a pitching angle q, and a yawing angular velocity r; a state transition matrix of the system can be solved according to a manner of an arbitrary order keeper so as to acquire an expression of a rigid body motion discrete state equation, such that the singularity problem of the attitude equation is avoided so as to acquire the main motion state of the rigid body. According to the present invention, the three-ary number is introduced, such that the state transition matrix is the block upper triangular manner, and can be solved by reducing the order so as to substantially simplify the calculation complexity, and be easily used by the engineering.
Description
Technical field
The present invention relates to the spatial movement rigid model, particularly the big maneuvering flight state output of aircraft problem.
Background technology
Axis is that the rigid motion differential equation is a fundamental equation of describing spatial movements such as aircraft, torpedo, spacecraft.Usually, in data processing etc. was used, the state variable of axon system mainly comprised the X of 3 speed components, three Eulerian angle and earth axes
E, Y
E, Z
EDeng, because Z
EBe defined as vertical ground and point to ground ball center, so Z
EActual flying height for bearing; X
E, Y
EUsually main dependence GPS, GNSS, the Big Dipper etc. directly provide; Eulerian angle are represented the rigid space athletic posture, and the differential equation of portrayal rigid body attitude is a core wherein, is that pitching, lift-over and crab angle are described with three Eulerian angle usually.When the angle of pitch of rigid body was ± 90 °, roll angle and crab angle can't definite values, and it is excessive that error is found the solution in the zone of closing on this singular point simultaneously, caused intolerable error on the engineering and can not use; For fear of this problem, people at first adopt the method for restriction angle of pitch span, and this makes equation degenerate, attitude work entirely, thereby be difficult to be widely used in engineering practice.Along with the research to the aircraft extreme flight, people have adopted direction cosine method, equivalent gyration vector method, hypercomplex number method etc. to calculate the rigid motion attitude again in succession.
Direction cosine method has been avoided " unusual " phenomenon of Eulerian angle describing methods, and calculating attitude matrix with direction cosine method does not have the equation degenerate problem, attitude work entirely; But need find the solution 9 differential equations; Calculated amount is bigger, and real-time is relatively poor, can't satisfy the engineering practice requirement.Equivalence gyration vector method such as list appearance recursion, Shuangzi appearance gyration vector, three increment gyration vectors and four increment rotating vector methods and various correction algorithms on this basis and recursive algorithm etc.When studying rotating vector in the document, all be based on the algorithm that rate gyro is output as angle increment.Yet in actual engineering, the output of some gyros is angle rate signals, like optical fibre gyro, dynamic tuned gyroscope etc.When rate gyro was output as angle rate signal, the Algorithm Error of rotating vector method obviously increased.The hypercomplex number method is that the function of 4 Eulerian angle of definition calculates the boat appearance; Can effectively remedy the singularity of Eulerian angle describing method; As long as separate 4 differential equation of first order formula groups; Analogy has tangible minimizing to cosine attitude matrix differential equation calculated amount, can satisfy in the engineering practice requirement to real-time.Its The common calculation methods has the card of finishing approximatioss, second order, fourth-order Runge-Kutta method and three rank Taylor expansion methods etc.Finishing card approximatioss essence is list appearance algorithm, can not compensate by exchange error what limited rotation caused, and the algorithm drift under high current intelligence in the attitude algorithm can be very serious.When adopting fourth-order Runge-Kutta method to find the solution the hypercomplex number differential equation,, the trigonometric function value can occur to exceed ± 1 phenomenon, disperse thereby cause calculating along with the continuous accumulation of integral error; The Taylor expansion method also is restricted because of the deficiency of computational accuracy.When rigid body is big when motor-driven, angular speed causes the error of said method bigger more greatly; Moreover, the error of attitude estimation usually can cause the error of 4 components of speed, highly output sharply to increase.
Summary of the invention
In order to overcome the existing big problem of rigid motion model output error, the present invention provides a kind of Laguerre output intent of rigid space motion state, and this method is through definition ternary number; Make that axis is that three speed components and ternary number constitute the linear differential equation group; And adopting the Laguerre orthogonal polynomial to lift-over, pitching, yaw rate p, q, r carry out close approximation to be described; Can be according to the state-transition matrix of the mode solving system of any rank retainer; And then obtain the expression formula of rigid motion discrete state equations, avoid attitude equation singular problem, thereby obtained the main motion state of rigid body.
The present invention solves the technical scheme that its technical matters adopts, a kind of Laguerre output intent of rigid space motion state, and its characteristic may further comprise the steps:
1, axis is that three speed components are output as:
Wherein: u, it is x that v, w are respectively along the rigid body axis, y, the speed component of z axle, n
x, n
y, n
zBe respectively along x, y, the overload of z axle, g is an acceleration of gravity, s
1, s
2, s
3Be the ternary number of definition, and
P, q, r are respectively lift-over, pitching, yaw rate, and T is the sampling period; Parameter-definition is identical in full;
Be the recursive form of Laguerre (Laguerre) orthogonal polynomial, lift-over, 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 the expansion of r is odd number, m=4,6 ..., n+1, m=5 when high-order term n is even number, 7 ..., n+1;
2, highly be output as:
Wherein: h is a height;
3, attitude angle is output as:
Wherein:
θ, ψ represent lift-over, pitching, crab angle respectively,
The invention has the beneficial effects as follows: make that through introducing the ternary number state-transition matrix is a triangular form on the piecemeal, can find the solution state-transition matrix by depression of order, simplified computation complexity greatly, be convenient to engineering and use.
Below in conjunction with embodiment the present invention is elaborated.
Embodiment
1, axis is that three speed components are output as:
Wherein: u, it is x that v, w are respectively along the rigid body axis, y, the speed component of z axle, n
x, n
y, n
zBe respectively along x, y, the overload of z axle, g is an acceleration of gravity, s
1, s
2, s
3Be the ternary number of definition, and
P, q, r are respectively lift-over, pitching, yaw rate, and T is the sampling period; Parameter-definition is identical in full;
Be the recursive form of Laguerre (Laguerre) orthogonal polynomial, lift-over, 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 the expansion of r is odd number, m=4,6 ..., n+1, m=5 when high-order term n is even number, 7 ..., n+1;
2, highly be output as:
Wherein: h is a height;
3, attitude angle is output as:.
Wherein:
θ, ψ represent lift-over, pitching, crab angle respectively,
Claims (1)
1. the Laguerre output intent of a rigid space motion state, its characteristic may further comprise the steps:
A) axis is that three speed components are output as:
Wherein: u, it is x that v, w are respectively along the rigid body axis, y, the speed component of z axle, n
x, n
y, n
zBe respectively along x, y, the overload of z axle, g is an acceleration of gravity, s
1, s
2, s
3Be the ternary number of definition, and
P, q, r are respectively lift-over, pitching, yaw rate, and T is the sampling period; Parameter-definition is identical in full;
Be the recursive form of Laguerre (Laguerre) orthogonal polynomial, lift-over, 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 the expansion of r is odd number, m=4,6 ..., n+1, m=5 when high-order term n is even number, 7 ..., n+1;
B) highly be output as:
Wherein: h is a height;
C) attitude angle is output as:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110280596 CN102445202B (en) | 2011-09-20 | 2011-09-20 | Laguerre output method for rigid body space motion state |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110280596 CN102445202B (en) | 2011-09-20 | 2011-09-20 | Laguerre output method for rigid body space motion state |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102445202A true CN102445202A (en) | 2012-05-09 |
CN102445202B CN102445202B (en) | 2013-05-08 |
Family
ID=46007928
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110280596 Expired - Fee Related CN102445202B (en) | 2011-09-20 | 2011-09-20 | Laguerre output method for rigid body space motion state |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102445202B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108303897A (en) * | 2018-03-02 | 2018-07-20 | 西安费斯达自动化工程有限公司 | Aircraft flutter analysis grid model Laguerre modeling method |
CN109214113A (en) * | 2018-09-30 | 2019-01-15 | 西安交通大学 | A kind of new model depression of order method for solving of architectural exterior-protecting construction dynamic heat transfer |
Citations (3)
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 |
US20070213889A1 (en) * | 2004-02-27 | 2007-09-13 | Instituto Nacional De Tecnica Aeroespacial "Esteba Terradas" | Sensor Fusion System and Method for Estimating Position, Speed and Orientation of a Vehicle, in Particular an Aircraft |
US20110190964A1 (en) * | 2010-01-29 | 2011-08-04 | Eurocopter | Turning-stabilized estimation of the attitude angles of an aircraft |
-
2011
- 2011-09-20 CN CN 201110280596 patent/CN102445202B/en not_active Expired - Fee Related
Patent Citations (3)
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 |
US20070213889A1 (en) * | 2004-02-27 | 2007-09-13 | Instituto Nacional De Tecnica Aeroespacial "Esteba Terradas" | Sensor Fusion System and Method for Estimating Position, Speed and Orientation of a Vehicle, in Particular an Aircraft |
US20110190964A1 (en) * | 2010-01-29 | 2011-08-04 | Eurocopter | Turning-stabilized estimation of the attitude angles of an aircraft |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108303897A (en) * | 2018-03-02 | 2018-07-20 | 西安费斯达自动化工程有限公司 | Aircraft flutter analysis grid model Laguerre modeling method |
CN108303897B (en) * | 2018-03-02 | 2020-12-29 | 西安费斯达自动化工程有限公司 | Laguerre modeling method for flutter analysis grid model of aircraft |
CN109214113A (en) * | 2018-09-30 | 2019-01-15 | 西安交通大学 | A kind of new model depression of order method for solving of architectural exterior-protecting construction dynamic heat transfer |
Also Published As
Publication number | Publication date |
---|---|
CN102445202B (en) | 2013-05-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102589553B (en) | Switching method for building aircraft motion model | |
CN102436437B (en) | Quaternion Fourier approximate output method in extreme flight of aircraft based on angular speed | |
CN102445202B (en) | Laguerre output method for rigid body space motion state | |
CN102359789B (en) | Arbitrary order output method for rigid body space motion state | |
CN102384747A (en) | Hartley output method of rigid body space motion states | |
CN102346729B (en) | Legendre output method for space motion space of rigid body | |
CN102323990B (en) | Method for modeling pneumatic model for rigid body space motion | |
CN102384746B (en) | Chebyshev output method for space motion state of rigid body | |
CN102508819B (en) | Angular-speed-based quaternion Legendre approximate output method during extreme flying of aircraft | |
CN102323992B (en) | Polynomial type output method for spatial motion state of rigid body | |
CN102508818B (en) | Arbitrary-step orthogonal series output method of space motion state of rigid body | |
CN102445203B (en) | Emmett output method for rigid body space motion state | |
CN102495830B (en) | Quaternion Hartley approximate output method based on angular velocities for aircraft during extreme flight | |
CN102495831B (en) | Quaternion Hermitian approximate output method based on angular velocities for aircraft during extreme flight | |
CN102359790B (en) | Fourier outputting method for spatial movement state of rigid body | |
CN102323991B (en) | Walsh output method for spatial motion state of rigid body | |
CN102495829B (en) | Quaternion Walsh approximate output method based on angular velocities for aircraft during extreme flight | |
CN102508821B (en) | State output method for space motion of rigid body | |
CN102506866B (en) | Angle speed-based Chebyshev approximate output method of quaternion numbers in ultimate flight of aircraft | |
CN102375803B (en) | Method for building air stream axle system model for rigid space motion | |
CN102346727B (en) | Body axis model for rigid space motion | |
CN102495825B (en) | Quaternion superlinear output method based on angular velocities for aircraft during extreme flight | |
CN102506865B (en) | Four-ary number polynomial approximate output method during extreme aerobat flight based on angular velocity | |
CN102494688B (en) | Quaternion Laguerre approximate output method based on angular speed used during extreme flight of flying vehicle | |
CN102506864B (en) | Method for approximately outputting quaternion numbers with arbitrary step size in orthogonal series during extreme 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 | ||
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: 20130508 |