Cleaned the code.

All of the debug drawing is in one function