move drone commands into function
height control for position control