Resurgence (PY2022)
Codebase for the Husky Robotics 2021-2022 rover Resurgence
|
Base class for Kalman Filters. More...
#include <KalmanFilterBase.h>
Public Member Functions | |
virtual void | predict (const Eigen::Matrix< double, inputDim, 1 > &input)=0 |
Use the model to predict the next system state, given the current inputs. | |
void | reset () |
Reset the filter. | |
void | reset (const Eigen::Matrix< double, stateDim, 1 > &state) |
Reset the filter. | |
void | reset (const Eigen::Matrix< double, stateDim, 1 > &state, const Eigen::Matrix< double, stateDim, 1 > &stdDevs) |
Reset the filter. | |
void | reset (const Eigen::Matrix< double, stateDim, 1 > &state, const Eigen::Matrix< double, stateDim, stateDim > &estCovMat) |
Reset the filter. | |
Eigen::Matrix< double, stateDim, 1 > | getState () const |
Gets the current state estimate. | |
Eigen::Matrix< double, stateDim, stateDim > | getEstimateCovarianceMat () const |
Get the current estimate covariance matrix. | |
Protected Attributes | |
Eigen::Matrix< double, stateDim, stateDim > | P |
Eigen::Matrix< double, stateDim, 1 > | xHat |
Base class for Kalman Filters.
stateDim | The dimension of the state vector. |
inputDim | The dimension of the input vector, or system actions. |
|
inline |
Get the current estimate covariance matrix.
This is an indication of the uncertainty of the pose estimate.
|
inline |
Gets the current state estimate.
|
pure virtual |
Use the model to predict the next system state, given the current inputs.
input | The current inputs to the system. |
Implemented in filters::ExtendedKalmanFilter< stateDim, inputDim, outputDim, processNoiseDim, outputNoiseDim >, and filters::KalmanFilter< stateDim, inputDim, outputDim >.
|
inline |
Reset the filter.
Sets the state estimate to the zero vector and resets the estimate covariance matrix to a diagonal matrix with large values.
|
inline |
Reset the filter.
Sets the state estimate to the supplied vector and resets the estimate covariance matrix to a diagonal matrix with large values.
state | The state to which the state estimate will be set. |
|
inline |
Reset the filter.
Sets the state estimate to the supplied vector with the given uncertainty.
state | The state to set the vector to. |
stdDevs | The standard deviation of the measurement of each element in the state vector. This should not be the zero vector. If you want to represent high certainty, use very small values instead. |
|
inline |
Reset the filter.
Sets the state estimate to the supplied vector and the estimate covariance matrix to the supplied matrix.
state | The state to set the vector to. |
estCovMat | The matrix to set the estimate covariance matrix to. This should not be the zero matrix. If you want to represent high certainty, use a diagonal matrix with very small values. |