SMACC2
Loading...
Searching...
No Matches
cl_nav2z::odom_tracker Namespace Reference

Classes

class  CpOdomTracker
 

Enumerations

enum class  WorkingMode : uint8_t {
  RECORD_PATH = 0 , CLEAR_PATH = 1 , IDLE = 2 , RECORD_PATH = 0 ,
  CLEAR_PATH = 1 , IDLE = 2
}
 
enum class  OdomTrackerStrategy { ODOMETRY_SUBSCRIBER , POSE_COMPONENT , ODOMETRY_SUBSCRIBER , POSE_COMPONENT }
 
enum class  WorkingMode : uint8_t {
  RECORD_PATH = 0 , CLEAR_PATH = 1 , IDLE = 2 , RECORD_PATH = 0 ,
  CLEAR_PATH = 1 , IDLE = 2
}
 
enum class  OdomTrackerStrategy { ODOMETRY_SUBSCRIBER , POSE_COMPONENT , ODOMETRY_SUBSCRIBER , POSE_COMPONENT }
 

Functions

double p2pDistance (const geometry_msgs::msg::Point &p1, const geometry_msgs::msg::Point &p2)
 
template<typename T >
void parameterDeclareAndtryGetOrSet (rclcpp::Node::SharedPtr &node, std::string param_name, T &value)
 

Enumeration Type Documentation

◆ OdomTrackerStrategy [1/2]

Enumerator
ODOMETRY_SUBSCRIBER 
POSE_COMPONENT 
ODOMETRY_SUBSCRIBER 
POSE_COMPONENT 

Definition at line 52 of file cp_odom_tracker.hpp.

◆ OdomTrackerStrategy [2/2]

Enumerator
ODOMETRY_SUBSCRIBER 
POSE_COMPONENT 
ODOMETRY_SUBSCRIBER 
POSE_COMPONENT 

Definition at line 52 of file cp_odom_tracker.hpp.

◆ WorkingMode [1/2]

enum class cl_nav2z::odom_tracker::WorkingMode : uint8_t
strong
Enumerator
RECORD_PATH 
CLEAR_PATH 
IDLE 
RECORD_PATH 
CLEAR_PATH 
IDLE 

Definition at line 45 of file cp_odom_tracker.hpp.

◆ WorkingMode [2/2]

enum class cl_nav2z::odom_tracker::WorkingMode : uint8_t
strong
Enumerator
RECORD_PATH 
CLEAR_PATH 
IDLE 
RECORD_PATH 
CLEAR_PATH 
IDLE 

Definition at line 45 of file cp_odom_tracker.hpp.

46{
47 RECORD_PATH = 0,
48 CLEAR_PATH = 1,
49 IDLE = 2
50};

Function Documentation

◆ p2pDistance()

double cl_nav2z::odom_tracker::p2pDistance ( const geometry_msgs::msg::Point & p1,
const geometry_msgs::msg::Point & p2 )
inline

p2pDistance()

Definition at line 208 of file cp_odom_tracker.hpp.

210{
211 double dx = (p1.x - p2.x);
212 double dy = (p1.y - p2.y);
213 double dz = (p2.z - p2.z);
214 double dist = sqrt(dx * dx + dy * dy + dz * dz);
215 return dist;
216}

Referenced by cl_nav2z::odom_tracker::CpOdomTracker::updateClearPath(), and cl_nav2z::odom_tracker::CpOdomTracker::updateRecordPath().

Here is the caller graph for this function:

◆ parameterDeclareAndtryGetOrSet()

template<typename T >
void cl_nav2z::odom_tracker::parameterDeclareAndtryGetOrSet ( rclcpp::Node::SharedPtr & node,
std::string param_name,
T & value )

Definition at line 47 of file cp_odom_tracker.cpp.

49{
50 if (!node->get_parameter(param_name, value))
51 {
52 RCLCPP_INFO_STREAM(
53 node->get_logger(), "[CpOdomTracker] autoset " << param_name << ": " << value);
54 node->declare_parameter(param_name, value);
55 }
56 else
57 {
58 RCLCPP_INFO_STREAM(node->get_logger(), "[CpOdomTracker] " << param_name << ": " << value);
59 }
60}

Referenced by cl_nav2z::odom_tracker::CpOdomTracker::onInitialize().

Here is the caller graph for this function: