Browse Source

modify plan speed

zhangjia 3 years ago
parent
commit
afbfaaa8c5
1 changed files with 8 additions and 0 deletions
  1. 8 0
      src/decition/decition_brain_sf/decition/adc_tools/compute_00.cpp

+ 8 - 0
src/decition/decition_brain_sf/decition/adc_tools/compute_00.cpp

@@ -374,6 +374,9 @@ int iv::decition::Compute00::getPlanSpeed(std::vector<GPSData> MapTrace)
                     }else if(((MapTrace[i]->mfCurvature>0.16))||((MapTrace[i]->mfCurvature<-0.16))){
                         MapTrace[i]->roadMode=14;
                     }
+                   /* else{
+                              MapTrace[i]->roadMode=18;
+                        }*/
                 }
                 for(int i=0;i<MapTrace.size();i++)
                 {
@@ -443,6 +446,11 @@ int iv::decition::Compute00::getPlanSpeed(std::vector<GPSData> MapTrace)
                                     doubledata[j][4]=min((Curve_LargeSpeed+step_count*step_speed),straightCurveSpeed);
                                     step_count++;
                                 }
+                        }else if(mode0to18countSum>0){
+                            for(int j=i;j>=i-mode0to18countSum;j--){
+                                doubledata[j][4]=Curve_LargeSpeed;
+                                step_count++;
+                            }
                         }else{
                                 doubledata[i][4]=Curve_LargeSpeed;
                         }