Some cleanup
Fix stopping criteria
Fix output
I'm finally happy with the stopping criteria
I Am READY