Python Quat.c Examples

Example #1

File: testQuat.py Project: janismac/SmallProjects

from Quat import Quat
import numpy as np

q1 = Quat(34,12,-67,.23)
q2 = Quat(.123,.756,5999,.567)

assert ((q1*q2 - (q2.c()*q1.c()).c()).norm_sq() < 1e-10)

q3 = q1.normalized()
assert (np.linalg.norm ((q3.rotm()*np.matrix([1, 1, 0]).T).T - q3.rotVec([1, 1, 0])) < 1e-10)