Added holding position function and flight state