Browse Source

modify pathpoint find

nvidia 3 years ago
parent
commit
14173333bd
1 changed files with 1 additions and 1 deletions
  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;
             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(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));
         }
     }