Hide printing behind DEBUG flag, more printing stuff.  Math is still wrong