|
@@ -11,17 +11,17 @@ extern iv::Ivlog * givlog;
|
|
|
using namespace std;
|
|
|
|
|
|
|
|
|
-iv::decition::Jeely_xingyueL_Adapter::Jeely_xingyueL_Adapter(){
|
|
|
+iv::decition::Jeely_xingyueL_adapter::Jeely_xingyueL_adapter(){
|
|
|
adapter_id=5;
|
|
|
- adapter_name="hapo";
|
|
|
+ adapter_name="Jeely_xingyueL";
|
|
|
}
|
|
|
-iv::decition::Jeely_xingyueL_Adapter::~Jeely_xingyueL_Adapter(){
|
|
|
+iv::decition::Jeely_xingyueL_adapter::~Jeely_xingyueL_adapter(){
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
-iv::decition::Decition iv::decition::Jeely_xingyueL_Adapter::getAdapterDeciton(GPS_INS now_gps_ins, std::vector<Point2D> trace , float dSpeed, float obsDistance ,
|
|
|
+iv::decition::Decition iv::decition::Jeely_xingyueL_adapter::getAdapterDeciton(GPS_INS now_gps_ins, std::vector<Point2D> trace , float dSpeed, float obsDistance ,
|
|
|
float obsSpeed,float accAim,float accNow ,bool changingDangWei,Decition *decition){
|
|
|
accAim=min(0.7f,accAim);
|
|
|
|
|
@@ -97,27 +97,6 @@ iv::decition::Decition iv::decition::Jeely_xingyueL_Adapter::getAdapterDeciton(G
|
|
|
controlSpeed= ServiceCarStatus.torque_st+((0-u)-ServiceCarStatus.mfCalAcc)*20;//1115 *10
|
|
|
}
|
|
|
|
|
|
- // if(((gpsIns.ins_pitch_angle>-2.5 && ServiceCarStatus.daocheMode)||
|
|
|
- // (gpsIns.ins_pitch_angle<2.5 && !ServiceCarStatus.daocheMode))){
|
|
|
- // if(realSpeed<5 ){
|
|
|
- // controlSpeed=min((float)25.0,controlSpeed); //youmenxianxiao 30
|
|
|
- // }else if(realSpeed<10){
|
|
|
- // controlSpeed=min((float)25.0,controlSpeed); //40
|
|
|
- // }
|
|
|
- // }
|
|
|
-
|
|
|
-
|
|
|
- // controlSpeed = min((float)(ServiceCarStatus.torque_st+1.0),controlSpeed); //1115 5.0
|
|
|
-
|
|
|
-// if(accAim>0 && ServiceCarStatus.mfCalAcc>0 && realSpeed>1 ){
|
|
|
-// if(controlSpeed>0){
|
|
|
-// controlSpeed = ServiceCarStatus.torque_st;
|
|
|
-// }
|
|
|
-// }else if(accAim<0 && ServiceCarStatus.mfCalAcc<0 && dSpeed>0){
|
|
|
-// if(controlSpeed>0 ){
|
|
|
-// controlSpeed = ServiceCarStatus.torque_st;
|
|
|
-// }
|
|
|
-// }
|
|
|
|
|
|
|
|
|
if(controlSpeed>ServiceCarStatus.torque_st){
|
|
@@ -325,7 +304,7 @@ iv::decition::Decition iv::decition::Jeely_xingyueL_Adapter::getAdapterDeciton(G
|
|
|
|
|
|
|
|
|
|
|
|
-float iv::decition::Jeely_xingyueL_Adapter::limitBrake(float realSpeed, float controlBrake,float dSpeed,float obsDistance , float ttc){
|
|
|
+float iv::decition::Jeely_xingyueL_adapter::limitBrake(float realSpeed, float controlBrake,float dSpeed,float obsDistance , float ttc){
|
|
|
|
|
|
//刹车限制
|
|
|
|
|
@@ -361,7 +340,7 @@ float iv::decition::Jeely_xingyueL_Adapter::limitBrake(float realSpeed, float co
|
|
|
|
|
|
}
|
|
|
|
|
|
-float iv::decition::Jeely_xingyueL_Adapter::limitSpeed(float realSpeed, float controlBrake,float dSpeed,float controlSpeed ){
|
|
|
+float iv::decition::Jeely_xingyueL_adapter::limitSpeed(float realSpeed, float controlBrake,float dSpeed,float controlSpeed ){
|
|
|
|
|
|
controlSpeed=min((float)100.0,controlSpeed);
|
|
|
controlSpeed=max((float)0.0,controlSpeed);
|