63 void rot_quat_mult (
double c[4],
const double a[4],
const double b[4]);
void rot_angle_axis_to_quat(double theta, const double axis[3], double q[4])
int rot_quat_to_matrix(const double quat[4], double rot[9])
void rot_quat_rotate_rev(const double quat[4], double v[3])
rot_quat_rotate_rev
void rot_quat_mult(double c[4], const double a[4], const double b[4])
rot_quat_mult
void rot_quat_to_angle_axis(const double q[4], double *theta, double axis[3])
int rot_quat_pos_to_matrix(const double quat[4], const double pose[3], double m[16])
int rot_quaternion_test()
void rot_quat_to_roll_pitch_yaw(const double q[4], double rpy[3])
void rot_roll_pitch_yaw_to_quat(const double rpy[3], double q[4])
void rot_angle_axis_to_roll_pitch_yaw(double angle, const double axis[3], double rpy[3])
int rot_matrix_to_quat(const double rot[9], double quat[4])
void rot_roll_pitch_yaw_to_angle_axis(const double rpy[3], double *angle, double axis[3])
void rot_quat_rotate(const double quat[4], double v[3])
rot_quat_rotate