Normalize vectors in a2p()

This commit is contained in:
Thomas Krijnen
2023-04-18 13:13:29 +02:00
committed by GitHub
parent 4bfda8851c
commit a1326cb5ed
@@ -20,7 +20,10 @@ import numpy as np
def a2p(o, z, x):
x = x / np.linalg.norm(x)
z = z / np.linalg.norm(z)
y = np.cross(z, x)
y = y / np.linalg.norm(y)
r = np.eye(4)
r[:-1, :-1] = x, y, z
r[-1, :-1] = o