where φ denote the vector of
misalignment angles, namely,
System equation
The mission of fi ne alignment is to
obtain more accurate attitude matrix based on coarse alignment, that is,
to estimate precise misalignment angles. In SINS stationary alignment,
the misalignment angles remain
constant, while no SINS navigation
calculation is carried out. Then, the
differential equations of misalignment
angles can be written as

Besides to determine misalignment
angles in the alignment, we also
need to estimate the biases of
accelerometers and gyros which
would be used to compensate the
output of IMU during navigation.
Here, the biases of accelerometers
and gyros are considered as some
noise processes which are consist
of first order Gauss-Markov noise
and Gaussian white noise. Thus,
the IMU error model is written as

Now, combine (11) and (13), system
equation can be written as
Measurement equation
Taking care of the error of
accelerometers, (5) can be written as
|