Wire up controller and take_off command