Obstacle avoidance with PX4/Gazebo Platform