Advertisement
Guest User

Untitled

a guest
Oct 15th, 2019
115
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 0.28 KB | None | 0 0
  1. import pyquaternion
  2.  
  3. def getQfromR(R):
  4.     return pyquaternion.Quaternion(matrix=R)
  5.  
  6. def quaternion_distance(r1, r2):
  7.     r1 = r1.reshape((3, 3))
  8.     r2 = r2.reshape((3, 3))
  9.     q1 = getQfromR(r1)
  10.     q2 = getQfromR(r2)
  11.     dist =  q1 * q2.inverse
  12.     return dist.degrees
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement