|
@@ -594,12 +594,29 @@ void MultiStationPlan(iv::v2x::v2x * pxv2x,double fsrclat,double fsrclon,double
|
|
|
givlog->verbose(" %d %11.7f %11.7f %11.3f ",i,data->gps_lat,
|
|
|
data->gps_lng,data->ins_heading_angle);
|
|
|
|
|
|
- data->roadSum = 1;
|
|
|
- data->roadMode = 0;
|
|
|
- data->roadOri = 0;
|
|
|
+// data->roadSum = 1;
|
|
|
+// data->roadMode = 0;
|
|
|
+// data->roadOri = 0;
|
|
|
|
|
|
- if(xPlan[i].lanmp == -1)data->roadMode = 15;
|
|
|
- if(xPlan[i].lanmp == 1)data->roadMode = 14;
|
|
|
+// if(xPlan[i].lanmp == -1)data->roadMode = 15;
|
|
|
+// if(xPlan[i].lanmp == 1)data->roadMode = 14;
|
|
|
+ data->roadOri = xPlan[i].mnLaneori;
|
|
|
+ data->roadSum = xPlan[i].mnLaneTotal;
|
|
|
+ data->mfDisToLaneLeft = xPlan[i].mfDisToLaneLeft;
|
|
|
+ data->mfDisToRoadLeft = xPlan[i].mfDisToRoadLeft;
|
|
|
+ data->mfLaneWidth = xPlan[i].mWidth;
|
|
|
+ data->mfRoadWidth = xPlan[i].mfRoadWidth;
|
|
|
+
|
|
|
+ data->mode2 = xPlan[i].nSignal;
|
|
|
+ if(data->mode2 == 3000)
|
|
|
+ {
|
|
|
+ int k;
|
|
|
+ for(k=(mapdata.size()-1);k>(mapdata.size()-150);k--)
|
|
|
+ {
|
|
|
+ if(k<0)break;
|
|
|
+ mapdata.at(k)->mode2 = 3000;
|
|
|
+ }
|
|
|
+ }
|
|
|
|
|
|
mapdata.push_back(data);
|
|
|
|