notworking backup commit
new command & line switching implemented
format & clean
typo
working on GPS test
more work dijekstra (not working yet)
gps working (units)
added perfect agent (empty)
Readme update