pyrobosim.utils.pose.get_bearing_range

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

Gets bearing and range between 2 points p1 and p2. The convention is the bearing of p2 with reference to p1.

Parameters:

• p1 – Reference point

• p2 – Target point

Returns:

Bearing and range of target pose with respect to reference pose.