Cleanups in debug
Added Coord class + cleanup