Cleaned up code, changing README now
Changed README to reflect state of software
Organized urdfs and edited README
Small change to README
Miniglogged everywhere
Replaced mutexes with safer std::lock_guard
Changed mutexes
Small changes to code
Fixed Node issues, cleaned up debug mode throughout
Adds debug-level info throughout
Googlified, verified Node comm, added debug flag.
Added command_time to vehicle command struct
Merge pull request #1 from arpg/vehicle_control

Vehicle control