def rotation_matrix_from_roll_pitch_yaw(roll, pitch, yaw) def get_quaternion_from_euler(roll, pitch, yaw) def quaternion_to_rotation_matrix(q) def rotation_matrix_to_quaternion(rotation_matrix) code