fix them bugs
add some comments, add map printing on the end, ..
Merge branch 'master' of github.com:koo5/cnc_stuff
reorganization, fixes