|
|
|
attitude of a robot at time t; where , , and
|
|
|
indicate the roll, pitch, and yaw, respectively |
|
attitude predicted for time t, before being corrected using the measurements; |
|
|
|
|
attitude estimated for time t through the prediction and correction procedure; |
|
|
|
|
acceleration measured at time t in the instrument coordinate frame; |
|
|
|
|
normalized acceleration measurement;
|
|
magnetic field measured in the instrument coordinate frame; |
|
|
|
|
bias in the magnetic field measurement ;
|
|
magnetic field wherein the bias is compensated from measurement ; |
|
|
|
|
normalized magnetic field measurement;
|
|
geomagnetic field represented in the North-East-Down (NED) coordinate frame |
|
|
appropriate for the geographical location;
|
|
normalized field measurement at time t;
|
|
linear velocity measured by a Doppler velocity log (DVL) in the instrument coordinate |
|
|
frame;
|
|
rotational (angular) velocity measured by a gyroscope in the instrument coordinate frame; |
|
|
|
|
motion function relating attitude and angular velocity in the instrument |
|
|
coordinate frame to the robot’s angular velocity ;
|
|
measurement function relating state to measurement ;
|
|
the kth discretized sampling instant of time |
|
time period between and ;
|