|
@@ -1624,17 +1624,17 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
|
|
if(front_car_id>0){
|
|
if(front_car_id>0){
|
|
static bool final_lock=false;
|
|
static bool final_lock=false;
|
|
if((distoend<90)&&(front_car.front_car_dis<obsDistance+10)){
|
|
if((distoend<90)&&(front_car.front_car_dis<obsDistance+10)){
|
|
- if((obsDistance>5)&&(obsDistance<15)){
|
|
|
|
|
|
+ if((obsDistance>3)&&(obsDistance<20)){
|
|
if((realspeed>3)&&(final_lock==false)){
|
|
if((realspeed>3)&&(final_lock==false)){
|
|
- minDecelerate=-0.5;
|
|
|
|
|
|
+ minDecelerate=-0.7;
|
|
}else{
|
|
}else{
|
|
dSpeed = min(3.0,dSpeed);
|
|
dSpeed = min(3.0,dSpeed);
|
|
final_lock=true;
|
|
final_lock=true;
|
|
}
|
|
}
|
|
obsDistance=200;
|
|
obsDistance=200;
|
|
- }else if((obsDistance>2)&&(obsDistance<5)){
|
|
|
|
|
|
+ }else if((obsDistance>1)&&(obsDistance<3)){
|
|
minDecelerate=-0.5;
|
|
minDecelerate=-0.5;
|
|
- }else{
|
|
|
|
|
|
+ }else if(obsDistance<1){
|
|
minDecelerate=-1.0;
|
|
minDecelerate=-1.0;
|
|
}
|
|
}
|
|
if(realspeed<1){
|
|
if(realspeed<1){
|