Function mbf_utility::angle

• Defined in File navigation_utility.h

Function Documentation

double mbf_utility::angle(const geometry_msgs::msg::PoseStamped &pose1, const geometry_msgs::msg::PoseStamped &pose2)

Computes the smallest angle between two poses.

Parameters:

• pose1 – pose 1

• pose2 – pose 2

Returns:

smallest angle between pose 1 and pose 2.