|
@@ -2022,6 +2022,14 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
|
|
|
|
|
|
|
|
|
//-----------------------------------------1+X采集车车路协同,add---------------------------------------------
|
|
|
+ if(ServiceCarStatus.mRSUupdateTimer.elapsed()>5*1000)
|
|
|
+ {
|
|
|
+ ServiceCarStatus.rsu_traffic_type=200;//lvdeng
|
|
|
+ ServiceCarStatus.rsu_warning_type=200;
|
|
|
+// ServiceCarStatus.rsu_gps_lat = 0.0; //路况信息或预警信息有效的时候才会使用到这写变量,所以这些变量的信息可不清除
|
|
|
+// ServiceCarStatus.rsu_gps_lng = 0.0;
|
|
|
+// ServiceCarStatus.rsu_trafficelimit_spd=200;
|
|
|
+ }
|
|
|
int traffic_type=ServiceCarStatus.rsu_traffic_type;//路况信息
|
|
|
int warning_type=ServiceCarStatus.rsu_warning_type;//预警信息,RSU获得
|
|
|
double distance_to_center=0;
|
|
@@ -2094,6 +2102,7 @@ if((traffic_type==0x01)||(traffic_type==0x02)||(traffic_type==0x03)||(traffic_ty
|
|
|
else if(warning_type==0x02)
|
|
|
{
|
|
|
dSpeed=0.0;
|
|
|
+ minDecelerate=-2.0;
|
|
|
ServiceCarStatus.vehicle_state_1x = 2;
|
|
|
ServiceCarStatus.target_spd_1x = 0;
|
|
|
}
|