feat(transition_manager): add param to ignore autonomous transition condition

control/operation_mode_transition_manager/config/operation_mode_transition_manager.param.yaml

@@ -2,6 +2,7 @@
   ros__parameters:
     transition_timeout: 10.0
     frequency_hz: 10.0
+    check_engage_condition: false # set false if you do not want to care about the engage condition.
     engage_acceptable_limits:
       allow_autonomous_in_stopped: true  # no check if the velocity is zero, always allowed.
       dist_threshold: 1.5

control/operation_mode_transition_manager/src/state.cpp

@@ -42,6 +42,8 @@ AutonomousMode::AutonomousMode(rclcpp::Node * node)
   sub_trajectory_ = node->create_subscription<Trajectory>(
     "trajectory", 1, [this](const Trajectory::SharedPtr msg) { trajectory_ = *msg; });
 
+  check_engage_condition_ = node->declare_parameter<bool>("check_engage_condition");
+
   // params for mode change available
   {
     auto & p = engage_acceptable_param_;
@@ -80,6 +82,10 @@ void AutonomousMode::update(bool transition)
 
 bool AutonomousMode::isModeChangeCompleted()
 {
+  if (!check_engage_condition_) {
+    return true;
+  }
+
   constexpr auto dist_max = 5.0;
   constexpr auto yaw_max = M_PI_4;
 
@@ -180,6 +186,11 @@ std::pair<bool, bool> AutonomousMode::hasDangerLateralAcceleration()
 
 bool AutonomousMode::isModeChangeAvailable()
 {
+  if (!check_engage_condition_) {
+    debug_info_.is_all_ok = true;
+    return true;
+  }
+
   constexpr auto dist_max = 100.0;
   constexpr auto yaw_max = M_PI_4;
 

control/operation_mode_transition_manager/src/state.hpp

@@ -72,6 +72,7 @@ class AutonomousMode : public ModeChangeBase
   rclcpp::Logger logger_;
   rclcpp::Clock::SharedPtr clock_;
 
+  bool check_engage_condition_ = true;  // if false, the vehicle is engaged without any checks.
   EngageAcceptableParam engage_acceptable_param_;
   StableCheckParam stable_check_param_;
   AckermannControlCommand control_cmd_;

launch/tier4_control_launch/config/operation_mode_transition_manager/operation_mode_transition_manager.param.yaml

@@ -2,6 +2,7 @@
   ros__parameters:
     transition_timeout: 10.0
     frequency_hz: 10.0
+    check_engage_condition: false # set false if you do not want to care about the engage condition.
     engage_acceptable_limits:
       allow_autonomous_in_stopped: true  # no check if the velocity is zero, always allowed.
       dist_threshold: 1.5