Robot: use Actuator::change_last_milestone in more places
Move previous_unit_vec from Planner to Robot