|
|
| TransformBtwRobotsUnaryFactorEM () |
| | default constructor - only use for serialization
|
| |
|
| TransformBtwRobotsUnaryFactorEM (Key key, const VALUE &measured, Key keyA, Key keyB, const Values &valA, const Values &valB, const SharedGaussian &model_inlier, const SharedGaussian &model_outlier, const double prior_inlier, const double prior_outlier, const bool flag_bump_up_near_zero_probs=false, const bool start_with_M_step=false) |
| | Constructor.
|
| |
|
virtual NonlinearFactor::shared_ptr | clone () const |
| | Clone.
|
| |
| virtual void | print (const std::string &s, const KeyFormatter &keyFormatter=DefaultKeyFormatter) const |
| | implement functions needed for Testable More...
|
| |
|
virtual bool | equals (const NonlinearFactor &f, double tol=1e-9) const |
| | equals
|
| |
|
void | setValAValB (const Values &valA, const Values &valB) |
| | implement functions needed to derive from Factor
|
| |
| virtual double | error (const Values &x) const |
| | Calculate the error of the factor This is typically equal to log-likelihood, e.g. More...
|
| |
|
virtual boost::shared_ptr< GaussianFactor > | linearize (const Values &x) const |
| | Linearize a non-linearFactorN to get a GaussianFactor, \( Ax-b \approx h(x+\delta x)-z = h(x) + A \delta x - z \) Hence \( b = z - h(x) = - \mathtt{error\_vector}(x) \).
|
| |
|
Vector | whitenedError (const Values &x, boost::optional< std::vector< Matrix > & > H=boost::none) const |
| |
|
Vector | calcIndicatorProb (const Values &x) const |
| |
|
Vector | calcIndicatorProb (const Values &x, const Vector &err) const |
| |
|
Vector | unwhitenedError (const Values &x) const |
| |
|
SharedGaussian | get_model_inlier () const |
| |
|
SharedGaussian | get_model_outlier () const |
| |
|
Matrix | get_model_inlier_cov () const |
| |
|
Matrix | get_model_outlier_cov () const |
| |
|
void | updateNoiseModels (const Values &values, const Marginals &marginals) |
| |
|
void | updateNoiseModels (const Values &values, const NonlinearFactorGraph &graph) |
| |
|
void | updateNoiseModels_givenCovs (const Values &values, const Matrix &cov1, const Matrix &cov2, const Matrix &cov12) |
| |
|
std::size_t | size () const |
| | number of variables attached to this factor
|
| |
|
virtual size_t | dim () const |
| | get the dimension of the factor (number of rows on linearization)
|
| |