An Image-Based Path Planning Algorithm Using a UAV Equipped with Stereo Vision