pyrobosim.utils.pose

Pose representation utilities.

Classes

Pose([x, y, z, roll, pitch, yaw, q])

Represents a 3D pose.

Functions

get_angle(p1, p2)	Basic utility for getting angle between 2D points.
get_bearing_range(p1, p2)	Gets bearing and range between 2 points p1 and p2.
get_distance(p1, p2)	Basic utility for getting distance between points.
rot2d(vec, ang)	Rotates a 2-element vector by an angle.
wrap_angle(ang)	Wraps an angle in the range [-pi, pi].