Added theoretical pid altitude hold