KFSAAD:
--------------------------------------------------------------------------
Implements an extended iterated Kalman Filter for the spin-axis
attitude determination problem.
--------------------------------------------------------------------------
Form:
[xF, P] = KFSAAD( x0, P0, Rcw, Rda, Rsb, cw1, cw2, da1, da2, sb, ue, us,...
er, cant1, cant2, ff, nits, attRef )
--------------------------------------------------------------------------
------
Inputs
------
x0 Initial state [ ra; dec; cwbias1; cwbias2; dabias1;
dabias2; cantbias1; cantbias2; sunbias; erbias]
P0 Initial covariance
Rcw Chordwidth covariance
Rda Dihedral angle measurement covariance
Rsb Sun sensor measurement covariance
cw1 Chordwidth measurement 1
cw2 Chordwidth measurement 2
da1 Dihedral angle measurement 1
da2 Dihedral angle measurement 2
sb Sun sensor measurement
ue Nadir vector
us Sun vector
er Earth radius
cant1 HSA 1 cant angle
cant2 HSA 2 cant angle
ff Forgetting factor (0 to 1)
nits Number of iterations
attRef Reference attitude for plotting [ra dec] (rad)
-------
Outputs
-------
xF Final State
P Covariance matrix
--------------------------------------------------------------------------
Children:
Common: Graphics/NewFig
Common: Graphics/XLabelS
Common: Graphics/YLabelS
SAAD: SAAttDet/CwValid
SAAD: SAAttDet/KFExItMu
