dp,
dPQplane_normal,
p));
- dbg(dPQplane_basis)
- dPQplane_basis = np.vstack((dPQplane_basis, [0,0,0,1]))
#dbg(dPQplane_basis)
+ dPQplane_basis = np.vstack((dPQplane_basis, [0,0,0,1]))
+ dbg(dPQplane_basis)
dPQplane_into = np.linalg.inv(dPQplane_basis)
+ dbg(dPQplane_into)
+ p_plane_check = augmatmultiply(dPQplane_into, p)
dp_plane = augmatmultiply(dPQplane_into, dp, augwith=0)
dq_plane = augmatmultiply(dPQplane_into, dq, augwith=0)
q_plane = augmatmultiply(dPQplane_into, q)
dist_pq_plane = np.linalg.norm(q_plane)
+ dbg('plane:', p_plane_check, dp_plane, dq_plane, q_plane)
+
# two circular arcs of equal maximum possible radius
# algorithm courtesy of Simon Tatham (`Railway problem',
# pers.comm. to ijackson@chiark 23.1.2004)