fix: fix angle diff calculation of mission_planner (autowarefoundatio…

…n#772) (autowarefoundation#152)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

map/lanelet2_extension/lib/query.cpp

@@ -731,10 +731,11 @@ bool query::getClosestLanelet(
       if (angle_diff < min_angle) {
         min_angle = angle_diff;
         *closest_lanelet_ptr = llt;
-      } else if ((segment_angle - pose_yaw) < 1e-04) {
-        min_angle = std::abs(segment_angle - pose_yaw);
-        *closest_lanelet_ptr = llt;
       }
+      /* else if ((segment_angle - pose_yaw) < 1e-04) {
+         min_angle = std::abs(segment_angle - pose_yaw);
+         *closest_lanelet_ptr = llt;
+       }*/
     }
   }