integrate servo and servo control via altimeter