Jafar
|
Point at infinity bearing-only observe model. More...
Point at infinity bearing-only observe model.
Definition at line 44 of file pointInfFeature.hpp.
#include <pointInfFeature.hpp>
Public Member Functions | |
BearingPointInfFeatureObserveModel (PointInfFeatureModel &featureModel_) | |
Observation::ObservationType | typeObs () const |
jblas::vec const & | computeInnovation (jblas::vec const &z_, jblas::vec const &zPred_) |
By default, simply do the substraction. | |
Protected Member Functions | |
jblas::vec const & | predictObservationInSensorFrame (const jblas::vec &feature_) |
Prediction of the observation, the feature is expressed in the sensor frame featureInSensorFrame_. | |
void | predictObservationInSensorFrameJac (const jblas::vec &feature_) |
Jacobian of predictObservationInSensorFrame(). | |
jblas::vec | inverseObservationInSensorFrame (Observation const &obs_) |
void | inverseObservationInSensorFrameJac (Observation const &obs_) |
jacobian of inverseObservationInSensorFrame() | |
double | computeBaselineInSensorFrame (jblas::vec_range const &deltaPose, Observation const &obsRef) const |
Computes the baseline in the sensor frame. |
double jafar::slam::BearingPointInfFeatureObserveModel::computeBaselineInSensorFrame | ( | jblas::vec_range const & | deltaPose, |
Observation const & | obsRef | ||
) | const [protected, virtual] |
Computes the baseline in the sensor frame.
Implements jafar::slam::InfFeatureObserveModel.
jblas::vec const& jafar::slam::BearingPointInfFeatureObserveModel::computeInnovation | ( | jblas::vec const & | y_, |
jblas::vec const & | zPred_ | ||
) | [virtual] |
By default, simply do the substraction.
Reimplementation of that function are allowed to adjust the values of Jobs1 and Jobs2.
y_ | observation |
zPred_ | prediction |
Reimplemented from jafar::filter::BlockObserveModel.
jblas::vec jafar::slam::BearingPointInfFeatureObserveModel::inverseObservationInSensorFrame | ( | Observation const & | obs_ | ) | [protected, virtual] |
inverse observation function in sensor frame, to be defined by user.
Implements jafar::slam::FeatureObserveModel.
Generated on Wed Oct 15 2014 00:37:49 for Jafar by doxygen 1.7.6.1 |