fix(motion_velocity_smoother): front wheel steer rate calculation (autowarefoundation#5965)

autowarefoundation#5964

Signed-off-by: Vincent Richard <richard-v@macnica.co.jp>

Author: VRichardJP

planning/motion_velocity_smoother/src/smoother/smoother_base.cpp

@@ -224,8 +224,8 @@ TrajectoryPoints SmootherBase::applySteeringRateLimit(
     auto & steer_back = output.at(i).front_wheel_angle_rad;
 
     // calculate the just 2 steering angle
-    steer_front = std::atan(base_param_.wheel_base * curvature_v.at(i));
-    steer_back = std::atan(base_param_.wheel_base * curvature_v.at(i + 1));
+    steer_front = std::atan(base_param_.wheel_base * curvature_v.at(i + 1));
+    steer_back = std::atan(base_param_.wheel_base * curvature_v.at(i));
 
     const auto mean_vel = 0.5 * (v_front + v_back);
     const auto dt = std::max(points_interval / mean_vel, std::numeric_limits<double>::epsilon());