Added debug levels to printing.
Added simple epsilon, still climbs sometimes.