Fixed speed command, Implemented location buffer

Also simplified and cleaned up the robot software - still more work to
be done here.