Added rpy() and calc_angle() to Quat