Path: SC/Sensor
% Propagates a quaternion based on updated angular increment measurements. The integration order can be specified but only correction terms up to and including the fourth order terms are included. The third order correction terms require the measurements from the previous time step. The fourth order correction terms require the measurements from the two previous time steps. Note that the sign of all correction terms is opposite that given in the Wong and Breckenridge reference. Testing has not shown this to be an issue. Since version 3. -------------------------------------------------------------------------- Form: q = QProp( qLast, theta, n ) -------------------------------------------------------------------------- ------ Inputs ------ qLast (4,1) Quaternion at last time step theta (3,k) Angular increments from gyro The first column is the most recent output. The second column is the previous output. The third column is the output from 2 time steps ago. n (1,1) The order of the propagator. Terms up to theta^n will be included. ------- Outputs ------- Q3 (4,1) Updated quaternion -------------------------------------------------------------------------- References: Wong, E.C. and W.G. Breckenridge, "Inertial Attitude Determination for a Dual-Spin Planetary Spacecraft", AIAA Journal of Guidance Navigation, and Control Vol. 6, No. 6, Nov-Dec 1983, pp. 491-8. Iwens, R.P. and R.L. Farrenkopf, "Performance Evaluation of a Precision Attitude Determination System", AIAA Paper 71-964, 1971. --------------------------------------------------------------------------
Common: Quaternion/QMult Common: Quaternion/QPose Math: Linear/Factorl Math: Linear/Unit
Back to the SC Module page