9 #ifndef CSENSORYFRAME_H
10 #define CSENSORYFRAME_H
64 CSensoryFrame( const CSensoryFrame &);
72 mutable
mrpt::maps::CMetricMapPtr m_cachedMap;
74 void internal_buildAuxPointsMap( const
void *options = NULL ) const;
85 template <class POINTSMAP>
86 inline const POINTSMAP* getAuxPointsMap()
const {
87 return static_cast<POINTSMAP*
>(m_cachedMap.pointer());
98 template <
class POINTSMAP>
100 internal_buildAuxPointsMap(options);
101 return static_cast<POINTSMAP*
>(m_cachedMap.pointer());
143 return insertObservationsInto(theMap.pointer(), robotPose);
164 void push_back(
const CObservationPtr &obs);
168 void insert(
const CObservationPtr &obs);
177 template <
typename T>
181 size_t foundCount = 0;
184 if ( (*it)->GetRuntimeClass()->derivedFrom( class_ID ) )
185 if (foundCount++ == ith)
186 return typename T::SmartPtr(*it);
187 return typename T::SmartPtr();
210 const_iterator
begin()
const {
return m_observations.begin(); }
223 const_iterator
end()
const {
return m_observations.end(); }
236 iterator
begin() {
return m_observations.begin(); }
249 inline iterator
end() {
return m_observations.end(); }
253 inline size_t size()
const {
return m_observations.size(); }
256 inline bool empty()
const {
return m_observations.empty(); }
259 void eraseByIndex(
const size_t &idx);
263 iterator erase(
const iterator &it);
267 void eraseByLabel(
const std::string &label);
272 CObservationPtr getObservationByIndex(
const size_t &idx )
const;
280 template <
typename T>
283 return static_cast<T
>(getObservationByIndex(idx));
290 CObservationPtr getObservationBySensorLabel(
const std::string &label,
const size_t &idx = 0)
const;
298 template <
typename T>
301 return T(getObservationBySensorLabel(label,idx));
std::deque< CObservationPtr > m_observations
The set of observations taken at the same time instant.
T::SmartPtr getObservationByClass(const size_t &ith=0) const
Returns the i'th observation of a given class (or of a descendant class), or NULL if there is no such...
EIGEN_STRONG_INLINE iterator end()
The virtual base class which provides a unified interface for all persistent objects in MRPT...
EIGEN_STRONG_INLINE iterator begin()
EIGEN_STRONG_INLINE void push_back(Scalar val)
Insert an element at the end of the container (for 1D vectors/arrays)
const Scalar * const_iterator
bool insertObservationsInto(mrpt::maps::CMetricMapPtr &theMap, const mrpt::poses::CPose3D *robotPose=NULL) const
Insert all the observations in this SF into a metric map or any kind (see mrpt::maps::CMetricMap).
std::deque< CObservationPtr >::const_iterator const_iterator
You can use CSensoryFrame::begin to get a iterator to the first element.
#define DEFINE_SERIALIZABLE_PRE_CUSTOM_BASE_LINKAGE(class_name, base_name, _LINKAGE_)
This declaration must be inserted in all CSerializable classes definition, before the class declarati...
class BASE_IMPEXP CSerializable
std::deque< CObservationPtr >::iterator iterator
You can use CSensoryFrame::begin to get a iterator to the first element.
const_iterator end() const
Returns a iterator to the end of the list of observations: this is an example of usage: ...
std::vector< T1 > & operator+=(std::vector< T1 > &a, const std::vector< T2 > &b)
a+=b (element-wise sum)
Declares a class for storing a "sensory frame", a set of "observations" taken by the robot approximat...
const_iterator begin() const
Returns a iterator to the first observation: this is an example of usage:
size_t size() const
Returns the number of observations in the list.
T getObservationBySensorLabelAs(const std::string &label, const size_t &idx=0) const
Returns the i'th observation in the list with the given "sensorLabel" (0=first), and as a different s...
This is the global namespace for all Mobile Robot Programming Toolkit (MRPT) libraries.
#define DEFINE_SERIALIZABLE(class_name)
This declaration must be inserted in all CSerializable classes definition, within the class declarati...
bool empty() const
Returns true if there are no observations in the list.
Declares a virtual base class for all metric maps storage classes.
A class used to store a 3D pose (a 3D translation + a rotation in 3D).
iterator begin()
Returns a iterator to the first observation: this is an example of usage:
A structure that holds runtime class type information.
iterator end()
Returns a iterator to the end of the list of observations: this is an example of usage: ...
#define DEFINE_SERIALIZABLE_POST_CUSTOM_BASE_LINKAGE(class_name, base_name, _LINKAGE_)
const POINTSMAP * buildAuxPointsMap(const void *options=NULL) const
Returns a cached points map representing this laser scan, building it upon the first call...
T getObservationByIndexAs(const size_t &idx) const
Returns the i'th observation in the list (0=first), and as a different smart pointer type: ...