Smooth control; start implementing Altitude hold