Drone hover the same height with sonar under belly in Program 4