pyrobosim.utils.pose.get_angle

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

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

Parameters:

• p1 – Reference point

• p2 – Target point

Returns:

Angle of target pose with respect to reference pose.