1 #ifndef TUW_MARKER_SLAM_H 2 #define TUW_MARKER_SLAM_H 4 #include <tuw_geometry/tuw_geometry.h> 5 #include <opencv2/core/core.hpp> 8 #include "tuw_marker_slam/SLAMConfig.h" 19 std::vector<Pose2D>
yt_;
33 #endif // TUW_MARKER_SLAM_H SLAMTechniquePtr slam_technique_
counter for the triggered cycles
tuw_marker_slam::SLAMConfig config_
technique used to estimate landmark map and the vehicles pose in it
std::shared_ptr< SLAMTechnique > SLAMTechniquePtr
cv::Mat_< double > C_Yt_
combined state yt = (xt, mt_1, ..., mt_n) with xt = (x, y, alpha), mt_i = (x_i, y_i, alpha_i)
void cycle()
global parameters
Command ut_
combined covariance matrix of combined state
unsigned long loop_count_
measurements at time t
MeasurementPtr zt_
motion commands v, w at time t
std::vector< Pose2D > yt_
constructor