|
@@ -177,14 +177,21 @@ iv::decition::Decition iv::decition::SightseeingAdapter::getAdapterDeciton(GPS_I
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ //rubbish add 2022.3.23
|
|
|
+ if(dSpeed>0){
|
|
|
+ controlBrake=0;
|
|
|
+ }
|
|
|
+
|
|
|
+ //rubbish end 2022.3.23
|
|
|
+
|
|
|
if(DecideGps00::minDecelerate<0){
|
|
|
controlBrake = max((0-DecideGps00::minDecelerate),controlBrake);
|
|
|
controlSpeed=0;
|
|
|
}
|
|
|
|
|
|
|
|
|
- controlBrake=limitBrake(realSpeed,controlBrake,dSpeed,obsDistance,ttc);
|
|
|
- controlSpeed = limitSpeed(realSpeed, controlBrake, dSpeed, controlSpeed);
|
|
|
+ //controlBrake=limitBrake(realSpeed,controlBrake,dSpeed,obsDistance,ttc);
|
|
|
+ //controlSpeed = limitSpeed(realSpeed, controlBrake, dSpeed, controlSpeed);
|
|
|
|
|
|
double reverse_speed=-(realSpeed+8)/3.6;//avoid veh in the reverse road
|
|
|
if((obsDistance>8.0)&&(obsSpeed<reverse_speed)){
|
|
@@ -200,7 +207,7 @@ iv::decition::Decition iv::decition::SightseeingAdapter::getAdapterDeciton(GPS_I
|
|
|
|
|
|
|
|
|
(*decition)->brake = controlBrake*9;//9 zj-6
|
|
|
- (*decition)->torque=controlSpeed;
|
|
|
+ (*decition)->torque=dSpeed;
|
|
|
lastBrake= (*decition)->brake;
|
|
|
lastTorque=(*decition)->torque;
|
|
|
|
|
@@ -222,16 +229,14 @@ iv::decition::Decition iv::decition::SightseeingAdapter::getAdapterDeciton(GPS_I
|
|
|
// givlog->debug("brain_decition","brake: %f,obsDistance: %f,obsSpeed: %f,reverse_speed: %f",
|
|
|
// (*decition)->brake,obsDistance,obsSpeed,reverse_speed);
|
|
|
|
|
|
-// givlog->debug("brain_decition","dSpeed: %f,realspeed: %f,brake: %f,torque: %f",
|
|
|
-// dSpeed,realSpeed,(*decition)->brake,(*decition)->torque);
|
|
|
+
|
|
|
|
|
|
(*decition)->grade=1;
|
|
|
(*decition)->mode=1;
|
|
|
(*decition)->speak=0;
|
|
|
- (*decition)->handBrake=1; // 0: laqi 1: shifang
|
|
|
+
|
|
|
(*decition)->bright=false;
|
|
|
(*decition)->engine=0;
|
|
|
-
|
|
|
(*decition)->dangweiEnable=true;
|
|
|
(*decition)->angleEnable=true;
|
|
|
(*decition)->speedEnable=true;
|
|
@@ -242,18 +247,19 @@ iv::decition::Decition iv::decition::SightseeingAdapter::getAdapterDeciton(GPS_I
|
|
|
(*decition)->angSpeed=60;
|
|
|
(*decition)->topLight=0;
|
|
|
|
|
|
-
|
|
|
+ (*decition)->handBrake=0; // 0: shifang 1: laqi
|
|
|
if(ServiceCarStatus.bocheMode ||ServiceCarStatus.daocheMode){
|
|
|
- (*decition)->dangWei=2;
|
|
|
+ (*decition)->dangWei=4;
|
|
|
(*decition)->backLight=1;
|
|
|
}
|
|
|
//1220
|
|
|
else{
|
|
|
- (*decition)->dangWei=4;
|
|
|
+ (*decition)->dangWei=2;
|
|
|
(*decition)->backLight=0;
|
|
|
}
|
|
|
|
|
|
-
|
|
|
+ givlog->debug("brain_decition","dSpeed: %f,realspeed: %f,brake: %f,torque: %f,accAim: %f,handBrake: %d,dangWei: %d",
|
|
|
+ dSpeed,realSpeed,(*decition)->brake,(*decition)->torque,accAim,(*decition)->handBrake,(*decition)->dangWei);
|
|
|
|
|
|
if((*decition)->brake>0){
|
|
|
(*decition)->brakeLight=1;
|