|
@@ -143,8 +143,8 @@ iv::decition::Decition iv::decition::HapoAdapter::getAdapterDeciton(GPS_INS now_
|
|
|
|
|
|
if(((now_gps_ins.ins_pitch_angle<-2.5 && ServiceCarStatus.daocheMode)||
|
|
|
(now_gps_ins.ins_pitch_angle>2.5 && !ServiceCarStatus.daocheMode))
|
|
|
- && abs(realSpeed)<1.0){
|
|
|
- controlSpeed=max((float)20.0,controlSpeed);
|
|
|
+ && (dSpeed-realSpeed)>3.0){
|
|
|
+ controlSpeed=max((float)30.0,controlSpeed);
|
|
|
controlSpeed=min((float)40.0,controlSpeed);
|
|
|
}
|
|
|
// 斜坡加大油门 end
|
|
@@ -263,15 +263,29 @@ iv::decition::Decition iv::decition::HapoAdapter::getAdapterDeciton(GPS_INS now_
|
|
|
(*decition)->home_light=0;
|
|
|
(*decition)->roof_light=0;
|
|
|
|
|
|
-
|
|
|
+ static int64_t DoorTimeStart=-1;
|
|
|
+ static int32_t door=0;
|
|
|
if(ServiceCarStatus.has_mbdoor){
|
|
|
if(ServiceCarStatus.mbdoor){
|
|
|
- (*decition)->door=2;
|
|
|
+ door=2;
|
|
|
+ //(*decition)->door=2;
|
|
|
+ DoorTimeStart=QDateTime::currentSecsSinceEpoch();
|
|
|
+ ServiceCarStatus.has_mbdoor=0;
|
|
|
}else{
|
|
|
- (*decition)->door=3;
|
|
|
+ door=3;
|
|
|
+ // (*decition)->door=3;
|
|
|
+ DoorTimeStart=QDateTime::currentSecsSinceEpoch();
|
|
|
+ ServiceCarStatus.has_mbdoor=0;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ if((QDateTime::currentSecsSinceEpoch()-DoorTimeStart)>10)
|
|
|
+ (*decition)->door=0;
|
|
|
+ else
|
|
|
+ (*decition)->door=door;
|
|
|
+ givlog->debug("decition_brain_bool","DoorTimeStart: %d,current: %d",
|
|
|
+ DoorTimeStart,QDateTime::currentSecsSinceEpoch());
|
|
|
+
|
|
|
if(ServiceCarStatus.has_mbjinguang){
|
|
|
if(ServiceCarStatus.mbjinguang){
|
|
|
(*decition)->nearLight=1;
|