rename kHungarian to snake_case

Author: takanotaiga

simulation/behavior_tree_plugin/include/behavior_tree_plugin/vehicle/follow_lane_sequence/follow_front_entity_action.hpp

@@ -42,9 +42,9 @@ class FollowFrontEntityAction : public entity_behavior::VehicleActionNode
 
 private:
   std::optional<double> distance_to_front_entity_;
-  static constexpr double kWaypointInterval = 1.0;
-  static constexpr double kFrontEntityMargin = 5.0;
-  static constexpr double kSpeedStep = 2.0;
+  static constexpr double waypoint_interval = 1.0;
+  static constexpr double front_entity_margin = 5.0;
+  static constexpr double speed_step = 2.0;
 };
 }  // namespace follow_lane_sequence
 }  // namespace vehicle

simulation/behavior_tree_plugin/include/behavior_tree_plugin/vehicle/follow_lane_sequence/follow_lane_action.hpp

@@ -43,11 +43,11 @@ class FollowLaneAction : public entity_behavior::VehicleActionNode
 
 private:
   std::optional<traffic_simulator::LaneletPose> target_lanelet_pose_;
-  static constexpr double kWaypointInterval = 1.0;
-  static constexpr double kFrontEntityStopMargin = 5.0;
-  static constexpr double kBoundingBoxHalfFactor = 0.5;
-  static constexpr double kStopLineMargin = 5.0;
-  static constexpr double kConflictingEntityMargin = 3.0;
+  static constexpr double waypoint_interval = 1.0;
+  static constexpr double front_entity_stop_margin = 5.0;
+  static constexpr double bounding_box_half_factor = 0.5;
+  static constexpr double stop_line_margin = 5.0;
+  static constexpr double conflicting_entity_margin = 3.0;
 };
 }  // namespace follow_lane_sequence
 }  // namespace vehicle

simulation/behavior_tree_plugin/include/behavior_tree_plugin/vehicle/follow_lane_sequence/stop_at_stop_line_action.hpp

@@ -43,11 +43,11 @@ class StopAtStopLineAction : public entity_behavior::VehicleActionNode
 
 private:
   std::optional<double> distance_to_stopline_;
-  static constexpr double kWaypointInterval = 1.0;
-  static constexpr double kBoundingBoxHalfFactor = 0.5;
-  static constexpr double kStopMargin = 1.0;
-  static constexpr double kFrontStoplineMargin = 5.0;
-  static constexpr double kVelocityEpsilon = 0.001;
+  static constexpr double waypoint_interval = 1.0;
+  static constexpr double bounding_box_half_factor = 0.5;
+  static constexpr double stop_margin = 1.0;
+  static constexpr double front_stopline_margin = 5.0;
+  static constexpr double velocity_epsilon = 0.001;
 };
 }  // namespace follow_lane_sequence
 }  // namespace vehicle

simulation/behavior_tree_plugin/src/vehicle/follow_lane_sequence/follow_front_entity_action.cpp

@@ -60,7 +60,7 @@ const traffic_simulator_msgs::msg::WaypointsArray FollowFrontEntityAction::calcu
     double horizon = getHorizon();
     const auto lanelet_pose = canonicalized_entity_status_->getLaneletPose();
     waypoints.waypoints = reference_trajectory->getTrajectory(
-      lanelet_pose.s, lanelet_pose.s + horizon, kWaypointInterval, lanelet_pose.offset);
+      lanelet_pose.s, lanelet_pose.s + horizon, waypoint_interval, lanelet_pose.offset);
     trajectory = std::make_unique<math::geometry::CatmullRomSubspline>(
       reference_trajectory, lanelet_pose.s, lanelet_pose.s + horizon);
     return waypoints;
@@ -127,17 +127,17 @@ BT::NodeStatus FollowFrontEntityAction::tick()
   if (
     distance_to_front_entity_.value() >=
     (calculateStopDistance(behavior_parameter_.dynamic_constraints) +
-     vehicle_parameters.bounding_box.dimensions.x + kFrontEntityMargin)) {
+     vehicle_parameters.bounding_box.dimensions.x + front_entity_margin)) {
     setCanonicalizedEntityStatus(
-      calculateUpdatedEntityStatus(front_entity_linear_velocity + kSpeedStep));
+      calculateUpdatedEntityStatus(front_entity_linear_velocity + speed_step));
     setOutput("waypoints", waypoints);
     setOutput("obstacle", calculateObstacle(waypoints));
     return BT::NodeStatus::RUNNING;
   } else if (
     distance_to_front_entity_.value() <=
     calculateStopDistance(behavior_parameter_.dynamic_constraints)) {
     setCanonicalizedEntityStatus(
-      calculateUpdatedEntityStatus(front_entity_linear_velocity - kSpeedStep));
+      calculateUpdatedEntityStatus(front_entity_linear_velocity - speed_step));
     setOutput("waypoints", waypoints);
     setOutput("obstacle", calculateObstacle(waypoints));
     return BT::NodeStatus::RUNNING;

simulation/behavior_tree_plugin/src/vehicle/follow_lane_sequence/follow_lane_action.cpp

@@ -46,7 +46,7 @@ const traffic_simulator_msgs::msg::WaypointsArray FollowLaneAction::calculateWay
     traffic_simulator_msgs::msg::WaypointsArray waypoints;
     const auto lanelet_pose = canonicalized_entity_status_->getLaneletPose();
     waypoints.waypoints = reference_trajectory->getTrajectory(
-      lanelet_pose.s, lanelet_pose.s + getHorizon(), kWaypointInterval, lanelet_pose.offset);
+      lanelet_pose.s, lanelet_pose.s + getHorizon(), waypoint_interval, lanelet_pose.offset);
     trajectory = std::make_unique<math::geometry::CatmullRomSubspline>(
       reference_trajectory, lanelet_pose.s, lanelet_pose.s + getHorizon());
     return waypoints;
@@ -97,7 +97,7 @@ BT::NodeStatus FollowLaneAction::tick()
       if (
         distance_to_front_entity.value() <=
         calculateStopDistance(behavior_parameter_.dynamic_constraints) +
-          vehicle_parameters.bounding_box.dimensions.x + kFrontEntityStopMargin) {
+          vehicle_parameters.bounding_box.dimensions.x + front_entity_stop_margin) {
         return BT::NodeStatus::FAILURE;
       }
     }
@@ -116,14 +116,14 @@ BT::NodeStatus FollowLaneAction::tick()
       if (
         distance_to_stopline.value() <=
         calculateStopDistance(behavior_parameter_.dynamic_constraints) +
-          vehicle_parameters.bounding_box.dimensions.x * kBoundingBoxHalfFactor + kStopLineMargin) {
+          vehicle_parameters.bounding_box.dimensions.x * bounding_box_half_factor + stop_line_margin) {
         return BT::NodeStatus::FAILURE;
       }
     }
     if (distance_to_conflicting_entity) {
       if (
         distance_to_conflicting_entity.value() <
-        (vehicle_parameters.bounding_box.dimensions.x + kConflictingEntityMargin +
+        (vehicle_parameters.bounding_box.dimensions.x + conflicting_entity_margin +
          calculateStopDistance(behavior_parameter_.dynamic_constraints))) {
         return BT::NodeStatus::FAILURE;
       }

simulation/behavior_tree_plugin/src/vehicle/follow_lane_sequence/stop_at_stop_line_action.cpp

@@ -57,7 +57,7 @@ const traffic_simulator_msgs::msg::WaypointsArray StopAtStopLineAction::calculat
     double horizon = getHorizon();
     const auto lanelet_pose = canonicalized_entity_status_->getLaneletPose();
     waypoints.waypoints = reference_trajectory->getTrajectory(
-      lanelet_pose.s, lanelet_pose.s + horizon, kWaypointInterval, lanelet_pose.offset);
+      lanelet_pose.s, lanelet_pose.s + horizon, waypoint_interval, lanelet_pose.offset);
     trajectory = std::make_unique<math::geometry::CatmullRomSubspline>(
       reference_trajectory, lanelet_pose.s, lanelet_pose.s + horizon);
     return waypoints;
@@ -76,7 +76,7 @@ std::optional<double> StopAtStopLineAction::calculateTargetSpeed(double current_
    */
   double rest_distance =
     distance_to_stopline_.value() -
-    (vehicle_parameters.bounding_box.dimensions.x * kBoundingBoxHalfFactor + kStopMargin);
+    (vehicle_parameters.bounding_box.dimensions.x * bounding_box_half_factor + stop_margin);
   if (rest_distance < calculateStopDistance(behavior_parameter_.dynamic_constraints)) {
     return 0;
   }
@@ -125,11 +125,11 @@ BT::NodeStatus StopAtStopLineAction::tick()
     }
   }
 
-  if (std::fabs(canonicalized_entity_status_->getTwist().linear.x) < kVelocityEpsilon) {
+  if (std::fabs(canonicalized_entity_status_->getTwist().linear.x) < velocity_epsilon) {
     if (distance_to_stopline_) {
       if (
         distance_to_stopline_.value() <=
-        vehicle_parameters.bounding_box.dimensions.x + kFrontStoplineMargin) {
+        vehicle_parameters.bounding_box.dimensions.x + front_stopline_margin) {
         if (!target_speed_) {
           target_speed_ = hdmap_utils_->getSpeedLimit(route_lanelets_);
         }