Vehicle control

Lots of changes to the readme. Also cleans up the urdf file system.