dPQplane_basis = np.vstack((dPQplane_basis, [0,0,0,1]))
dPQplane_into = np.linalg.inv(dPQplane_basis)
- dp_plane = unaugment(dPQplane_into @ augment0(dp))
- dq_plane = unaugment(dPQplane_into @ augment0(dq))
- q_plane = dPQplane_into @ augment(q)
- q_plane = unaugment(dPQplane_into @ augment(q))
+ dp_plane = unaugment(dPQplane_into * augment0(dp))
+ dq_plane = unaugment(dPQplane_into * augment0(dq))
+ q_plane = unaugment(dPQplane_into * augment(q))
dist_pq_plane = np.linalg.norm(q_plane)
# two circular arcs of equal maximum possible radius