Added emergency stop/reset, auto mode to status, and tuned path following again