mobilitypath_visualizer::anonymous_namespace{mobilitypath_visualizer.cpp} Namespace Reference

Functions
double	compute_2d_distance (const geometry_msgs::msg::Point &pt1, const geometry_msgs::msg::Point &pt2)

Function Documentation

compute_2d_distance()

double mobilitypath_visualizer::anonymous_namespace{mobilitypath_visualizer.cpp}::compute_2d_distance	(	const geometry_msgs::msg::Point &	pt1,
		const geometry_msgs::msg::Point &	pt2
	)

Definition at line 26 of file mobilitypath_visualizer.cpp.

        {
            double dx = pt2.x - pt1.x;
            double dy = pt2.y - pt1.y;
            double dz = pt2.z - pt1.z;
 
            return sqrt(dx * dx + dy * dy + dz * dz);
        }

Referenced by mobilitypath_visualizer::MobilityPathVisualizer::composeLabelMarker().

Here is the caller graph for this function: