浏览代码

angle debug add limit value

chenxiaowei 1 年之前
父节点
当前提交
1f3edc2c1d
共有 1 个文件被更改,包括 3 次插入0 次删除
  1. 3 0
      src/decition/decition_brain_sf_changan_shenlan/decition/brain.cpp

+ 3 - 0
src/decition/decition_brain_sf_changan_shenlan/decition/brain.cpp

@@ -447,6 +447,9 @@ void iv::decition::BrainDecition::run() {
                 decition_gps->angle_active = 0;//横向控制激活模式
                 decition_gps->angle_active = 0;//横向控制激活模式
                 decition_gps->angle_mode = 0; //横向控制激活,和上一条同时满足才执行横向请求角度
                 decition_gps->angle_mode = 0; //横向控制激活,和上一条同时满足才执行横向请求角度
                 decition_gps->auto_mode = 0; //3为自动控制模式
                 decition_gps->auto_mode = 0; //3为自动控制模式
+               // ServiceCarStatus.ang_debug=ServiceCarStatus.ang_debug*15.9;//如果xml中配置的是车轮转角
+                ServiceCarStatus.ang_debug=max((double)-430.0,ServiceCarStatus.ang_debug);
+                ServiceCarStatus.ang_debug=min((double)430.0,ServiceCarStatus.ang_debug);
                 decition_gps->wheel_angle = ServiceCarStatus.ang_debug;//0;
                 decition_gps->wheel_angle = ServiceCarStatus.ang_debug;//0;
             }
             }
             else
             else