Easy Navigation
Loading...
Searching...
No Matches
GoalManager.cpp File Reference

Implementation of the GoalManager class. More...

#include <cmath>
#include "tf2_geometry_msgs/tf2_geometry_msgs.hpp"
#include "tf2/utils.hpp"
#include "nav_msgs/msg/odometry.hpp"
#include "easynav_system/GoalManager.hpp"
Include dependency graph for GoalManager.cpp:

Namespaces

namespace  easynav
 

Functions

double calculate_angle (const geometry_msgs::msg::Pose &pose1, const geometry_msgs::msg::Pose &pose2)
 Get the (absolute) yaw angle difference between two poses.
 
double calculate_distance_xy (const geometry_msgs::msg::Pose &pose1, const geometry_msgs::msg::Pose &pose2)
 Internal utility functions.
 
constexpr double norm_angle (const double angle)
 Angle normalization to [-pi, pi) range (in radians)
 

Detailed Description

Implementation of the GoalManager class.