|
Auterion App SDK
Auterion SDK is a library that can be used by AuterionOS apps to communicate with the system.
|
A filter for estimating Line-of-Sight (LOS) vectors and their rates. More...
#include <auterion_sdk/tracking/los_filter/los_filter.hpp>
Public Member Functions | |
| LosFilter () | |
| Default constructor. | |
| void | init () |
| Initializes the filter without an initial LOS vector. | |
| void | init (const Eigen::Vector3f &los_init) |
| Initializes the filter with a given LOS vector. | |
| void | predict (float dt) |
| Predicts the next state of the filter based on elapsed time. | |
| void | update (const Eigen::Vector3f &los_measurement, float los_variance) |
| Updates the filter state with a new LOS measurement. | |
| Eigen::Vector3f | getLOS () const |
| Gets the current estimated LOS vector. | |
| Eigen::Vector3f | getLOSRate () const |
| Gets the current estimated LOS rate. | |
| const Eigen::MatrixXf | getCovariance () const |
| Gets the covariance matrix of the state. | |
| Eigen::Vector3f | getLOSInnov () const |
| Gets the LOS innovation (difference between measurement and prediction). | |
| Eigen::Vector3f | getLOSInnovVar () const |
| Gets the variance of the LOS innovation. | |
| Eigen::MatrixXf | getStateVariance () const |
| Gets the state variance matrix. | |
| Eigen::MatrixXf | getLOSVariance () const |
| Gets the variance of the LOS estimates. | |
| Eigen::MatrixXf | getLOSRateVariance () const |
| Gets the variance of the LOS rate estimates. | |
A filter for estimating Line-of-Sight (LOS) vectors and their rates.
This class provides functionality for initializing, predicting, and updating the state of a LOS estimation filter. It maintains covariance information and provides access to various state variables.
| auterion::LosFilter::LosFilter | ( | ) |
Default constructor.
Initializes an instance of the LosFilter.
| const Eigen::MatrixXf auterion::LosFilter::getCovariance | ( | ) | const |
Gets the covariance matrix of the state.
| Eigen::Vector3f auterion::LosFilter::getLOS | ( | ) | const |
Gets the current estimated LOS vector.
| Eigen::Vector3f auterion::LosFilter::getLOSInnov | ( | ) | const |
Gets the LOS innovation (difference between measurement and prediction).
| Eigen::Vector3f auterion::LosFilter::getLOSInnovVar | ( | ) | const |
Gets the variance of the LOS innovation.
| Eigen::Vector3f auterion::LosFilter::getLOSRate | ( | ) | const |
Gets the current estimated LOS rate.
| Eigen::MatrixXf auterion::LosFilter::getLOSRateVariance | ( | ) | const |
Gets the variance of the LOS rate estimates.
| Eigen::MatrixXf auterion::LosFilter::getLOSVariance | ( | ) | const |
Gets the variance of the LOS estimates.
| Eigen::MatrixXf auterion::LosFilter::getStateVariance | ( | ) | const |
Gets the state variance matrix.
| void auterion::LosFilter::init | ( | ) |
Initializes the filter without an initial LOS vector.
This function prepares the filter for operation.
| void auterion::LosFilter::init | ( | const Eigen::Vector3f & | los_init | ) |
Initializes the filter with a given LOS vector.
| los_init | Initial Line-of-Sight (LOS) vector. |
| void auterion::LosFilter::predict | ( | float | dt | ) |
Predicts the next state of the filter based on elapsed time.
| dt | Time step for prediction (in seconds). |
| void auterion::LosFilter::update | ( | const Eigen::Vector3f & | los_measurement, |
| float | los_variance | ||
| ) |
Updates the filter state with a new LOS measurement.
| los_measurement | Measured LOS vector. |
| los_variance | Measurement variance. |