Fix error in file parser
Add debug drawing of velocity