|
@@ -144,17 +144,20 @@ void executeDecition(const iv::brain::decition &decition)
|
|
|
|
|
|
double fWheelAngleReq = decition.wheelangle();
|
|
|
double fsendinter = 0.02;
|
|
|
- if(fabs(fWheelAngleReq - gfWheelAngle)/fsendinter > gfWheelSpeedLim)
|
|
|
- {
|
|
|
- if(fWheelAngleReq > gfWheelAngle)
|
|
|
- {
|
|
|
- fWheelAngleReq = fWheelAngleReq + fsendinter * gfWheelSpeedLim;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- fWheelAngleReq = fWheelAngleReq - fsendinter * gfWheelSpeedLim;
|
|
|
- }
|
|
|
- }
|
|
|
+// if(fabs(fWheelAngleReq - gfWheelAngle)/fsendinter > gfWheelSpeedLim)
|
|
|
+// {
|
|
|
+// if(fWheelAngleReq > gfWheelAngle)
|
|
|
+// {
|
|
|
+// fWheelAngleReq = gfWheelAngle + fsendinter * gfWheelSpeedLim;
|
|
|
+// }
|
|
|
+// else
|
|
|
+// {
|
|
|
+// fWheelAngleReq = gfWheelAngle - fsendinter * gfWheelSpeedLim;
|
|
|
+// }
|
|
|
+
|
|
|
+// }
|
|
|
+
|
|
|
+ std::cout<<" wheel req: "<<decition.wheelangle()<<" real send : "<<fWheelAngleReq<<" real whhel:"<<gfWheelAngle<< std::endl;
|
|
|
|
|
|
_m1C4.ACC_LatAngReq = ECU_1C4_ACC_LatAngReq_toS(fWheelAngleReq);
|
|
|
//_m1C4.ADS_Reqmode = decition.angle_mode(); //20221102,新车没有此信号
|