Update spin some to use spin all

Signed-off-by: mini-1235 <[email protected]>

Author: mini-1235

nav2_behavior_tree/plugins/action/controller_selector_node.cpp

@@ -66,7 +66,7 @@ BT::NodeStatus ControllerSelector::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   // This behavior always use the last selected controller received from the topic input.
   // When no input is specified it uses the default controller.

nav2_behavior_tree/plugins/action/goal_checker_selector_node.cpp

@@ -66,7 +66,7 @@ BT::NodeStatus GoalCheckerSelector::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   // This behavior always use the last selected goal checker received from the topic input.
   // When no input is specified it uses the default goal checker.

nav2_behavior_tree/plugins/action/planner_selector_node.cpp

@@ -66,7 +66,7 @@ BT::NodeStatus PlannerSelector::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   // This behavior always use the last selected planner received from the topic input.
   // When no input is specified it uses the default planner.

nav2_behavior_tree/plugins/action/progress_checker_selector_node.cpp

@@ -65,7 +65,7 @@ BT::NodeStatus ProgressCheckerSelector::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   // This behavior always use the last selected progress checker received from the topic input.
   // When no input is specified it uses the default goaprogressl checker.

nav2_behavior_tree/plugins/action/smoother_selector_node.cpp

@@ -67,7 +67,7 @@ BT::NodeStatus SmootherSelector::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   // This behavior always use the last selected smoother received from the topic input.
   // When no input is specified it uses the default smoother.

nav2_behavior_tree/plugins/condition/is_battery_charging_condition.cpp

@@ -62,7 +62,7 @@ BT::NodeStatus IsBatteryChargingCondition::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
   if (is_battery_charging_) {
     return BT::NodeStatus::SUCCESS;
   }

nav2_behavior_tree/plugins/condition/is_battery_low_condition.cpp

@@ -68,7 +68,7 @@ BT::NodeStatus IsBatteryLowCondition::tick()
     initialize();
   }
 
-  callback_group_executor_.spin_some();
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
   if (is_battery_low_) {
     return BT::NodeStatus::SUCCESS;
   }

nav2_behavior_tree/plugins/decorator/goal_updater_node.cpp

@@ -88,9 +88,7 @@ inline BT::NodeStatus GoalUpdater::tick()
   getInput("input_goal", goal);
   getInput("input_goals", goals);
 
-  // Spin multiple times due to rclcpp regression in Jazzy requiring a 'warm up' spin
-  callback_group_executor_.spin_all(std::chrono::milliseconds(1));
-  callback_group_executor_.spin_all(std::chrono::milliseconds(49));
+  callback_group_executor_.spin_all(std::chrono::milliseconds(50));
 
   if (last_goal_received_set_) {
     if (last_goal_received_.header.stamp == rclcpp::Time(0)) {

nav2_route/test/test_graph_loader.cpp

@@ -107,7 +107,6 @@ TEST(GraphLoader, test_transformation_api)
   tf_broadcaster->sendTransform(transform);
   rclcpp::Rate(1).sleep();
   tf_broadcaster->sendTransform(transform);
-  rclcpp::spin_all(node->get_node_base_interface(), std::chrono::milliseconds(1));
   rclcpp::spin_all(node->get_node_base_interface(), std::chrono::milliseconds(50));
 
   graph[0].coords.frame_id = "map_test";

nav2_route/test/test_graph_saver.cpp

@@ -143,7 +143,6 @@ TEST(GraphSaver, test_transformation_api)
   tf_broadcaster->sendTransform(transform);
   rclcpp::Rate(1).sleep();
   tf_broadcaster->sendTransform(transform);
-  rclcpp::spin_all(node->get_node_base_interface(), std::chrono::milliseconds(1));
   rclcpp::spin_all(node->get_node_base_interface(), std::chrono::milliseconds(50));
 
   GraphSaver graph_saver(node, tf, frame);