Fix OffRoad to work with yarp