ackermann motion model bug (ros-navigation#3498) (ros-navigation#3501)

Prevent cost to be modified twice.

(cherry picked from commit 482017c)

Co-authored-by: HAIDAR OBEID <31267966+ObeidHaidar@users.noreply.github.com>

nav2_mppi_controller/src/critics/constraint_critic.cpp

@@ -65,6 +65,7 @@ void ConstraintCritic::score(CriticData & data)
         std::move(out_of_min_bounds_motion) +
         std::move(out_of_turning_rad_motion)) *
         data.model_dt, {1}, immediate) * weight_, power_);
+    return;
   }
 
   data.costs += xt::pow(