pyrobosim.utils.pose.get_distance

pyrobosim.utils.pose.get_distance(p1: Sequence[float], p2: Sequence[float]) → float

Basic utility for getting distance between points.

Parameters:

• p1 – Reference point

• p2 – Target point

Returns:

Distance between target pose and reference pose.