class mola::FactorStereoProjectionPose

Overview

Smart factor for a set of stereo-camera observations of one point landmark. The ID of the factor is the ID of the landmark.

#include <FactorStereoProjectionPose.h>

class FactorStereoProjectionPose: public mola::FactorBase
{
public:
    // fields

    double sigma_xleft_;
    double sigma_xright_;
    double sigma_y_;
    StereoObservation observation_;
    mola::id_t observing_kf_;
    mola::id_t observed_landmark_;
    mola::id_t camera_params_id_;
    mrpt::math::TPose3D cameraPoseOnRobot_;

    // construction

    FactorStereoProjectionPose();

    FactorStereoProjectionPose(
        double sigma_xleft,
        double sigma_xright,
        double sigma_y,
        const StereoObservation& st,
        const id_t observing_kf,
        const id_t observed_landmark,
        const id_t camera_params,
        const mrpt::math::TPose3D& cameraPoseOnRobot = mrpt::math::TPose3D()
        );

    // methods

    virtual std::size_t edge_count() const;
    virtual mola::id_t edge_indices(const std::size_t i) const;
};

Inherited Members

public:
    // fields

    mola::fid_t my_id_ {mola::INVALID_FID};
    mola::Robust robust_type_ {mola::Robust::REGULAR_L2};
    double robust_param_ {1.0};

    // methods

    virtual std::size_t edge_count() const = 0;
    virtual mola::id_t edge_indices(const std::size_t i) const = 0;

Fields

double sigma_xleft_

Noise model

Methods

virtual std::size_t edge_count() const

Number of entities involved in this factor: 1 for unary factors, 2 for binary, etc.

virtual mola::id_t edge_indices(const std::size_t i) const

Access entity indices involved in this factor