-------------------------------------------------------------------------------
   Attitude determination using a Kalman Filter
   See also KFSAAD
-------------------------------------------------------------------------------