Pretty good altitude hold with velocity hold stuff