def test_trace(self, q):
     r1 = np.array(spw.trace(spw.rotation_matrix_from_quaternion(q[0], q[1], q[2], q[3]))).astype(float)
     r2 = quaternion_matrix(q)
     r2 = np.trace(r2)
     self.assertTrue(np.isclose(r1, r2).all(), msg='\n{} != \n{}'.format(r1, r2))
 def test_rotation3_quaternion(self, q):
     r1 = np.array(spw.rotation_matrix_from_quaternion(*q)).astype(float)
     r2 = quaternion_matrix(q)
     self.assertTrue(np.isclose(r1, r2).all(), msg='{} \n{} != \n{}'.format(q, r1, r2))