Given a sequence of random points, check if it will collide with an obstacle which means it's the occupied space in octomap, and then use the navigation command to control the PX4 to the points which we predict no collision. Also, if you give a target's position, you can check for occlusion between the drone and the target. https://youtu.be/W1sos9TLVeg