|
@@ -1049,6 +1049,8 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
|
|
if(distoend == 0.0)distoend = 0.09;
|
|
if(distoend == 0.0)distoend = 0.09;
|
|
acc_end = (-1.0)*nowspeed*nowspeed/(2.0*distoend);
|
|
acc_end = (-1.0)*nowspeed*nowspeed/(2.0*distoend);
|
|
if((acc_end<(-3.0))&&(nowspeed<10))acc_end = -3.0;
|
|
if((acc_end<(-3.0))&&(nowspeed<10))acc_end = -3.0;
|
|
|
|
+ dSecSpeed = sqrt(2.0 * fabs(acc_end) * distoend);
|
|
|
|
+ dSpeed = dSecSpeed * 3.6;
|
|
}
|
|
}
|
|
|
|
|
|
if((distoend <= 0.1)||(PathPoint>=gpsMapLine.size()-2))acc_end = (stopbrake + 0.1)*(-1.0);
|
|
if((distoend <= 0.1)||(PathPoint>=gpsMapLine.size()-2))acc_end = (stopbrake + 0.1)*(-1.0);
|