Browse Source

change driver_map_xodrload. fix problem in plan. it's ok.

yuchuli 3 years ago
parent
commit
1281004068
1 changed files with 10 additions and 9 deletions
  1. 10 9
      src/driver/driver_map_xodrload/xodrdijkstra.cpp

+ 10 - 9
src/driver/driver_map_xodrload/xodrdijkstra.cpp

@@ -1063,15 +1063,16 @@ inline double xodrdijkstra::getedgedis(int vs, int vd)
     std::vector<roadedge > * proadedge = &mroadedge;
     std::vector<roadedge > * proadedge = &mroadedge;
     double dis = std::numeric_limits<double>::max();
     double dis = std::numeric_limits<double>::max();
 
 
-//    for(i=0;i<mvectorvertexedge[vs].mvectorroadedge.size();i++)
-//    {
-//        if((vs == mvectorvertexedge[vs].mvectorroadedge[i]->mvertexstart)&&(vd == mvectorvertexedge[vs].mvectorroadedge[i]->mvertexend))
-//        {
-//            dis = mroadedge[i].mlen;
-//            return dis;
-//        }
-//    }
-//    return dis;
+    for(i=0;i<mvectorvertexedge[vs].mvectorroadedge.size();i++)
+    {
+        if((vs == mvectorvertexedge[vs].mvectorroadedge[i]->mvertexstart)&&(vd == mvectorvertexedge[vs].mvectorroadedge[i]->mvertexend))
+        {
+            dis = mvectorvertexedge[vs].mvectorroadedge[i]->mlen;
+  //          dis = mroadedge[i].mlen;
+            return dis;
+        }
+    }
+    return dis;
 
 
     for(i=0;i<mroadedge.size();i++)
     for(i=0;i<mroadedge.size();i++)
     {
     {