add thread_priority option to the ros2_control_node (#1820) (#1824)

Co-authored-by: Sai Kishor Kothakota <[email protected]>
ros-controls · Oct 31, 2024 · d897740 · d897740
1 parent 1d67297
commit d897740
Show file tree

Hide file tree

Showing 2 changed files with 11 additions and 2 deletions.
diff --git a/controller_manager/src/ros2_control_node.cpp b/controller_manager/src/ros2_control_node.cpp
@@ -45,13 +45,17 @@ int main(int argc, char ** argv)
   auto cm = std::make_shared<controller_manager::ControllerManager>(executor, manager_node_name);
 
   RCLCPP_INFO(cm->get_logger(), "update rate is %d Hz", cm->get_update_rate());
+  const int thread_priority = cm->get_parameter_or<int>("thread_priority", kSchedPriority);
+  RCLCPP_INFO(
+    cm->get_logger(), "Spawning %s RT thread with scheduler priority: %d", cm->get_name(),
+    thread_priority);
 
   std::thread cm_thread(
-    [cm]()
+    [cm, thread_priority]()
     {
       if (realtime_tools::has_realtime_kernel())
       {
-        if (!realtime_tools::configure_sched_fifo(kSchedPriority))
+        if (!realtime_tools::configure_sched_fifo(thread_priority))
         {
           RCLCPP_WARN(
             cm->get_logger(),

diff --git a/doc/release_notes.rst b/doc/release_notes.rst
@@ -12,3 +12,8 @@ controller_interface
 ********************
 
 * The new ``PoseSensor`` semantic component provides a standard interface for hardware providing cartesian poses (`#1775 <https://github.com/ros-controls/ros2_control/pull/1775>`_)
+
+controller_manager
+******************
+
+* The ``ros2_control_node`` node now accepts the ``thread_priority`` parameter to set the scheduler priority of the controller_manager's RT thread (`#1820 <https://github.com/ros-controls/ros2_control/pull/1820>`_).