Main MRPT website > C++ reference for MRPT 1.9.9
ClearanceDiagram.h
Go to the documentation of this file.
1 /* +------------------------------------------------------------------------+
2  | Mobile Robot Programming Toolkit (MRPT) |
3  | http://www.mrpt.org/ |
4  | |
5  | Copyright (c) 2005-2018, Individual contributors, see AUTHORS file |
6  | See: http://www.mrpt.org/Authors - All rights reserved. |
7  | Released under BSD License. See details in http://www.mrpt.org/License |
8  +------------------------------------------------------------------------+ */
9 #pragma once
10 
11 #include <vector>
12 #include <map>
13 #include <cstdint>
16 
17 namespace mrpt
18 {
19 namespace nav
20 {
21 /** Clearance information for one particular PTG and one set of obstacles.
22  * Usage:
23  * - Declare an object of this type (it will be initialized to "empty"),
24  * - Call CParameterizedTrajectoryGenerator::initClearanceDiagram()
25  * - Repeatedly call CParameterizedTrajectoryGenerator::updateClearance() for
26  * each 2D obstacle point.
27  *
28  * \ingroup nav_tpspace
29  */
31 {
32  public:
33  /** default ctor */
35  /** Reset to default, empty state */
36  void clear();
37  /** Initializes the container to allocate `decimated_num_paths` entries, as
38  * a decimated
39  * subset of a total of `actual_num_paths` paths */
40  void resize(size_t actual_num_paths, size_t decimated_num_paths);
41  inline bool empty() const { return m_raw_clearances.empty(); }
42  inline size_t get_actual_num_paths() const { return m_actual_num_paths; }
43  inline size_t get_decimated_num_paths() const
44  {
45  return m_raw_clearances.size();
46  }
47 
48  /** Gets the clearance for path `k` and distance `TPS_query_distance` in one
49  * of two modes:
50  * - [integrate_over_path=false] clearance from that specific spot, or
51  * - [integrate_over_path=true] average clearance over the path from the
52  * origin to that specific spot.
53  */
54  double getClearance(
55  uint16_t k, double TPS_query_distance, bool integrate_over_path) const;
56  void renderAs3DObject(
57  mrpt::opengl::CMesh& mesh, double min_x, double max_x, double min_y,
58  double max_y, double cell_res, bool integrate_over_path) const;
59 
62 
63  /** [TPS_distance] => normalized_clearance_for_exactly_that_robot_pose */
64  using dist2clearance_t = std::map<double, double>;
65  dist2clearance_t& get_path_clearance(size_t actual_k);
66  const dist2clearance_t& get_path_clearance(size_t actual_k) const;
67 
69  {
70  return m_raw_clearances[decim_k];
71  }
73  size_t decim_k) const
74  {
75  return m_raw_clearances[decim_k];
76  }
77 
78  size_t real_k_to_decimated_k(size_t k) const;
79  size_t decimated_k_to_real_k(size_t k) const;
80 
81  protected:
82  /** Container: [decimated_path_k][TPS_distance] =>
83  * normalized_clearance_for_exactly_that_robot_pose */
84  std::vector<dist2clearance_t> m_raw_clearances;
85 
86  size_t m_actual_num_paths; // The decimated number of paths is implicit in
87  // raw_clearances.size()
88  double m_k_a2d, m_k_d2a;
89 };
90 
91 } // namespace nav
92 } // namespace mrpt
mrpt::nav::ClearanceDiagram::writeToStream
void writeToStream(mrpt::serialization::CArchive &out) const
Definition: ClearanceDiagram.cpp:94
mrpt::nav::ClearanceDiagram::get_actual_num_paths
size_t get_actual_num_paths() const
Definition: ClearanceDiagram.h:42
opengl_frwds.h
uint16_t
unsigned __int16 uint16_t
Definition: rptypes.h:44
mrpt::nav::ClearanceDiagram::m_actual_num_paths
size_t m_actual_num_paths
Definition: ClearanceDiagram.h:86
mrpt::nav::ClearanceDiagram::get_decimated_num_paths
size_t get_decimated_num_paths() const
Definition: ClearanceDiagram.h:43
mrpt::nav::ClearanceDiagram::getClearance
double getClearance(uint16_t k, double TPS_query_distance, bool integrate_over_path) const
Gets the clearance for path k and distance TPS_query_distance in one of two modes:
Definition: ClearanceDiagram.cpp:132
mrpt::nav::ClearanceDiagram::renderAs3DObject
void renderAs3DObject(mrpt::opengl::CMesh &mesh, double min_x, double max_x, double min_y, double max_y, double cell_res, bool integrate_over_path) const
Definition: ClearanceDiagram.cpp:27
mrpt
This is the global namespace for all Mobile Robot Programming Toolkit (MRPT) libraries.
Definition: CKalmanFilterCapable.h:30
mrpt::opengl::CMesh
A planar (XY) grid where each cell has an associated height and, optionally, a texture map.
Definition: CMesh.h:39
mrpt::nav::ClearanceDiagram::m_k_a2d
double m_k_a2d
Definition: ClearanceDiagram.h:88
mrpt::serialization::CArchive
Virtual base class for "archives": classes abstracting I/O streams.
Definition: CArchive.h:48
mrpt::nav::ClearanceDiagram::empty
bool empty() const
Definition: ClearanceDiagram.h:41
mrpt::nav::ClearanceDiagram
Clearance information for one particular PTG and one set of obstacles.
Definition: ClearanceDiagram.h:30
mrpt::nav::ClearanceDiagram::readFromStream
void readFromStream(mrpt::serialization::CArchive &in)
Definition: ClearanceDiagram.cpp:75
mrpt::nav::ClearanceDiagram::dist2clearance_t
std::map< double, double > dist2clearance_t
[TPS_distance] => normalized_clearance_for_exactly_that_robot_pose
Definition: ClearanceDiagram.h:64
mrpt::nav::ClearanceDiagram::get_path_clearance
dist2clearance_t & get_path_clearance(size_t actual_k)
Definition: ClearanceDiagram.cpp:104
mrpt::nav::ClearanceDiagram::m_k_d2a
double m_k_d2a
Definition: ClearanceDiagram.h:88
mrpt::nav::ClearanceDiagram::decimated_k_to_real_k
size_t decimated_k_to_real_k(size_t k) const
Definition: ClearanceDiagram.cpp:124
serialization_frwds.h
mrpt::nav::ClearanceDiagram::clear
void clear()
Reset to default, empty state.
Definition: ClearanceDiagram.cpp:174
mrpt::nav::ClearanceDiagram::get_path_clearance_decimated
const dist2clearance_t & get_path_clearance_decimated(size_t decim_k) const
Definition: ClearanceDiagram.h:72
in
GLuint in
Definition: glext.h:7274
mrpt::nav::ClearanceDiagram::ClearanceDiagram
ClearanceDiagram()
default ctor
Definition: ClearanceDiagram.cpp:22
mrpt::nav::ClearanceDiagram::real_k_to_decimated_k
size_t real_k_to_decimated_k(size_t k) const
Definition: ClearanceDiagram.cpp:116
mrpt::nav::ClearanceDiagram::resize
void resize(size_t actual_num_paths, size_t decimated_num_paths)
Initializes the container to allocate decimated_num_paths entries, as a decimated subset of a total o...
Definition: ClearanceDiagram.cpp:181
mrpt::nav::ClearanceDiagram::m_raw_clearances
std::vector< dist2clearance_t > m_raw_clearances
Container: [decimated_path_k][TPS_distance] => normalized_clearance_for_exactly_that_robot_pose
Definition: ClearanceDiagram.h:84
mrpt::nav::ClearanceDiagram::get_path_clearance_decimated
dist2clearance_t & get_path_clearance_decimated(size_t decim_k)
Definition: ClearanceDiagram.h:68



Page generated by Doxygen 1.8.17 for MRPT 1.9.9 Git: ad3a9d8ae Tue May 1 23:10:22 2018 -0700 at miƩ 12 jul 2023 10:03:34 CEST