实现算法
1、首先将满足条件的道路（link） 放到指定的容器中
vector<sdk::link> vec_linkA;
vector<sdk::link> vec_linkB; //同时copy一份到vec_linkB
vector<sdk::link> vec_link_error; //存放不通地方的道路也就是link
2、将vec_linkB 的link逐一出栈去vec_linkA查找是否有该link下一条可行的路，只要能找到一条就证明这里是通的
a、如果 link 是有方向的，那么按方向看是否有可行的link
b、如果 link 是无方向的，那么任意一个端点 node_id上都要挂接link 并且最少有一个node点是
是下一条路的起始点
本文出自 “简单可依赖” 博客，谢绝转载！
原文：http://wenxuehui.blog.51cto.com/12898974/1956881