The EKFslam class provides EKF SLAM 3d from MRPT libraries. More...
#include <mrpt_ekf_slam_3d.h>

Public Member Functions | |
| EKFslam () | |
| constructor | |
| void | init3Dwindow () |
| init 3D window from mrpt lib | |
| void | landmark_to_3d (const CRangeBearingKFSLAM::KFArray_FEAT &lm, TPoint3D &p) |
| convert landmark to 3d point | |
| void | observation (CSensoryFrame::Ptr _sf, CObservationOdometry::Ptr _odometry) |
| calculate the actions from odometry model for current observation | |
| void | read_iniFile (std::string ini_filename) |
| read ini file | |
| void | run3Dwindow () |
| run 3D window update from mrpt lib | |
| virtual | ~EKFslam () |
| destructor | |
Protected Attributes | |
| CActionCollection::Ptr | action |
| actions | |
| bool | CAMERA_3DSCENE_FOLLOWS_ROBOT |
| CMatrixDouble | fullCov_ |
| full covariance matrix | |
| CVectorDouble | fullState_ |
| full state vector | |
| std::map< unsigned int, CLandmark::TLandmarkID > | LM_IDs_ |
| vector of the landmarks ID | |
| std::vector< mrpt::math::TPoint3D > | LMs_ |
| vector of the landmarks | |
| CRangeBearingKFSLAM | mapping |
| EKF slam 3d class. | |
| vector< TPose3D > | meanPath |
| mrpt::poses::CPose3D | odomLastObservation_ |
| last observation of odometry | |
| CPose3DQuatPDFGaussian | robotPose_ |
| current robot pose | |
| CSensoryFrame::Ptr | sf |
| observations | |
| bool | SHOW_3D_LIVE |
| mrpt::system::TTimeStamp | timeLastUpdate_ |
| last update of the pose and map | |
| mrpt::gui::CDisplayWindow3D::Ptr | win3d |
| MRPT window. | |
The EKFslam class provides EKF SLAM 3d from MRPT libraries.
Definition at line 57 of file mrpt_ekf_slam_3d.h.
| EKFslam::EKFslam | ( | ) |
constructor
Definition at line 13 of file mrpt_ekf_slam_3d.cpp.
| EKFslam::~EKFslam | ( | ) | [virtual] |
destructor
Definition at line 38 of file mrpt_ekf_slam_3d.cpp.
| void EKFslam::init3Dwindow | ( | ) |
init 3D window from mrpt lib
Definition at line 96 of file mrpt_ekf_slam_3d.cpp.
| void EKFslam::landmark_to_3d | ( | const CRangeBearingKFSLAM::KFArray_FEAT & | lm, |
| TPoint3D & | p | ||
| ) |
convert landmark to 3d point
Definition at line 193 of file mrpt_ekf_slam_3d.cpp.
| void EKFslam::observation | ( | CSensoryFrame::Ptr | _sf, |
| CObservationOdometry::Ptr | _odometry | ||
| ) |
calculate the actions from odometry model for current observation
| _sf | current observation |
| _odometry | raw odometry |
Definition at line 70 of file mrpt_ekf_slam_3d.cpp.
| void EKFslam::read_iniFile | ( | std::string | ini_filename | ) |
read ini file
| ini_filename | the name of the ini file to read |
Definition at line 42 of file mrpt_ekf_slam_3d.cpp.
| void EKFslam::run3Dwindow | ( | ) |
run 3D window update from mrpt lib
Definition at line 106 of file mrpt_ekf_slam_3d.cpp.
CActionCollection::Ptr EKFslam::action [protected] |
actions
Definition at line 99 of file mrpt_ekf_slam_3d.h.
bool EKFslam::CAMERA_3DSCENE_FOLLOWS_ROBOT [protected] |
Definition at line 109 of file mrpt_ekf_slam_3d.h.
CMatrixDouble EKFslam::fullCov_ [protected] |
full covariance matrix
Definition at line 114 of file mrpt_ekf_slam_3d.h.
CVectorDouble EKFslam::fullState_ [protected] |
full state vector
Definition at line 115 of file mrpt_ekf_slam_3d.h.
std::map<unsigned int, CLandmark::TLandmarkID> EKFslam::LM_IDs_ [protected] |
vector of the landmarks ID
Definition at line 113 of file mrpt_ekf_slam_3d.h.
std::vector<mrpt::math::TPoint3D> EKFslam::LMs_ [protected] |
vector of the landmarks
Definition at line 112 of file mrpt_ekf_slam_3d.h.
CRangeBearingKFSLAM EKFslam::mapping [protected] |
EKF slam 3d class.
Definition at line 95 of file mrpt_ekf_slam_3d.h.
vector<TPose3D> EKFslam::meanPath [protected] |
Definition at line 110 of file mrpt_ekf_slam_3d.h.
mrpt::poses::CPose3D EKFslam::odomLastObservation_ [protected] |
last observation of odometry
Definition at line 102 of file mrpt_ekf_slam_3d.h.
CPose3DQuatPDFGaussian EKFslam::robotPose_ [protected] |
current robot pose
Definition at line 111 of file mrpt_ekf_slam_3d.h.
CSensoryFrame::Ptr EKFslam::sf [protected] |
observations
Definition at line 100 of file mrpt_ekf_slam_3d.h.
bool EKFslam::SHOW_3D_LIVE [protected] |
Definition at line 108 of file mrpt_ekf_slam_3d.h.
mrpt::system::TTimeStamp EKFslam::timeLastUpdate_ [protected] |
last update of the pose and map
Definition at line 97 of file mrpt_ekf_slam_3d.h.
mrpt::gui::CDisplayWindow3D::Ptr EKFslam::win3d [protected] |
MRPT window.
Definition at line 107 of file mrpt_ekf_slam_3d.h.