def test_quaternion_from_euler_angles():
axis = [1.0, 0.0, 0.0]
angle = math.pi/2
assert np.allclose(quaternion_from_axis_angle(axis, angle), quaternion_from_euler_angles([math.pi/2, 0, 0]))
def test_quaternion_from_axis_angle():
axis = [1.0, 0.0, 0.0]
angle = math.pi/2
q = quaternion_from_axis_angle(axis, angle)
assert allclose(q, [math.sqrt(2)/2, math.sqrt(2)/2, 0, 0])
def test_euler_angles_from_quaternion():
axis = [1.0, 0.0, 0.0]
angle = math.pi/2
q = quaternion_from_axis_angle(axis, angle)
assert np.allclose(euler_angles_from_quaternion(q), [math.pi/2, 0, 0])