style(pre-commit): autofix

Author: pre-commit-ci[bot]

common/autoware_motion_utils/include/autoware/motion_utils/factor/planning_factor_interface.hpp

@@ -18,26 +18,26 @@
 #include <autoware/motion_utils/trajectory/trajectory.hpp>
 #include <rclcpp/rclcpp.hpp>
 
-#include <autoware_planning_msgs/msg/path_point.hpp>
-#include <autoware_planning_msgs/msg/trajectory_point.hpp>
-#include <geometry_msgs/msg/pose.hpp>
 #include <autoware_planning_msgs/msg/control_point.hpp>
+#include <autoware_planning_msgs/msg/path_point.hpp>
 #include <autoware_planning_msgs/msg/path_point_with_lane_id.hpp>
 #include <autoware_planning_msgs/msg/planning_factor.hpp>
 #include <autoware_planning_msgs/msg/planning_factor_array.hpp>
 #include <autoware_planning_msgs/msg/safety_factor_array.hpp>
+#include <autoware_planning_msgs/msg/trajectory_point.hpp>
+#include <geometry_msgs/msg/pose.hpp>
 
 #include <string>
 #include <vector>
 
 namespace autoware::motion_utils
 {
 
-using geometry_msgs::msg::Pose;
 using autoware_planning_msgs::msg::ControlPoint;
 using autoware_planning_msgs::msg::PlanningFactor;
 using autoware_planning_msgs::msg::PlanningFactorArray;
 using autoware_planning_msgs::msg::SafetyFactorArray;
+using geometry_msgs::msg::Pose;
 
 class PlanningFactorInterface
 {

common/autoware_motion_utils/include/autoware/motion_utils/resample/resample.hpp

@@ -16,8 +16,8 @@
 #define AUTOWARE__MOTION_UTILS__RESAMPLE__RESAMPLE_HPP_
 
 #include "autoware_planning_msgs/msg/path.hpp"
-#include "autoware_planning_msgs/msg/trajectory.hpp"
 #include "autoware_planning_msgs/msg/path_with_lane_id.hpp"
+#include "autoware_planning_msgs/msg/trajectory.hpp"
 
 #include <vector>
 

common/autoware_motion_utils/include/autoware/motion_utils/trajectory/conversion.hpp

@@ -16,10 +16,10 @@
 #define AUTOWARE__MOTION_UTILS__TRAJECTORY__CONVERSION_HPP_
 
 #include "autoware_planning_msgs/msg/detail/path__struct.hpp"
+#include "autoware_planning_msgs/msg/detail/path_with_lane_id__struct.hpp"
 #include "autoware_planning_msgs/msg/detail/trajectory__struct.hpp"
 #include "autoware_planning_msgs/msg/detail/trajectory_point__struct.hpp"
 #include "std_msgs/msg/header.hpp"
-#include "autoware_planning_msgs/msg/detail/path_with_lane_id__struct.hpp"
 
 #include <vector>
 
@@ -95,7 +95,8 @@ inline TrajectoryPoints convertToTrajectoryPoints(
 }
 
 template <class T>
-autoware_planning_msgs::msg::PathWithLaneId convertToPathWithLaneId([[maybe_unused]] const T & input)
+autoware_planning_msgs::msg::PathWithLaneId convertToPathWithLaneId(
+  [[maybe_unused]] const T & input)
 {
   static_assert(sizeof(T) == 0, "Only specializations of convertToPathWithLaneId can be used.");
   throw std::logic_error("Only specializations of convertToPathWithLaneId can be used.");

common/autoware_motion_utils/include/autoware/motion_utils/trajectory/interpolation.hpp

@@ -17,8 +17,8 @@
 
 #include "autoware/universe_utils/geometry/geometry.hpp"
 
-#include "autoware_planning_msgs/msg/trajectory.hpp"
 #include "autoware_planning_msgs/msg/path_with_lane_id.hpp"
+#include "autoware_planning_msgs/msg/trajectory.hpp"
 
 #include <boost/optional.hpp>
 

common/autoware_motion_utils/include/autoware/motion_utils/trajectory/trajectory.hpp

@@ -24,8 +24,8 @@
 #include <rclcpp/logging.hpp>
 
 #include <autoware_planning_msgs/msg/path_point.hpp>
-#include <autoware_planning_msgs/msg/trajectory_point.hpp>
 #include <autoware_planning_msgs/msg/path_point_with_lane_id.hpp>
+#include <autoware_planning_msgs/msg/trajectory_point.hpp>
 
 #include <algorithm>
 #include <limits>
@@ -58,7 +58,8 @@ void validateNonEmpty(const T & points)
 
 extern template void validateNonEmpty<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const std::vector<autoware_planning_msgs::msg::PathPoint> &);
-extern template void validateNonEmpty<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+extern template void
+validateNonEmpty<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> &);
 extern template void validateNonEmpty<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> &);
@@ -311,7 +312,8 @@ size_t findNearestIndex(const T & points, const geometry_msgs::msg::Point & poin
 extern template size_t findNearestIndex<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points,
   const geometry_msgs::msg::Point & point);
-extern template size_t findNearestIndex<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+extern template size_t
+findNearestIndex<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
   const geometry_msgs::msg::Point & point);
 extern template size_t findNearestIndex<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
@@ -463,8 +465,9 @@ calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::PathPoi
   const geometry_msgs::msg::Point & p_target, const bool throw_exception = false);
 extern template double
 calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t seg_idx,
-  const geometry_msgs::msg::Point & p_target, const bool throw_exception = false);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t seg_idx, const geometry_msgs::msg::Point & p_target,
+  const bool throw_exception = false);
 extern template double
 calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t seg_idx,
@@ -734,8 +737,8 @@ extern template double calcSignedArcLength<std::vector<autoware_planning_msgs::m
   const size_t dst_idx);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const size_t dst_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const size_t dst_idx);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -784,8 +787,8 @@ calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::PathPoint
   const size_t dst_idx);
 extern template std::vector<double>
 calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const size_t dst_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const size_t dst_idx);
 extern template std::vector<double>
 calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -862,8 +865,8 @@ extern template double calcSignedArcLength<std::vector<autoware_planning_msgs::m
   const geometry_msgs::msg::Point & dst_point);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const geometry_msgs::msg::Point & dst_point);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const geometry_msgs::msg::Point & dst_point);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -1147,8 +1150,8 @@ calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::PathPoint>>
   const double offset, const bool throw_exception = false);
 extern template std::optional<geometry_msgs::msg::Point>
 calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const double offset, const bool throw_exception = false);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const double offset, const bool throw_exception = false);
 extern template std::optional<geometry_msgs::msg::Point>
 calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -1293,9 +1296,9 @@ calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const bool throw_exception = false);
 extern template std::optional<geometry_msgs::msg::Pose>
 calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const double offset, const bool set_orientation_from_position_direction = true,
-  const bool throw_exception = false);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const double offset,
+  const bool set_orientation_from_position_direction = true, const bool throw_exception = false);
 extern template std::optional<geometry_msgs::msg::Pose>
 calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -1906,7 +1909,8 @@ void insertOrientation(T & points, const bool is_driving_forward)
 
 extern template void insertOrientation<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   std::vector<autoware_planning_msgs::msg::PathPoint> & points, const bool is_driving_forward);
-extern template void insertOrientation<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+extern template void
+insertOrientation<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
   const bool is_driving_forward);
 extern template void insertOrientation<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
@@ -2051,8 +2055,8 @@ extern template double calcSignedArcLength<std::vector<autoware_planning_msgs::m
   const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
 extern template double
 calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -2460,7 +2464,8 @@ double calcYawDeviation(
 extern template double calcYawDeviation<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points,
   const geometry_msgs::msg::Pose & pose, const bool throw_exception = false);
-extern template double calcYawDeviation<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+extern template double
+calcYawDeviation<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
   const geometry_msgs::msg::Pose & pose, const bool throw_exception = false);
 extern template double calcYawDeviation<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
@@ -2495,7 +2500,8 @@ extern template bool isTargetPointFront<std::vector<autoware_planning_msgs::msg:
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points,
   const geometry_msgs::msg::Point & base_point, const geometry_msgs::msg::Point & target_point,
   const double threshold = 0.0);
-extern template bool isTargetPointFront<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+extern template bool
+isTargetPointFront<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
   const geometry_msgs::msg::Point & base_point, const geometry_msgs::msg::Point & target_point,
   const double threshold = 0.0);

common/autoware_motion_utils/src/factor/velocity_factor_interface.cpp

@@ -16,8 +16,8 @@
 #include <autoware/motion_utils/trajectory/trajectory.hpp>
 
 #include <autoware_planning_msgs/msg/path_point.hpp>
-#include <autoware_planning_msgs/msg/trajectory_point.hpp>
 #include <autoware_planning_msgs/msg/path_point_with_lane_id.hpp>
+#include <autoware_planning_msgs/msg/trajectory_point.hpp>
 
 #include <string>
 #include <vector>

common/autoware_motion_utils/src/trajectory/interpolation.cpp

@@ -17,10 +17,10 @@
 #include "autoware/interpolation/linear_interpolation.hpp"
 #include "autoware/motion_utils/trajectory/trajectory.hpp"
 
-using autoware_planning_msgs::msg::Trajectory;
-using autoware_planning_msgs::msg::TrajectoryPoint;
 using autoware_planning_msgs::msg::PathPointWithLaneId;
 using autoware_planning_msgs::msg::PathWithLaneId;
+using autoware_planning_msgs::msg::Trajectory;
+using autoware_planning_msgs::msg::TrajectoryPoint;
 
 namespace autoware::motion_utils
 {

common/autoware_motion_utils/src/trajectory/trajectory.cpp

@@ -111,8 +111,8 @@ calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::PathPoi
   const geometry_msgs::msg::Point & p_target, const bool throw_exception);
 template double
 calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t seg_idx,
-  const geometry_msgs::msg::Point & p_target, const bool throw_exception);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t seg_idx, const geometry_msgs::msg::Point & p_target, const bool throw_exception);
 template double
 calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t seg_idx,
@@ -122,7 +122,8 @@ calcLongitudinalOffsetToSegment<std::vector<autoware_planning_msgs::msg::Traject
 template size_t findNearestSegmentIndex<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points,
   const geometry_msgs::msg::Point & point);
-template size_t findNearestSegmentIndex<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
+template size_t
+findNearestSegmentIndex<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
   const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
   const geometry_msgs::msg::Point & point);
 template size_t findNearestSegmentIndex<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
@@ -170,8 +171,8 @@ template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::Pat
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points, const size_t src_idx,
   const size_t dst_idx);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const size_t dst_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const size_t dst_idx);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
   const size_t dst_idx);
@@ -183,8 +184,8 @@ calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::PathPoint
   const size_t dst_idx);
 template std::vector<double>
 calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const size_t dst_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const size_t dst_idx);
 template std::vector<double>
 calcSignedArcLengthPartialSum<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -206,8 +207,8 @@ template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::Pat
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points, const size_t src_idx,
   const geometry_msgs::msg::Point & dst_point);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const geometry_msgs::msg::Point & dst_point);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const geometry_msgs::msg::Point & dst_point);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
   const geometry_msgs::msg::Point & dst_point);
@@ -265,8 +266,8 @@ calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::PathPoint>>
   const double offset, const bool throw_exception);
 template std::optional<geometry_msgs::msg::Point>
 calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const double offset, const bool throw_exception);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const double offset, const bool throw_exception);
 template std::optional<geometry_msgs::msg::Point>
 calcLongitudinalOffsetPoint<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
@@ -294,8 +295,8 @@ calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::PathPoint>>(
   const bool throw_exception);
 template std::optional<geometry_msgs::msg::Pose>
 calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const double offset, const bool set_orientation_from_position_direction,
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const double offset, const bool set_orientation_from_position_direction,
   const bool throw_exception);
 template std::optional<geometry_msgs::msg::Pose>
 calcLongitudinalOffsetPose<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
@@ -487,8 +488,8 @@ template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::Pat
   const std::vector<autoware_planning_msgs::msg::PathPoint> & points, const size_t src_idx,
   const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::PathPointWithLaneId>>(
-  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points, const size_t src_idx,
-  const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
+  const std::vector<autoware_planning_msgs::msg::PathPointWithLaneId> & points,
+  const size_t src_idx, const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);
 template double calcSignedArcLength<std::vector<autoware_planning_msgs::msg::TrajectoryPoint>>(
   const std::vector<autoware_planning_msgs::msg::TrajectoryPoint> & points, const size_t src_idx,
   const geometry_msgs::msg::Point & dst_point, const size_t dst_seg_idx);