Wait longer for controllers to load and activate

(cherry picked from commit cef5f3c)

Author: RobertWilbrandt

ur_robot_driver/test/robot_driver.py

@@ -151,10 +151,14 @@ def tearDownClass(cls):
 
     def init_robot(self):
 
-        # Wait longer for the first service clients (for both the driver and the dashboard client) as the robot driver is still starting up
+        # Wait longer for the first service clients:
+        #  - The robot has to start up
+        #  - The controller_manager has to start
+        #  - The controllers need to load and activate
         service_interfaces_initial = {
             "/dashboard_client/power_on": Trigger,
             "/controller_manager/switch_controller": SwitchController,
+            "/io_and_status_controller/set_io": SetIO,
         }
         self.service_clients = {
             srv_name: waitForService(
@@ -169,7 +173,6 @@ def init_robot(self):
             "/dashboard_client/stop": Trigger,
             "/dashboard_client/get_robot_mode": GetRobotMode,
             "/controller_manager/switch_controller": SwitchController,
-            "/io_and_status_controller/set_io": SetIO,
             "/io_and_status_controller/resend_robot_program": Trigger,
         }
         self.service_clients.update(