CN102359789B - Arbitrary order output method for rigid body space motion state - Google Patents
Arbitrary order output method for rigid body space motion state Download PDFInfo
- Publication number
- CN102359789B CN102359789B CN 201110280600 CN201110280600A CN102359789B CN 102359789 B CN102359789 B CN 102359789B CN 201110280600 CN201110280600 CN 201110280600 CN 201110280600 A CN201110280600 A CN 201110280600A CN 102359789 B CN102359789 B CN 102359789B
- Authority
- CN
- China
- Prior art keywords
- integral
- rigid body
- output
- motion state
- arbitrary order
- 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 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
- 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 an arbitrary order 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 a linear differential equation by defining the three-ary number; a state transition matrix 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 the 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 GPS, GNSS, the Big Dipper etc. of relying on directly provide; Eulerian angle are represented the rigid space athletic posture, and the differential equation of portrayal rigid body attitude is 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 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.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, as 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 sample algorithm, and to can not compensating by exchange error that limited rotation causes, 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, along with the continuous accumulation of integral error, the trigonometric function value can occur to exceed ± 1 phenomenon, disperse thereby cause calculating; 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 invention provides a kind of any rank output intent of rigid space motion state, this method is by definition ternary number, make that axis is that three speed components and ternary number constitute the linear differential equation group, 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 any rank output intent of rigid space motion state, and its feature 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 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;
2, highly be output as:
Wherein: h is height;
3, attitude angle is output as:
The invention has the beneficial effects as follows: make that by introducing the ternary number state-transition matrix is 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.
Elaborate below in conjunction with the present invention of embodiment.
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 acceleration of gravity, s
1, s
2, s
3Be the ternary number of definition, and
More than desirable t in two formulas
0=kT, t=(k+1) T;
P, q, r are respectively lift-over, pitching, yaw rate, and T is the sampling period; Parameter-definition is identical in full;
2, highly be output as:
Wherein: h is height;
3, attitude angle is output as:
Wherein:
θ, ψ represent lift-over, pitching, crab angle respectively,
Claims (1)
1. any rank output intent of a rigid space motion state, its feature may further comprise the steps:
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 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;
Highly be output as:
Wherein: h is height;
Attitude angle is output as:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110280600 CN102359789B (en) | 2011-09-20 | 2011-09-20 | Arbitrary order output method for rigid body space motion state |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110280600 CN102359789B (en) | 2011-09-20 | 2011-09-20 | Arbitrary order output method for rigid body space motion state |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102359789A CN102359789A (en) | 2012-02-22 |
CN102359789B true CN102359789B (en) | 2013-07-10 |
Family
ID=45585153
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110280600 Expired - Fee Related CN102359789B (en) | 2011-09-20 | 2011-09-20 | Arbitrary order output method for rigid body space motion state |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102359789B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112857366B (en) * | 2021-01-14 | 2022-03-18 | 东南大学 | Optical fiber strapdown inertial navigation system attitude calculation method based on compression structure |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2241959C1 (en) * | 2003-05-20 | 2004-12-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А.Пилюгина" | Method and device for evaluating navigation parameters of controlled mobile objects |
CN1270162C (en) * | 2000-02-03 | 2006-08-16 | 独立技术有限责任公司 | Attitude estimation in tiltable body using modified quaternion data representation |
CN102072729A (en) * | 2009-11-23 | 2011-05-25 | 北京信息科技大学 | Measurement device and measurement method for measuring posture of rotary aircraft |
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-09-20 CN CN 201110280600 patent/CN102359789B/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1270162C (en) * | 2000-02-03 | 2006-08-16 | 独立技术有限责任公司 | Attitude estimation in tiltable body using modified quaternion data representation |
RU2241959C1 (en) * | 2003-05-20 | 2004-12-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А.Пилюгина" | Method and device for evaluating navigation parameters of controlled mobile objects |
CN102072729A (en) * | 2009-11-23 | 2011-05-25 | 北京信息科技大学 | Measurement device and measurement method for measuring posture of rotary aircraft |
Non-Patent Citations (8)
Title |
---|
Asymptotic Behavior on Cox Risk Rrocess Perturbed by Diffusion;WANG Hui-li et.;《CHINESE QUARTERLY JOURNAL OF MATHEMATICS》;20091231;第24卷(第3期);全文 * |
WANG Hui-li et..Asymptotic Behavior on Cox Risk Rrocess Perturbed by Diffusion.《CHINESE QUARTERLY JOURNAL OF MATHEMATICS》.2009,第24卷(第3期),全文. |
一类非线性***的混沌控制;周凤歧等;《航空学报》;20071130;第28卷(第6期);全文 * |
周凤歧等.一类非线性***的混沌控制.《航空学报》.2007,第28卷(第6期),全文. |
基于二次稳定意义上的H2鲁棒性能分析;王进华等;《2001中国控制与决策学术年会论文集》;20011231;全文 * |
王蓓等.递阶H∞优化方法及其在飞控***中的应用.《中国控制会议论文集》.1995,全文. |
王进华等.基于二次稳定意义上的H2鲁棒性能分析.《2001中国控制与决策学术年会论文集》.2001,全文. |
递阶H∞优化方法及其在飞控***中的应用;王蓓等;《中国控制会议论文集》;19951030;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN102359789A (en) | 2012-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102809377A (en) | Aircraft inertia/pneumatic model integrated navigation method | |
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 | |
CN102323990A (en) | Pneumatic model for rigid body space motion | |
CN102346729B (en) | Legendre output method for space motion space of rigid body | |
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 | |
CN102508821B (en) | State output method for space motion of rigid body | |
CN102323991B (en) | Walsh output method for spatial motion state of rigid body | |
CN102495829A (en) | Quaternion Walsh approximate output method based on angular velocities for aircraft during extreme flight | |
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 | |
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 | |
CN102506865B (en) | Four-ary number polynomial approximate output method during extreme aerobat flight based on angular velocity |
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: 20130710 |