style(pre-commit): autofix

Author: pre-commit-ci[bot]

control/mpc_lateral_controller/include/mpc_lateral_controller/mpc.hpp

@@ -380,8 +380,8 @@ class MPC
     const MPCTrajectory & reference_trajectory, const MPCData & mpc_data_traj_raw,
     const MPCData & mpc_data, const MPCMatrix & mpc_matrix,
     const AckermannLateralCommand & ctrl_cmd, const VectorXd & Uex,
-    const Odometry & current_kinematics,
-    bool success_data_for_diagnostic , bool success_data_traj_raw) const;
+    const Odometry & current_kinematics, bool success_data_for_diagnostic,
+    bool success_data_traj_raw) const;
 
   /**
    * @brief calculate steering rate limit along with the target trajectory

control/mpc_lateral_controller/src/mpc.cpp

@@ -127,7 +127,8 @@ bool MPC::calculateMPC(
 Float32MultiArrayStamped MPC::generateDiagData(
   const MPCTrajectory & reference_trajectory, const MPCData & mpc_data_traj_raw,
   const MPCData & mpc_data, const MPCMatrix & mpc_matrix, const AckermannLateralCommand & ctrl_cmd,
-  const VectorXd & Uex, const Odometry & current_kinematics, bool success_data_for_diagnostic , bool success_data_traj_raw) const
+  const VectorXd & Uex, const Odometry & current_kinematics, bool success_data_for_diagnostic,
+  bool success_data_traj_raw) const
 {
   Float32MultiArrayStamped diagnostic;
 
@@ -147,31 +148,50 @@ Float32MultiArrayStamped MPC::generateDiagData(
   const auto append_diag = [&](const auto & val) -> void {
     diagnostic.data.push_back(static_cast<DiagnosticValueType>(val));
   };
-  append_diag(ctrl_cmd.steering_tire_angle);      // [0] final steering command (MPC + LPF)
-  append_diag(Uex(0));                            // [1] mpc calculation result
-  append_diag(mpc_matrix.Uref_ex(0));             // [2] feed-forward steering value
-  append_diag(success_data_for_diagnostic ? std::atan(nearest_smooth_k * wb) : -1.0);  // [3] feed-forward steering value raw
-  append_diag(success_data_for_diagnostic ? mpc_data.steer : -1.0);                    // [4] current steering angle
-  append_diag(success_data_for_diagnostic ? mpc_data.lateral_err : -1.0);              // [5] lateral error (the actual error used for MPC)
+  append_diag(ctrl_cmd.steering_tire_angle);  // [0] final steering command (MPC + LPF)
+  append_diag(Uex(0));                        // [1] mpc calculation result
+  append_diag(mpc_matrix.Uref_ex(0));         // [2] feed-forward steering value
+  append_diag(
+    success_data_for_diagnostic ? std::atan(nearest_smooth_k * wb)
+                                : -1.0);  // [3] feed-forward steering value raw
+  append_diag(success_data_for_diagnostic ? mpc_data.steer : -1.0);  // [4] current steering angle
+  append_diag(
+    success_data_for_diagnostic ? mpc_data.lateral_err
+                                : -1.0);  // [5] lateral error (the actual error used for MPC)
   append_diag(tf2::getYaw(current_kinematics.pose.pose.orientation));  // [6] current_pose yaw
-  append_diag(success_data_for_diagnostic ? tf2::getYaw(mpc_data.nearest_pose.orientation) : -1.0);         // [7] nearest_pose yaw
-  append_diag(success_data_for_diagnostic ? mpc_data.yaw_err : -1.0);                                       // [8] yaw error
-  append_diag(success_data_for_diagnostic ? reference_trajectory.vx.at(mpc_data.nearest_idx) : -1.0);       // [9] reference velocity
-  append_diag(current_velocity);                                       // [10] measured velocity
-  append_diag(wz_command);                           // [11] angular velocity from steer command
-  append_diag(success_data_for_diagnostic ? wz_measured : -1.0);                          // [12] angular velocity from measured steer
-  append_diag(success_data_for_diagnostic ? current_velocity * nearest_smooth_k : -1.0);  // [13] angular velocity from path curvature
-  append_diag(success_data_for_diagnostic ? nearest_smooth_k : -1.0);          // [14] nearest path curvature (used for feed-forward)
-  append_diag(success_data_for_diagnostic ? nearest_k : -1.0);                 // [15] nearest path curvature (not smoothed)
-  append_diag(success_data_for_diagnostic ? mpc_data.predicted_steer : -1.0);  // [16] predicted steer
-  append_diag(success_data_for_diagnostic ? wz_predicted : -1.0);              // [17] angular velocity from predicted steer
+  append_diag(
+    success_data_for_diagnostic ? tf2::getYaw(mpc_data.nearest_pose.orientation)
+                                : -1.0);                               // [7] nearest_pose yaw
+  append_diag(success_data_for_diagnostic ? mpc_data.yaw_err : -1.0);  // [8] yaw error
+  append_diag(
+    success_data_for_diagnostic ? reference_trajectory.vx.at(mpc_data.nearest_idx)
+                                : -1.0);  // [9] reference velocity
+  append_diag(current_velocity);          // [10] measured velocity
+  append_diag(wz_command);                // [11] angular velocity from steer command
+  append_diag(
+    success_data_for_diagnostic ? wz_measured : -1.0);  // [12] angular velocity from measured steer
+  append_diag(
+    success_data_for_diagnostic ? current_velocity * nearest_smooth_k
+                                : -1.0);  // [13] angular velocity from path curvature
+  append_diag(
+    success_data_for_diagnostic ? nearest_smooth_k
+                                : -1.0);  // [14] nearest path curvature (used for feed-forward)
+  append_diag(
+    success_data_for_diagnostic ? nearest_k : -1.0);  // [15] nearest path curvature (not smoothed)
+  append_diag(
+    success_data_for_diagnostic ? mpc_data.predicted_steer : -1.0);  // [16] predicted steer
+  append_diag(
+    success_data_for_diagnostic ? wz_predicted
+                                : -1.0);  // [17] angular velocity from predicted steer
   append_diag(iteration_num);             // [18] iteration number
   append_diag(runtime);                   // [19] runtime of the latest problem solved
   append_diag(objective_value);           // [20] objective value of the latest problem solved
   append_diag(std::clamp(
     Uex(0), -m_steer_lim,
     m_steer_lim));  // [21] control signal after the saturation constraint (clamp)
-  append_diag(success_data_traj_raw ? mpc_data_traj_raw.lateral_err : -1.0);  // [22] lateral error from raw trajectory
+  append_diag(
+    success_data_traj_raw ? mpc_data_traj_raw.lateral_err
+                          : -1.0);  // [22] lateral error from raw trajectory
 
   return diagnostic;
 }