This document defines an initial covariance matrix P for state estimation. It sets the diagonal elements of P to be 1 for the relative position swr, relative translational velocity swrd, and relative angular velocity swom states. The matrix P will be used for state estimation with the uncertainty for each state set to 1.
This document defines an initial covariance matrix P for state estimation. It sets the diagonal elements of P to be 1 for the relative position swr, relative translational velocity swrd, and relative angular velocity swom states. The matrix P will be used for state estimation with the uncertainty for each state set to 1.
This document defines an initial covariance matrix P for state estimation. It sets the diagonal elements of P to be 1 for the relative position swr, relative translational velocity swrd, and relative angular velocity swom states. The matrix P will be used for state estimation with the uncertainty for each state set to 1.