MRPT
1.9.9
|
Base class for SE(2)/SE(3) interpolators.
See docs for derived classes.
Definition at line 50 of file CPoseInterpolatorBase.h.
#include <mrpt/poses/CPoseInterpolatorBase.h>
Public Member Functions | |
CPoseInterpolatorBase () | |
Default ctor: empty sequence of poses. More... | |
void | insert (const mrpt::Clock::time_point &t, const pose_t &p) |
Inserts a new pose in the sequence. More... | |
void | insert (const mrpt::Clock::time_point &t, const cpose_t &p) |
Overload (slower) More... | |
pose_t & | interpolate (const mrpt::Clock::time_point &t, pose_t &out_interp, bool &out_valid_interp) const |
Returns the pose at a given time, or interpolates using splines if there is not an exact match. More... | |
cpose_t & | interpolate (const mrpt::Clock::time_point &t, cpose_t &out_interp, bool &out_valid_interp) const |
void | clear () |
Clears the current sequence of poses. More... | |
void | setMaxTimeInterpolation (const mrpt::Clock::duration &time) |
Set value of the maximum time to consider interpolation. More... | |
mrpt::Clock::duration | getMaxTimeInterpolation () |
Set value of the maximum time to consider interpolation. More... | |
bool | getPreviousPoseWithMinDistance (const mrpt::Clock::time_point &t, double distance, pose_t &out_pose) |
Get the previous CPose3D in the map with a minimum defined distance. More... | |
bool | getPreviousPoseWithMinDistance (const mrpt::Clock::time_point &t, double distance, cpose_t &out_pose) |
bool | saveToTextFile (const std::string &s) const |
Saves the points in the interpolator to a text file, with this format: Each row contains these elements separated by spaces: More... | |
bool | saveInterpolatedToTextFile (const std::string &s, const mrpt::Clock::duration &period) const |
Saves the points in the interpolator to a text file, with the same format that saveToTextFile, but interpolating the path with the given period in seconds. More... | |
bool | loadFromTextFile (const std::string &s) |
Loads from a text file, in the format described by saveToTextFile. More... | |
void | getBoundingBox (point_t &minCorner, point_t &maxCorner) const |
Computes the bounding box in all Euclidean coordinates of the whole path. More... | |
void | setInterpolationMethod (TInterpolatorMethod method) |
Change the method used to interpolate the robot path. More... | |
TInterpolatorMethod | getInterpolationMethod () const |
Returns the currently set interpolation method. More... | |
void | filter (unsigned int component, unsigned int samples) |
Filters by averaging one of the components of the pose data within the interpolator. More... | |
Protected Member Functions | |
void | impl_interpolation (const TTimePosePair &p1, const TTimePosePair &p2, const TTimePosePair &p3, const TTimePosePair &p4, const TInterpolatorMethod method, const mrpt::Clock::time_point &td, pose_t &out_interp) const |
template<> | |
void | impl_interpolation (const TTimePosePair &p1, const TTimePosePair &p2, const TTimePosePair &p3, const TTimePosePair &p4, const TInterpolatorMethod method, const mrpt::Clock::time_point &t, pose_t &out_interp) const |
template<> | |
void | impl_interpolation (const TTimePosePair &p1, const TTimePosePair &p2, const TTimePosePair &p3, const TTimePosePair &p4, const TInterpolatorMethod method, const mrpt::Clock::time_point &t, pose_t &out_interp) const |
Protected Attributes | |
TPath | m_path |
The sequence of poses. More... | |
mrpt::Clock::duration | maxTimeInterpolation |
Maximum time considered to interpolate. More... | |
TInterpolatorMethod | m_method {mrpt::poses::imLinearSlerp} |
using mrpt::poses::CPoseInterpolatorBase< DIM >::const_iterator = typename TPath::const_iterator |
Definition at line 69 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::const_reverse_iterator = typename TPath::const_reverse_iterator |
Definition at line 71 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::cpose_t = typename Lie::SE<DIM>::type |
Definition at line 62 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::iterator = typename TPath::iterator |
Definition at line 68 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::point_t = typename Lie::Euclidean<DIM>::light_type |
TPoint2D or TPoint3D.
Definition at line 64 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::pose_t = typename Lie::SE<DIM>::light_type |
TPose2D or TPose3D.
Definition at line 60 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::reverse_iterator = typename TPath::reverse_iterator |
Definition at line 70 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::TPath = std::map<mrpt::Clock::time_point, pose_t> |
Definition at line 67 of file CPoseInterpolatorBase.h.
using mrpt::poses::CPoseInterpolatorBase< DIM >::TTimePosePair = std::pair<mrpt::Clock::time_point, pose_t> |
Definition at line 66 of file CPoseInterpolatorBase.h.
mrpt::poses::CPoseInterpolatorBase< DIM >::CPoseInterpolatorBase | ( | ) |
Default ctor: empty sequence of poses.
Definition at line 28 of file CPoseInterpolatorBase.hpp.
|
inline |
Definition at line 114 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 115 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 73 of file CPoseInterpolatorBase.h.
Referenced by mrpt::topography::path_from_rtk_gps(), and mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
|
inline |
Definition at line 74 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 75 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 78 of file CPoseInterpolatorBase.h.
void mrpt::poses::CPoseInterpolatorBase< DIM >::clear | ( | ) |
Clears the current sequence of poses.
Definition at line 35 of file CPoseInterpolatorBase.hpp.
Referenced by mrpt::nav::CAbstractNavigator::internal_onStartNewNavigation(), mrpt::topography::path_from_rtk_gps(), and mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
|
inline |
Definition at line 108 of file CPoseInterpolatorBase.h.
Referenced by mrpt::nav::CAbstractNavigator::performNavigationStepNavigating().
|
inline |
Definition at line 76 of file CPoseInterpolatorBase.h.
Referenced by mrpt::topography::path_from_rtk_gps().
|
inline |
Definition at line 77 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 101 of file CPoseInterpolatorBase.h.
Referenced by mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
void mrpt::poses::CPoseInterpolatorBase< DIM >::filter | ( | unsigned int | component, |
unsigned int | samples | ||
) |
Filters by averaging one of the components of the pose data within the interpolator.
The width of the filter is set by the number of samples.
component | [IN] The index of the component to filter: 0 (x), 1 (y), 2 (z), 3 (yaw), 4 (pitch) or 5 (roll) |
samples | [IN] The width of the average filter. |
Definition at line 374 of file CPoseInterpolatorBase.hpp.
|
inline |
Definition at line 109 of file CPoseInterpolatorBase.h.
Referenced by mrpt::poses::CPoseInterpolatorBase< 3 >::getPreviousPoseWithMinDistance().
|
inline |
Definition at line 110 of file CPoseInterpolatorBase.h.
void mrpt::poses::CPoseInterpolatorBase< DIM >::getBoundingBox | ( | point_t & | minCorner, |
point_t & | maxCorner | ||
) | const |
Computes the bounding box in all Euclidean coordinates of the whole path.
std::exception | On empty path |
Definition at line 337 of file CPoseInterpolatorBase.hpp.
TInterpolatorMethod mrpt::poses::CPoseInterpolatorBase< DIM >::getInterpolationMethod | ( | ) | const |
Returns the currently set interpolation method.
Definition at line 368 of file CPoseInterpolatorBase.hpp.
mrpt::Clock::duration mrpt::poses::CPoseInterpolatorBase< DIM >::getMaxTimeInterpolation | ( | ) |
Set value of the maximum time to consider interpolation.
Definition at line 230 of file CPoseInterpolatorBase.hpp.
bool mrpt::poses::CPoseInterpolatorBase< DIM >::getPreviousPoseWithMinDistance | ( | const mrpt::Clock::time_point & | t, |
double | distance, | ||
pose_t & | out_pose | ||
) |
Get the previous CPose3D in the map with a minimum defined distance.
Definition at line 191 of file CPoseInterpolatorBase.hpp.
bool mrpt::poses::CPoseInterpolatorBase< DIM >::getPreviousPoseWithMinDistance | ( | const mrpt::Clock::time_point & | t, |
double | distance, | ||
cpose_t & | out_pose | ||
) |
This is an overloaded member function, provided for convenience. It differs from the above function only in what argument(s) it accepts.
Definition at line 181 of file CPoseInterpolatorBase.hpp.
|
protected |
Definition at line 45 of file CPose2DInterpolator.cpp.
|
protected |
Definition at line 56 of file CPose3DInterpolator.cpp.
|
protected |
void mrpt::poses::CPoseInterpolatorBase< DIM >::insert | ( | const mrpt::Clock::time_point & | t, |
const pose_t & | p | ||
) |
Inserts a new pose in the sequence.
It overwrites any previously existing pose at exactly the same time.
Definition at line 47 of file CPoseInterpolatorBase.hpp.
Referenced by mrpt::topography::path_from_rtk_gps(), TEST(), and mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
void mrpt::poses::CPoseInterpolatorBase< DIM >::insert | ( | const mrpt::Clock::time_point & | t, |
const cpose_t & | p | ||
) |
Overload (slower)
Definition at line 41 of file CPoseInterpolatorBase.hpp.
CPoseInterpolatorBase< DIM >::pose_t & mrpt::poses::CPoseInterpolatorBase< DIM >::interpolate | ( | const mrpt::Clock::time_point & | t, |
pose_t & | out_interp, | ||
bool & | out_valid_interp | ||
) | const |
Returns the pose at a given time, or interpolates using splines if there is not an exact match.
t | The time of the point to interpolate. |
out_interp | The output interpolated pose. |
out_valid_interp | Whether there was information enough to compute the interpolation. |
Definition at line 70 of file CPoseInterpolatorBase.hpp.
Referenced by mrpt::obs::CObservationVelodyneScan::generatePointCloudAlongSE3Trajectory(), mrpt::nav::CAbstractPTGBasedReactive::performNavigationStep(), and TEST().
CPoseInterpolatorBase< DIM >::cpose_t & mrpt::poses::CPoseInterpolatorBase< DIM >::interpolate | ( | const mrpt::Clock::time_point & | t, |
cpose_t & | out_interp, | ||
bool & | out_valid_interp | ||
) | const |
This is an overloaded member function, provided for convenience. It differs from the above function only in what argument(s) it accepts.
Definition at line 58 of file CPoseInterpolatorBase.hpp.
bool mrpt::poses::CPoseInterpolatorBase< DIM >::loadFromTextFile | ( | const std::string & | s | ) |
Loads from a text file, in the format described by saveToTextFile.
std::exception | On invalid file format |
Definition at line 303 of file CPoseInterpolatorBase.hpp.
|
inline |
Definition at line 83 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 87 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 79 of file CPoseInterpolatorBase.h.
Referenced by mrpt::nav::CAbstractNavigator::performNavigationStepNavigating(), and mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
|
inline |
Definition at line 80 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 81 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 82 of file CPoseInterpolatorBase.h.
bool mrpt::poses::CPoseInterpolatorBase< DIM >::saveInterpolatedToTextFile | ( | const std::string & | s, |
const mrpt::Clock::duration & | period | ||
) | const |
Saves the points in the interpolator to a text file, with the same format that saveToTextFile, but interpolating the path with the given period in seconds.
Definition at line 265 of file CPoseInterpolatorBase.hpp.
bool mrpt::poses::CPoseInterpolatorBase< DIM >::saveToTextFile | ( | const std::string & | s | ) | const |
Saves the points in the interpolator to a text file, with this format: Each row contains these elements separated by spaces:
Definition at line 236 of file CPoseInterpolatorBase.hpp.
void mrpt::poses::CPoseInterpolatorBase< DIM >::setInterpolationMethod | ( | TInterpolatorMethod | method | ) |
Change the method used to interpolate the robot path.
The default method at construction is "imSpline".
Definition at line 361 of file CPoseInterpolatorBase.hpp.
Referenced by mrpt::nav::CAbstractNavigator::CAbstractNavigator(), and mrpt::topography::path_from_rtk_gps().
void mrpt::poses::CPoseInterpolatorBase< DIM >::setMaxTimeInterpolation | ( | const mrpt::Clock::duration & | time | ) |
Set value of the maximum time to consider interpolation.
If set to a negative value, the check is disabled (default behavior).
Definition at line 222 of file CPoseInterpolatorBase.hpp.
Referenced by mrpt::topography::path_from_rtk_gps().
|
inline |
Definition at line 107 of file CPoseInterpolatorBase.h.
Referenced by mrpt::topography::path_from_rtk_gps(), mrpt::nav::CAbstractNavigator::performNavigationStepNavigating(), TEST(), and mrpt::nav::CAbstractNavigator::updateCurrentPoseAndSpeeds().
|
inline |
Definition at line 92 of file CPoseInterpolatorBase.h.
|
inline |
Definition at line 96 of file CPoseInterpolatorBase.h.
|
protected |
Definition at line 212 of file CPoseInterpolatorBase.h.
|
protected |
The sequence of poses.
Definition at line 207 of file CPoseInterpolatorBase.h.
Referenced by mrpt::poses::CPoseInterpolatorBase< 3 >::at(), mrpt::poses::CPoseInterpolatorBase< 3 >::begin(), mrpt::poses::CPoseInterpolatorBase< 3 >::cbegin(), mrpt::poses::CPoseInterpolatorBase< 3 >::cend(), mrpt::poses::CPoseInterpolatorBase< 3 >::empty(), mrpt::poses::CPoseInterpolatorBase< 3 >::end(), mrpt::poses::CPoseInterpolatorBase< 3 >::erase(), mrpt::poses::CPoseInterpolatorBase< 3 >::find(), mrpt::poses::CPoseInterpolatorBase< 3 >::lower_bound(), mrpt::poses::CPoseInterpolatorBase< 3 >::rbegin(), mrpt::poses::CPoseInterpolatorBase< 3 >::rend(), mrpt::poses::CPoseInterpolatorBase< 3 >::size(), and mrpt::poses::CPoseInterpolatorBase< 3 >::upper_bound().
|
protected |
Maximum time considered to interpolate.
If the difference between the desired timestamp where to interpolate and the next timestamp stored in the map is bigger than this value, the interpolation will not be done.
Definition at line 211 of file CPoseInterpolatorBase.h.
Page generated by Doxygen 1.8.14 for MRPT 1.9.9 Git: c7a3bec24 Sun Mar 29 18:33:13 2020 +0200 at dom mar 29 18:50:38 CEST 2020 |