def test_normalized(self):
x = (0, 1, 2)
x0 = mat.normalized(x)
self.assertTrue(np.equal(1, np.dot(x0, x0) ** .5))
def decompose(p):
n = mat.normalized(axis)
p = p[:3] - center
pn = p.dot(n) * n
return pn, p - pn