diff --git a/common/motion_utils/include/motion_utils/trajectory/trajectory.hpp b/common/motion_utils/include/motion_utils/trajectory/trajectory.hpp
index b6656393a8582..841fc9193bae6 100644
--- a/common/motion_utils/include/motion_utils/trajectory/trajectory.hpp
+++ b/common/motion_utils/include/motion_utils/trajectory/trajectory.hpp
@@ -198,7 +198,7 @@ boost::optional<size_t> findNearestIndex(
 
   for (size_t i = 0; i < points.size(); ++i) {
     const auto squared_dist = tier4_autoware_utils::calcSquaredDistance2d(points.at(i), pose);
-    if (squared_dist > max_squared_dist) {
+    if (squared_dist > max_squared_dist || squared_dist >= min_squared_dist) {
       continue;
     }
 
@@ -208,10 +208,6 @@ boost::optional<size_t> findNearestIndex(
       continue;
     }
 
-    if (squared_dist >= min_squared_dist) {
-      continue;
-    }
-
     min_squared_dist = squared_dist;
     min_idx = i;
     is_nearest_found = true;