Go to the documentation of this file.
9 #ifndef CRobot2DPoseEstimator_H
10 #define CRobot2DPoseEstimator_H
47 bool hasVelocities =
false,
76 max_odometry_age ( 1.0 ),
77 max_localiz_age ( 4.0 )
106 const double delta_time,
mrpt::math::CMatrixDouble33 m_last_loc_cov
mrpt::math::TPose2D m_last_odo
TOptions params
parameters of the filter.
double max_odometry_age
To consider data old, in seconds.
mrpt::system::TTimeStamp now()
A shortcut for system::getCurrentTime.
bool getLatestRobotPose(mrpt::math::TPose2D &pose) const
Get the latest known robot pose, either from odometry or localization.
This is the global namespace for all Mobile Robot Programming Toolkit (MRPT) libraries.
void processUpdateNewPoseLocalization(const mrpt::math::TPose2D &newPose, const mrpt::math::CMatrixDouble33 &newPoseCov, mrpt::system::TTimeStamp cur_tim)
Updates the filter so the pose is tracked to the current time.
bool getCurrentEstimate(mrpt::math::TPose2D &pose, float &v, float &w, mrpt::system::TTimeStamp tim_query=mrpt::system::now()) const
Get the current estimate, obtained as:
uint64_t TTimeStamp
A system independent time type, it holds the the number of 100-nanosecond intervals since January 1,...
mrpt::system::TTimeStamp m_last_odo_time
void processUpdateNewOdometry(const mrpt::math::TPose2D &newGlobalOdometry, mrpt::system::TTimeStamp cur_tim, bool hasVelocities=false, float v=0, float w=0)
Updates the filter so the pose is tracked to the current time.
mrpt::synch::CCriticalSection m_cs
This class provides simple critical sections functionality.
A class used to store a 2D pose.
mrpt::system::TTimeStamp m_last_loc_time
bool getLatestRobotPose(CPose2D &pose) const
This is an overloaded member function, provided for convenience. It differs from the above function o...
bool getCurrentEstimate(mrpt::poses::CPose2D &pose, float &v, float &w, mrpt::system::TTimeStamp tim_query=mrpt::system::now()) const
This is an overloaded member function, provided for convenience. It differs from the above function o...
static void extrapolateRobotPose(const mrpt::math::TPose2D &p, const float v, const float w, const double delta_time, mrpt::math::TPose2D &new_p)
An auxiliary method to extrapolate the pose of a robot located at "p" with velocities (v,...
A numeric matrix of compile-time fixed size.
double max_localiz_age
To consider data old, in seconds.
A simple filter to estimate and extrapolate the robot 2D (x,y,phi) pose from asynchronous odometry an...
virtual ~CRobot2DPoseEstimator()
Destructor.
mrpt::math::TPose2D m_last_loc
Last pose as estimated by the localization/SLAM subsystem.
mrpt::math::TPose2D m_loc_odo_ref
The interpolated odometry position for the last "m_robot_pose" (used as "coordinates base" for subseq...
CRobot2DPoseEstimator()
Default constructor.
Page generated by Doxygen 1.8.20 for MRPT 1.4.0 SVN: at Thu Aug 27 02:40:23 UTC 2020 | | |