浏览代码

modify pathpoint find

nvidia 3 年之前
父节点
当前提交
14173333bd
共有 1 个文件被更改,包括 1 次插入1 次删除
  1. 1 1
      src/decition/decition_brain_sf/decition/adc_tools/compute_00.cpp

+ 1 - 1
src/decition/decition_brain_sf/decition/adc_tools/compute_00.cpp

@@ -534,7 +534,7 @@ int iv::decition::Compute00::getNearestPointIndex(GPS_INS rp, const std::vector<
             index = i;
             index = i;
             minDis = tmpdis;
             minDis = tmpdis;
             maxAng = min(abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle), abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle - 360));
             maxAng = min(abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle), abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle - 360));
-            maxAng = min(maxAngle, abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle + 360));
+            maxAng = min(maxAng, abs(rp.ins_heading_angle - (*gpsMap[i]).ins_heading_angle + 360));
         }
         }
     }
     }