CN102323992B - Polynomial type output method for spatial motion state of rigid body - Google Patents
Polynomial type output method for spatial motion state of rigid body Download PDFInfo
- Publication number
- CN102323992B CN102323992B CN201110280619.9A CN201110280619A CN102323992B CN 102323992 B CN102323992 B CN 102323992B CN 201110280619 A CN201110280619 A CN 201110280619A CN 102323992 B CN102323992 B CN 102323992B
- Authority
- CN
- China
- Prior art keywords
- phi
- space motion
- rigid
- state
- rigid body
- 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 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
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 claims 1
- 239000011159 matrix material Substances 0.000 abstract description 8
- 239000013598 vector Substances 0.000 description 7
- 238000005096 rolling process Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 210000003050 axon Anatomy 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 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
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a polynomial type output method for a spatial motion state of a rigid body. In the method, by defining a ternary number, three speed components of a machine body axis system and the ternary number constitute a linear simultaneous differential equation, polynomials are used for performing approximate description on roll rate p, pitch rate q and yaw rate r, a state-transition matrix of a system can be solved according to a random-order keeper manner so as to further obtain an expression of a motion discrete state equation of the rigid body, and thus, the problem of a singular gesture equation is avoided and the main motion state of the rigid body is obtained. In the invention, by introducing the ternary number to make the state-transition matrix be of a blocked upper triangular form, the state-transition matrix can be solved in a reduced order manner, the computation complexity is greatly simplified, and engineering purposes are facilitated.
Description
Technical field
The present invention relates to spatial movement rigid model, particularly the large maneuvering flight State-output of aircraft model modelling approach.
Background technology
Axis is that the rigid motion differential equation is the fundamental equation of describing the spatial movements such as aircraft, torpedo, spacecraft.Conventionally,, in the application such as data processing, the state variable of axon system mainly comprises the X of 3 speed components, three Eulerian angle and earth axes
e, Y
e, Z
edeng, due to Z
ebe defined as vertical ground and point to ground ball center, therefore Z
ereality is negative flying height; X
e, Y
econventionally main GPS, GNSS, the Big Dipper etc. of relying on directly provide; Eulerian angle represent rigid space motion attitude, and the differential equation of portraying rigid body attitude is core wherein, is that pitching, rolling and crab angle are described conventionally with three Eulerian angle.In the time that the angle of pitch of rigid body 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, first 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.Along with the research to aircraft extreme flight, people have adopted again direction cosine method, Rotation Vector, Quaternion Method etc. to calculate rigid motion attitude 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 equation degenerate problem, attitude work entirely, but need to solve 9 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.Quaternion Method is that the function of 4 Eulerian angle of definition calculates boat appearance, can effectively make up the singularity of Eulerian angle describing method, as long as separate 4 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.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.When rigid body is large when motor-driven, angular speed causes more greatly the error of said method larger; Moreover, the error that attitude is estimated usually can cause the error of 4 components of speed, highly output sharply to increase.
Summary of the invention
In order to overcome the large problem of existing rigid motion model output model modeling error, the invention provides a kind of modeling method of rigid space motion state polynomial class output model, the method is by definition Three-ary Number, making axis is that three speed components and Three-ary Number form linear differential equation group, and adopt polynomial class to rolling, pitching, yaw rate p, q, r carries out close approximation description, can be according to the state-transition matrix of the mode solving system of arbitrary order retainer, and then obtain the expression formula of rigid motion discrete state equations, avoid attitude equation singular problem, thereby obtain rigid body main movement state.
The present invention solves the technical scheme that its technical matters adopts, a kind of modeling method of rigid space motion state polynomial class output model, and its feature comprises the following steps:
1, the axis of rigid space motion is that three speed components are output as:
Wherein: u, v, it is x that w is respectively along rigid body axis, y, the rigid space motion 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
3for the Three-ary Number of definition, and
P, q, r is respectively rigid space motion angular velocity in roll, rate of pitch and yaw rate, and T is the sampling period;
P, q, the expansion of r is respectively
p(t)=[p
0p
1…p
n-1p
n]M[1t…t
n-1t
n]
T
q(t)=[q
0q
1…q
n-1q
n]M[1t…t
n-1t
n]
T
r(t)=[r
0r
1…r
n-1r
n]M[1t…t
n-1t
n]
T
M is the constant matrices of predefined,
2, the height of rigid space motion is output as:
Wherein: the height that h is rigid space motion;
3, the attitude angle of rigid space motion is output as:
Wherein:
represent respectively roll angle, the angle of pitch and the crab angle of rigid space motion,
The invention has the beneficial effects as follows: by introducing Three-ary Number, to make state-transition matrix be triangular form on piecemeal, can depression of order solving state transition matrix, greatly simplify computation complexity, be convenient to engineering and use.
Below in conjunction with embodiment, the present invention is elaborated.
Embodiment
1, the axis of rigid space motion is that three speed components are output as:
Wherein: u, v, it is x that w is respectively along rigid body axis, y, the rigid space motion 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
3for the Three-ary Number of definition, and
P, q, r is respectively angular velocity in roll, rate of pitch and the yaw rate of rigid space motion, and T is the sampling period;
P, q, the expansion of r is respectively
p(t)=[p
0p
1…p
n-1p
n]M[1t…t
n-1t
n]
T
q(t)=[q
0q
1…q
n-1q
n]M[1t…t
n-1t
n]
T
r(t)=[r
0r
1…r
n-1r
n]M[1t…t
n-1t
n]
T
M is the constant matrices of predefined, for Chebyshev (Chebyshev) orthogonal polynomial:
Constant matrices
m(i,j)=0,(j>i)
m(i,0)=0,(j=1,2,…,N)
2, the height of rigid space motion is output as:
Wherein: the height that h is rigid space motion;
3, the attitude angle of rigid space motion is output as:
Wherein:
represent respectively roll angle, the angle of pitch and the crab angle of rigid space motion,
Claims (1)
1. a modeling method for rigid space motion state polynomial class output model, described rigid body is aircraft, its feature comprises the following steps:
The axis of rigid space motion is that three speed components are output as:
Wherein: u, v, it is x that w is respectively along rigid body axis, y, the rigid space motion 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
3for the Three-ary Number of definition, and
P, q, r is respectively angular velocity in roll, rate of pitch and the yaw rate of rigid space motion, and T is the sampling period;
P, q, the expansion of r is respectively
p(t)=[p
0?p
1?…?p
n-1?p
n]M[1?t?…?t
n-1?t
n]
T
q(t)=[q
0?q
1?…?q
n-1?q
n]M[1?t…?t
n-1?t
n]
T
r(t)=[r
0?r
1…?r
n-1?r
n]M[1?t?…?t
n-1?t
n]
T
M is the constant matrices of predefined,
The height of rigid space motion is output as:
Wherein: the height that h is rigid space motion;
The attitude angle of rigid space motion is output as:
Wherein:
θ, ψ represents respectively roll angle, the angle of pitch and the crab angle of rigid space motion,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110280619.9A CN102323992B (en) | 2011-09-20 | 2011-09-20 | Polynomial type output method for spatial motion state of rigid body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110280619.9A CN102323992B (en) | 2011-09-20 | 2011-09-20 | Polynomial type output method for spatial motion state of rigid body |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102323992A CN102323992A (en) | 2012-01-18 |
CN102323992B true CN102323992B (en) | 2014-11-19 |
Family
ID=45451733
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110280619.9A Expired - Fee Related CN102323992B (en) | 2011-09-20 | 2011-09-20 | Polynomial type output method for spatial motion state of rigid body |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102323992B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107339987B (en) * | 2017-04-21 | 2021-06-29 | 上海交通大学 | Rigid body attitude calculation method based on function iteration integral |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
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 CN201110280619.9A patent/CN102323992B/en not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102072729A (en) * | 2009-11-23 | 2011-05-25 | 北京信息科技大学 | Measurement device and measurement method for measuring posture of rotary aircraft |
Non-Patent Citations (2)
Title |
---|
余晓艇等.无人机轮式着陆横侧向控制.《***仿真学报》.2010,第22卷第166-171页. * |
无人机轮式着陆横侧向控制;余晓艇等;《***仿真学报》;20100228;第22卷;第166-171页 * |
Also Published As
Publication number | Publication date |
---|---|
CN102323992A (en) | 2012-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
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 | |
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 | |
CN102323992B (en) | Polynomial type output method for spatial motion state of rigid body | |
CN102323990B (en) | Method for modeling pneumatic model for rigid body space motion | |
CN102346729B (en) | Legendre output method for space motion space of rigid body | |
CN102508818B (en) | Arbitrary-step orthogonal series output method of space motion state 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 | |
CN102384747A (en) | Hartley output method of rigid body space motion states | |
CN102323991B (en) | Walsh output method for spatial motion state of rigid body | |
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 | |
CN102508821B (en) | State output method for space motion of rigid body | |
CN102359789B (en) | Arbitrary order output method for rigid body space motion state | |
CN102445203B (en) | Emmett output method for rigid body space motion state | |
CN102375803B (en) | Method for building air stream axle system model for rigid space motion | |
CN102506865B (en) | Four-ary number polynomial approximate output method during extreme aerobat flight based on angular velocity | |
CN102506864B (en) | Method for approximately outputting quaternion numbers with arbitrary step size in orthogonal series during extreme flight of aircraft | |
CN102346727B (en) | Body axis model for rigid space motion | |
CN102506866B (en) | Angle speed-based Chebyshev approximate output method of quaternion numbers in ultimate flight of aircraft | |
CN102359790B (en) | Fourier outputting method for spatial movement state of rigid body | |
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 |
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 |
Granted publication date: 20141119 |
|
CF01 | Termination of patent right due to non-payment of annual fee |