Added communications with VehicleWrapper. First working version in U of Tokyo's Vicon lab.