|
@@ -228,7 +228,7 @@ iv::Point2D iv::decition::frenet_to_cartesian1D(std::vector<GPSData> gpsMap,doub
|
|
|
int s_index=(int)(s_condition-(*gpsMap[index]).frenet_s)*10+index;
|
|
|
int start_index=max(0,s_index-500);
|
|
|
int map_size=gpsMap.size();
|
|
|
- int end_index=min(s_index+500,map_size);
|
|
|
+ int end_index=min(s_index+500,map_size-1);
|
|
|
|
|
|
int map_max=(*gpsMap[map_size-1]).frenet_s;
|
|
|
double s_index_min=(*gpsMap[start_index]).frenet_s;
|