Parameters
Matrix<double>
x0
The best estimate of the initial state of the estimate.
Matrix<double>
P0
The covariance of the initial state estimate. If unsure about initial state, set to a large value