利用距离变换的路径规划算法,在linux下依赖Freelgut OpenCV