pyrobosim.utils.pose.get_angle

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

Basic utility for getting angle between 2D points. The convention is the angle p2 with reference to p1.

Parameters:

  • p1 (list[float]) – Reference point

  • p2 (list[float]) – Target point

Returns:

Angle of target pose with respect to reference pose.

Return type:

float