|
@@ -91,7 +91,7 @@ float iv::decition::PIDController::getPidAngle(float realSpeed, std::vector<Poin
|
|
|
if(ServiceCarStatus.msysparam.mvehtype=="ge3" || ServiceCarStatus.msysparam.mvehtype=="vv7"){
|
|
|
realSpeed > 40 ? PreviewDistance = max(6.0, realSpeed *0.6) : PreviewDistance = max(4.0, realSpeed *0.3);
|
|
|
}else{
|
|
|
- realSpeed > 40 ? PreviewDistance = max(6.0, realSpeed *0.6) : PreviewDistance = max(6.0, realSpeed *0.5);
|
|
|
+ realSpeed > 40 ? PreviewDistance = max(6.0, realSpeed *0.6) : PreviewDistance = max(4.0, realSpeed *0.3);
|
|
|
}
|
|
|
|
|
|
|
|
@@ -122,10 +122,12 @@ float iv::decition::PIDController::getPidAngle(float realSpeed, std::vector<Poin
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ if((sumdis>1.0) &&(gpsIndex == 0))gpsIndex = nsize -1;
|
|
|
+
|
|
|
|
|
|
bool bUseAutowareKappa = true;
|
|
|
double wheel_base = 2.9;
|
|
|
- double wheelratio = 15.6;
|
|
|
+ double wheelratio = 13.6;
|
|
|
|
|
|
if(bUseAutowareKappa)
|
|
|
{
|