Fixed headlight reset when starting to drive
Made stop_movement public