|
@@ -1947,6 +1947,9 @@ iv::Station iv::decition::DecideGps00::getNearestStation(iv::GPS_INS now_gps_ins
|
|
station_n[i].map_index=j;
|
|
station_n[i].map_index=j;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
+ givlog->debug("brain_v2x","stationi: %d, map_index: %d",
|
|
|
|
+ i,station_n[i].map_index);
|
|
|
|
+
|
|
}
|
|
}
|
|
int minDistance=10;
|
|
int minDistance=10;
|
|
for (int j = 0; j < gpsMap.size(); j++)
|
|
for (int j = 0; j < gpsMap.size(); j++)
|
|
@@ -1958,6 +1961,10 @@ iv::Station iv::decition::DecideGps00::getNearestStation(iv::GPS_INS now_gps_ins
|
|
now_index=j;
|
|
now_index=j;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
+
|
|
|
|
+ givlog->debug("brain_v2x","now_index: %d",
|
|
|
|
+ now_index);
|
|
|
|
+
|
|
int min_index=gpsMap.size()-1;
|
|
int min_index=gpsMap.size()-1;
|
|
int station_index=0;
|
|
int station_index=0;
|
|
for(int i=0;i<station_size;i++)
|
|
for(int i=0;i<station_size;i++)
|