Function mbf_utility::distance

• Defined in File navigation_utility.h

Function Documentation

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

Computes the Euclidean-distance between two poses.

Parameters:

• pose1 – pose 1

• pose2 – pose 2

Returns:

Euclidean distance between pose 1 and pose 2.