Attitude estimation in tiltable body using modified quaternion data representation
First Claim
1. A method of estimating the attitude of a tiltable body, said body including tilt sensing means and angular rate sensing means, the method comprising the steps of:
- outputting angular rate information from said angular rate sensing means;
transforming and integrating said outputted angular rate information to produce first quaternion position information such that said first quaternion position information is constrained to represent a rotation about a horizontal axis in an earth frame of reference;
outputting tilt information from said tilt sensing means;
processing said outputted tilt information to generate second quaternion position information such that said second quaternion position information is constrained to represent a rotation about a horizontal axis in said earth frame of reference;
comparing said first quaternion position information to said second quaternion position information to generate error information; and
using said error information to compensate for drift in said angular rate sensing means.
2 Assignments
0 Petitions
Accused Products
Abstract
The attitude of a tiltable body is tracked and controlled on the basis of signals outputted from gyros and tilt sensors. The signals outputted from the gyros are transformed and integrated to produce estimated position information in the form of a modified quaternion in which the yaw component is constrained to a zero value. Modified quaternion information in the same form is also generated from signals outputted from the tilt sensor and is used to detect and correct an error component in the estimated position information. Gyro drift is also corrected based on the output of the tilt sensor.
-
Citations
11 Claims
-
1. A method of estimating the attitude of a tiltable body, said body including tilt sensing means and angular rate sensing means, the method comprising the steps of:
-
outputting angular rate information from said angular rate sensing means;
transforming and integrating said outputted angular rate information to produce first quaternion position information such that said first quaternion position information is constrained to represent a rotation about a horizontal axis in an earth frame of reference;
outputting tilt information from said tilt sensing means;
processing said outputted tilt information to generate second quaternion position information such that said second quaternion position information is constrained to represent a rotation about a horizontal axis in said earth frame of reference;
comparing said first quaternion position information to said second quaternion position information to generate error information; and
using said error information to compensate for drift in said angular rate sensing means.
-
-
2. A method of estimating the attitude of a tiltable body, said body including tilt sensing means and angular rate sensing means, the method comprising the steps of:
-
outputting angular rate information from said angular rate sensing means;
generating modified quaternion rate information from said outputted angular rate information, said modified quaternion rate information being in the form of a scalar quantity and a two-component vector;
integrating said modified quaternion rate information to generate first modified quaternion attitude information, said step of generating said modified quaternion rate information being constrained so that said first modified quaternion attitude information is of the form e=e0+e1i+e2j, where i, j are imaginary unit vectors which satisfy the following relations with each other and with a third imaginary unit vector k;
- View Dependent Claims (3, 4, 5)
-
-
6. A method of estimating the attitude of a tiltable body, comprising the steps of:
-
generating angular rate information in a body frame;
applying a drift correction signal to said angular rate information to produce corrected angular rate information;
processing said corrected angular rate information using modified quaternion estimated position information to produce modified quaternion estimated rate information referenced to an earth frame, said modified quaternion estimated rate information consisting of a scalar component and two vector components;
adjusting said modified quaternion estimated rate information on the basis of a weighted position error signal to produce an estimated position difference signal;
integrating said estimated position difference signal to produce said modified quaternion estimated position information, said modified quaternion estimated position information consisting of a scalar component and two vector components;
generating tilt information in said earth frame;
using said tilt information to generate modified quaternion reference position information, said modified quaternion reference position information consisting of a scalar component and two vector components;
subtracting said modified quaternion reference position information said modified quaternion estimated position information to produce an error position signal;
weighting said error position signal to produce said weighted position error signal;
converting said error position signal to a tilt angle error signal using said modified quaternion estimated position information;
forming an angular error vector from pitch and roll components of said tilt angle signal and from a yaw component of an angular rate signal generated by converting said corrected angular rate information to said earth frame using said modified quaternion estimated position information;
converting said angular error vector from said earth frame to said body frame using said modified quaternion estimated position information; and
applying weighted integration to said converted angular error vector to generate said drift correction signal. - View Dependent Claims (7)
converting said modified quaternion estimated rate information and said modified quaternion estimated position information to generate Euler angle output information; and
outputting said Euler angle output information to control signal generating means.
-
-
8. Apparatus for estimating the attitude of a tiltable body, comprising:
-
tilt sensing means mounted on said body for outputting tilt information;
angular rate sensing means mounted on said body for outputting angular rate information;
means for generating modified quaternion rate information from said angular rate information outputted from said angular rate sensing means, said modified quaternion rate information being in the form of a scalar quantity and a two-component vector;
means for integrating said modified quaternion rate information to generate first modified quaternion attitude information, said first modified quaternion attitude information being of the form e=e0+ei+e2j;
where i, j are imaginary unit vectors which satisfy the following relations with each other and with a third imaginary unit vector k;
- View Dependent Claims (9, 10, 11)
-
Specification