Minor changes
Stripped down version of hover_vPID to only hover without obstacle avoidance