Quaternion Integration (GPS)

The quaternion approach using a four parameter vector with a unity magnitude constraint allows three degrees of freedom. Due to the unity magnitude constraint, quaternions are elements of a unit sphere in four space. This unit sphere is not a Euclidean vector space in which the usual definitions of vector addition and scaling apply; therefore, care must be taken in the integration of the quaternion differential equation. Since the equations are linear, if the sampling rate is high enough that it is accurate to consider the rotation rate as constant over the sample interval T, then it is possible to find and implement a closed form solution to eqn. (D.30). Such a solution is presented below.

To simplify notation, letso that eqn. (D.30) can be written astmp9A2280_thumb

tmp9A2282_thumb


Our objective is to findtmp9A2283_thumbwhentmp9A2284_thumbis known and Q(t) is constant for tmp9A2285_thumb Given these assumptions, fortmp9A2286_thumbwe have that

tmp9A2291_thumb

and we define the integrating factor

tmp9A2292_thumb

Multiplying the integrating factor into eqn. (D.32) from the left and simplifying proceeds as follows:

tmp9A2293_thumb

Integrating both sides over the interval yields

tmp9A2294_thumb

where it has been recognized that

tmp9A2295_thumb

To write the solution of eqn. (D.34) in a more convenient form, we definetmp9A2296_thumband

tmp9A2298_thumb

where

tmp9A2299_thumb

With these definitions, eqn. (D.34) is equivalent to

tmp9A2300_thumb

Fortunately, the state transition matrix .tmp9A2301_thumballows further simplification. First, it is easily verified by direct multiplication that

tmp9A2303_thumb

Expandingtmp9A2304_thumbusing a power series

tmp9A2305_thumb

Therefore, because the above derivation can be repeated over any interval of duration T for which the assumption of a constant angular rate is valid, we have the general equation

tmp9A2306_thumb

wheretmp9A2307_thumb‘ involve the integral of the angular rates over the fc-th sampling intervaltmp9A2308_thumb

Note that no approximations were made in this derivation, so the solution is in closed form given the assumption thattmp9A2309_thumbis constant over the interval of length T. The solution is easily verified to be norm preserving by showing that the norm of the right side of eqn. (D.36) is equal totmp9A2310_thumb.

The algorithm is not an exact solution to the differential equation over any interval where the angular rates are not constant. In [73] the algorithm of eqn. (D.36) is shown to be second order and a third order algorithm is also presented. The algorithm being second order means the algorithm error contains terms proportional to T3 and higher powers. Because T is small, higher order algorithms have smaller errors; however, the tradeoff is that they require additional computation.

Next post:

Previous post: