|
|
attitude represented by quaternion at time t:
|
|
|
where is the scalar part and is the vector part of the quaternion |
|
|
location at time t:
|
|
|
velocity at time t:
|
|
|
rotational velocity measured by gyroscope in the instrument coordinate frame at time t: |
|
|
|
|
|
acceleration measured in the instrument coordinate frame at time t: |
|
|
|
|
|
measurement of location at time t:
|
|
|
measurement of velocity at time t:
|
|
|
measurement of magnetic field in the instrument coordinate frame at time t: |
|
|
|
|
|
measurement of altitude at time t
|
|
|
bias in altitude measurement at time t:
|
|
|
bias in angular rate measurement at time t:
|
|
|
scale factor in acceleration measurement at time t
|
|
|
gravitational acceleration regarded as constant throughout the implementation |
|
|
in the northeast down (NED) coordinate system |
|
|
geomagnetic field appropriate for a location in the NED coordinate frame that is considered |
|
|
to be constant throughout the experiment:
|
|
|
unit vector in the direction d, where
|