小弟不才....参考visibility graph 做路径规划的东西
蓝色为障碍物 其他两个三角形为起始点终点
每个顶点两两互连 很多线段
http://imgur.com/fgJzjMz
要扣掉不能行走路径 就是不能穿过障碍物
我的方法是用障碍物的边 跟 路径做有无交叉的判断
可是内部对角线连线 我却没办法解决
http://imgur.com/KPgIopP
后来有想到解决方法 就是多边形 顶点 点和点的距离 大于2 就删除路径
可是会删到多余的线段 就是凹下去那端 外围的连线并不是在障碍物内部
请各位大大 可以帮小弟忙一下吗 谢谢