|
|
attitude of a robot at time t; , where , and indicate roll, pitch and yaw |
|
|
attitude estimated at time t through prediction and a correction procedure;
|
|
|
error covariance of the estimated attitude
|
|
|
attitude predicted at time t, before it is corrected by the measurements;
|
|
|
error covariance of the predicted attitude
|
|
|
acceleration measured in the instrument coordinate frame;
|
|
|
normalized acceleration measurement;
|
|
|
magnetic field measured in the instrument coordinate frame;
|
|
|
normalized magnetic field measurement;
|
|
|
measurements of roll, pitch and yaw calculated from the and at time t;
|
|
|
linear velocity of the robot in the robot coordinate frame;
|
|
|
rotational velocity of the robot in the robot coordinate frame;
|
|
|
motion model of a robot that relates the robot attitude and the linear velocity to the rotational velocity of the robot;
|
|
|
the measurement model that relates state to the measurement ;
|
|
|
the k-th discretized sampling time instant |
|
|
time period between and ;
|