pub fn matrix_to_intrinsic_roll_pitch_yaw(rot: Rotation3<f64>) -> [f64; 3]
Convert a rotation martix to intrinsic roll-pitch-yaw angles.