Fix bug where path would not be updated in autopilot state