浏览代码

edit obs distance

Gogs 2 年之前
父节点
当前提交
2e56b70fb3
共有 1 个文件被更改,包括 1 次插入1 次删除
  1. 1 1
      src/decition/decition_brain_sf_jsguide_new/decition/decide_gps_00.cpp

+ 1 - 1
src/decition/decition_brain_sf_jsguide_new/decition/decide_gps_00.cpp

@@ -3523,7 +3523,7 @@ void iv::decition::DecideGps00::computeObsOnRoadXY( iv::GPS_INS now_gps_ins,iv::
         iv::Point2D now_s_d=cartesian_to_frenet1D(gpsMapLine,now_gps_ins.gps_x,now_gps_ins.gps_y);
         givlog->debug("decition_brain","road_num: %d,obsFrenetMid_s: %f,now_s: %f",roadNum,obsFrenetMid.s,now_s_d.s);
         obsFrenet.s=obsFrenetMid.s-now_s_d.s;
-        lidarDistance = obsPoint.y + lidarXiuZheng;   //激光距离推到车头  gjw20191110 lidar
+        lidarDistance = obsFrenet.s;//obsPoint.y + lidarXiuZheng;   //激光距离推到车头  gjw20191110 lidar
         //    lidarDistance=-1;
         if (lidarDistance<0)
         {