Added the heading controller and mode selection for CART2 vehicle.