pyrobosim.utils.pose.get_distance

pyrobosim.utils.pose.get_distance(p1, p2)

Basic utility for getting distance between points.

Parameters:

• p1 (list[float]) – Reference point

• p2 (list[float]) – Target point

Returns:

Distance between target pose and reference pose.

Return type:

float