pyrobosim.utils.pose.get_bearing_range

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

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

Parameters:

  • p1 (list[float]) – Reference point

  • p2 (list[float]) – Target point

Returns:

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

Return type:

(float, float)