dq = unit_v(cp[3]-cp[2])
dbg('HelixishCurve __init__', cp)
+ dbg(dp, dq)
# the initial attempt
# - solve in the plane containing dP and dQ
dPQplane_normal = np.cross(dp, dq)
if (np.linalg.norm(dPQplane_normal) < 1E6):
+ dbg('dPQplane_normal small')
dPQplane_normal += [0, 0, 1E5]
dPQplane_normal = unit_v(dPQplane_normal)
p));
dbg(dPQplane_basis)
dPQplane_basis = np.vstack((dPQplane_basis, [0,0,0,1]))
- dbg(dPQplane_basis)
+ #dbg(dPQplane_basis)
dPQplane_into = np.linalg.inv(dPQplane_basis)
dp_plane = augmatmultiply(dPQplane_into, dp, augwith=0)
def dbg(*args):
for f in _files:
- print('// D ', *args, file=f)
+ s = ' '.join(map(str,args))
+ for l in s.split('\n'):
+ print('// D ', l, file=f)
f.flush()
class NullVisdebug():