|
@@ -1913,9 +1913,10 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
|
|
|
std::cout<<"dSpeed= "<<dSpeed<<std::endl;
|
|
|
|
|
|
// givlog->debug("SPEED","dSpeed is %f",dSpeed);
|
|
|
+ gps_decition->wheel_angle = 0.0 - controlAng;
|
|
|
phaseSpeedDecition(gps_decition, secSpeed, obsDistance, obsSpeed,now_gps_ins);
|
|
|
|
|
|
- gps_decition->wheel_angle = 0.0 - controlAng;
|
|
|
+
|
|
|
|
|
|
lastAngle=gps_decition->wheel_angle;
|
|
|
|