Universal_Robots_ROS2_Driver icon indicating copy to clipboard operation
Universal_Robots_ROS2_Driver copied to clipboard
verified publisher icon UniversalRobots

Movement overshoot with UR20 and ROS2-humble

Open leander2189 opened this issue 4 months ago • 14 comments

Affected ROS2 Driver version(s)

2.8.1-1jammy.20250915.231359

Used ROS distribution.

Humble

Which combination of platform is the ROS driver running on.

Docker

How is the UR ROS2 Driver installed.

From binary packets

Which robot platform is the driver connected to.

UR E-series robot

Robot SW / URSim version(s)

5.17.3

How is the ROS driver used.

Through the robot teach pendant using External Control URCap

Issue details

Summary

When doing long movements, the UR overshoots the final position and then corrects it back. This entails a serious risk for collisions.

https://github.com/user-attachments/assets/ce9e8457-a9ea-4edd-bc1d-8b5c2522ccb6

Issue details

We are running the software stack within a docker container, in a Ubuntu 22.04 with realtime kernel installed.

uname -a
Linux rout0-240626aa 5.15.0-1032-realtime #35-Ubuntu SMP PREEMPT_RT Tue Jan 24 11:45:03 UTC 2023 x86_64 x86_64 x86_64 GNU/Linux

I am not 100% sure whether the code inside the docker is using the realtime feature but it's not complaining in the launch (it did before the realtime kernel was installed)

We are controlling the UR20 using external control URCap, generating the motion plan using MoveIt and MTC. It looks like the controller detects that the UR has reached the position and returns (process keeps going on, see the light turning on in the video), but the robot is actually moving a little further and then it corrects back.

We are using a copy of ur_control.launch.py, running the ur_ros2_control node and the scaled_joint_trajectory_controller. These are the settings we have:

update_rate.yaml

controller_manager:
  ros__parameters:
    update_rate: 500  # Hz

ros2_control_configuration.yaml

scaled_joint_trajectory_controller:
  ros__parameters:
    joints:
      - ur_shoulder_pan_joint
      - ur_shoulder_lift_joint
      - ur_elbow_joint
      - ur_wrist_1_joint
      - ur_wrist_2_joint
      - ur_wrist_3_joint
    command_interfaces:
      - position
    state_interfaces:
      - position
      - velocity
    state_publish_rate: 200.0
    action_monitor_rate: 100.0
    allow_partial_joints_goal: false
    constraints:
      stopped_velocity_tolerance: 0.2
      goal_time: 0.0
      ur_shoulder_pan_joint: { trajectory: 0.05, goal: 0.03 }
      ur_shoulder_lift_joint: { trajectory: 0.05, goal: 0.03 }
      ur_elbow_joint: { trajectory: 0.05, goal: 0.03 }
      ur_wrist_1_joint: { trajectory: 0.05, goal: 0.03 }
      ur_wrist_2_joint: { trajectory: 0.05, goal: 0.03 }
      ur_wrist_3_joint: { trajectory: 0.05, goal: 0.03 }
    speed_scaling_interface_name: ur_speed_scaling/speed_scaling_factor

Expected Behavior

The robot should follow accurately the planned trajectory

Relevant log output

Accept Public visibility

  • [x] I agree to make this context public

leander2189 avatar Oct 14 '25 15:10 leander2189

Probably related to this behaviour, the robot is not even following the commanded trajectory:

https://github.com/user-attachments/assets/28af3d75-6446-4ae8-b7eb-377997622f1e

In the video, the robot has been stopped (through the E-Stop) in the middle of a motion, right before a collision. The planned motion is shown too. It can be seen that the actual position of the UR is not even close to any point of the sent trajectory.

Configuration is the same as in the initial post

leander2189 avatar Oct 15 '25 11:10 leander2189

To comment on that I would need the trajectory that is sent to the robot. I know that this is a little hard to do on Humble, as actions aren't observable and the trajectory is coming from MoveIt.

You could try switching to the passthrough trajectory controller to further debug this. For this, modify the moveit controllers file to contain it:

# MoveIt uses this configuration for controller management
moveit_controller_manager: moveit_simple_controller_manager/MoveItSimpleControllerManager

trajectory_execution:
  allowed_execution_duration_scaling: 1.2
  allowed_goal_duration_margin: 0.5
  allowed_start_tolerance: 0.01
  execution_duration_monitoring: false # May lead to unexpectedly aborted goals with scaled JTC

moveit_simple_controller_manager:
  controller_names:
    - scaled_joint_trajectory_controller
    - joint_trajectory_controller
    - passthrough_trajectory_controller

  scaled_joint_trajectory_controller:
    action_ns: follow_joint_trajectory
    type: FollowJointTrajectory
    default: false
    joints:
      - shoulder_pan_joint
      - shoulder_lift_joint
      - elbow_joint
      - wrist_1_joint
      - wrist_2_joint
      - wrist_3_joint


  joint_trajectory_controller:
    action_ns: follow_joint_trajectory
    type: FollowJointTrajectory
    default: false
    joints:
      - shoulder_pan_joint
      - shoulder_lift_joint
      - elbow_joint
      - wrist_1_joint
      - wrist_2_joint
      - wrist_3_joint

  passthrough_trajectory_controller:
    action_ns: follow_joint_trajectory
    type: FollowJointTrajectory
    default: true
    joints:
      - shoulder_pan_joint
      - shoulder_lift_joint
      - elbow_joint
      - wrist_1_joint
      - wrist_2_joint
      - wrist_3_joint

and start the driver with the initial_joint_controller:=passthrough_trajectory_controller command.

I would expect the same behavior as with the scaled JTC, but you can observe the setpoints for the trajectory in the robot's log. Could you then download the support file from the robot and post the log_history.txt from that?

urfeex avatar Oct 15 '25 11:10 urfeex

I haven't been able to get the trajectory data and robot logs, but I think I know when it's happening:

Turns out that if the Tool Speed set in the Robot safety is lower that the settings in MoveIt (which by the way can be only defined as Joint speed), it's when we see this issue.

leander2189 avatar Oct 16 '25 07:10 leander2189

Hm, from my understanding that should result in a trajectory slowdown, but not a deviation or even an overshoot. That is exactly why we have added speed scaling to the JTC.

You could also record the controller's state topic by

ros2 topic echo /scaled_joint_trajectory_controller/controller_state  > controller_state.txt

or you record a rosbag with that topic and preferably /speed_scaling_state_broadcaster/speed_scaling

urfeex avatar Oct 16 '25 08:10 urfeex

We were monitoring the /scaled_joint_trajectory_controller/controller_state topic, and noticed that at a certain point in the trajectory, the msg.reference values jump directly to the final goal positions instead of continuing the smooth interpolation. As shown in the attached image, all joints reference positions (red lines) suddenly move to the goal pose, while the feedback positions (blue lines) lag and then rush to catch up. At this point, the robot cannot follow the trajectory anymore and simply moves all joints to the final configuration:

Image

Is this due to some short of timeout? We had try to set: First config of: ros2_control_configuration.yaml:

scaled_joint_trajectory_controller:
  ros__parameters:
    joints:
      - ur_shoulder_pan_joint
      - ur_shoulder_lift_joint
      - ur_elbow_joint
      - ur_wrist_1_joint
      - ur_wrist_2_joint
      - ur_wrist_3_joint
    command_interfaces:
      - position
    state_interfaces:
      - position
      - velocity
    state_publish_rate: 100.0
    action_monitor_rate: 20.0
    allow_partial_joints_goal: false
    constraints:
      stopped_velocity_tolerance: 0.2
      goal_time: 0.0
      ur_shoulder_pan_joint: { trajectory: 0.2, goal: 0.1 }
      ur_shoulder_lift_joint: { trajectory: 0.2, goal: 0.1 }
      ur_elbow_joint: { trajectory: 0.2, goal: 0.1 }
      ur_wrist_1_joint: { trajectory: 0.2, goal: 0.1 }
      ur_wrist_2_joint: { trajectory: 0.2, goal: 0.1 }
      ur_wrist_3_joint: { trajectory: 0.2, goal: 0.1 }
    speed_scaling_interface_name: ur_speed_scaling/speed_scaling_factor

Second config of ros2_control_configuration.yaml, updating:

goal_time: 30.0
goal_time_tolerance: 30.0

We also have these options setted in the MoveGroup configuration:

trajectory_execution = {
        "allow_trajectory_execution": True,
        "moveit_manage_controllers": True,
        "trajectory_execution.allowed_execution_duration_scaling": 1.0,
        "trajectory_execution.allowed_goal_duration_margin": 10.0,
        "trajectory_execution.allowed_start_tolerance": 0.03,
        "trajectory_execution.trajectory_duration_monitoring": False,
        "trajectory_execution.execution_duration_monitoring": False
    }

And nothing seems to fix the issue.

GinesLopezz avatar Oct 21 '25 16:10 GinesLopezz

We keep debugging this.

The cause of the error is setting a slow TCP Speed in the UR Safety configuration (we set it to 250mm/s). With this configuration, MoveIt is creating trajectories that are faster than this speed, so the robot can't follow and at some point a timeout is thrown and the behaviour that my colleague showed appears.

Setting a TCP speed much higher we don't find this issue, even if we change the % of feedrate speed

leander2189 avatar Oct 22 '25 14:10 leander2189

Thank you for your continued feedback. I can reproduce this with a slow TCP speed safety setting. I'll need to look into what's happening there.

However, in my case the external_control's safety mechanism kicks in and stops the robot, creating a popup saying that the commanded velocity was too high (resulting from the growing error). Is your software (particularly the ur_client_library) up-to-date?

urfeex avatar Oct 22 '25 14:10 urfeex

May I though suggest that as a workaround you can use the passthrough_trajectory_controller. I couldn't reproduce the issue with that. It uses the same trajectory interpolation method as the scaled JTC, so MoveIt's collision checks do apply.

urfeex avatar Oct 22 '25 15:10 urfeex

Hi again, sorry for the delay. We tried using the passthrough_trajectory_controller, but it did not work. Is it possible that this controller is not available for ROS2 Humble?

leander2189 avatar Nov 19 '25 06:11 leander2189

but it did not work

What does that mean exactly? I've tested things on Humble as explained in https://github.com/UniversalRobots/Universal_Robots_ROS2_Driver/issues/1537#issuecomment-3405917348

urfeex avatar Nov 19 '25 11:11 urfeex

I'm trying to run the stack using the passthrough trajectory controller. However, I'm facing some issues: the goal is accepted by the controller but the UR does not move. In the logs I'm able to check the controller is accepting the trajectory:

[passthrough_trajectory_controller]: Received new trajectory. (goal_received_callback() at ./src/passthrough_trajectory_controller.cpp:372)
[passthrough_trajectory_controller.rclcpp_action]: Accepted goal 31734dc458c6168cef856e5793f292 (execute_goal_request_received() at ./src/server.cpp:443)
[passthrough_trajectory_controller]: Accepted new trajectory with 481 points. (goal_accepted_callback() at ./src/passthrough_trajectory_controller.cpp:530)
[passthrough_trajectory_controller]: Goal time tolerance: 0 sec (goal_accepted_callback() at ./src/passthrough_trajectory_controller.cpp:558)
[URPositionHardwareInterface]: Got a new trajectory with 481 points. (check_passthrough_trajectory_controller() at ./src/hardware_interface.cpp:1466)

The one thing that seems weird from the above logs is this line:

[passthrough_trajectory_controller]: Goal time tolerance: 0 sec

Nevertheless, the ros2 param does match the value I set in the .yaml file:

ros2 param get /passthrough_trajectory_controller constraints.goal_time_tolerance 
Double value is: 60.0

Apart from that, the controller seems to be correctly active:

[ur_ros2_control_node-34] [DEBUG 1763639959.609550154] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'io_and_status_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609579478] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'speed_scaling_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609596644] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'passthrough_trajectory_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609629706] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'forward_position_controller_zstage ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609678860] [controller_manager]: update_loop_counter: '394 ' controller_go: 'True ' controller_name: 'joint_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)

Also in rqt_controller_manager:

Image Image

As long as I'm aware of, I have configured the controller as explained in https://github.com/UniversalRobots/Universal_Robots_ROS2_Driver/issues/1537#issuecomment-3405917348

In the controllers.yaml:

controller_names:
  - passthrough_trajectory_controller

passthrough_trajectory_controller:
  action_ns: follow_joint_trajectory
  type: FollowJointTrajectory
  default: true
  joints:
    - ur_shoulder_pan_joint
    - ur_shoulder_lift_joint
    - ur_elbow_joint
    - ur_wrist_1_joint
    - ur_wrist_2_joint
    - ur_wrist_3_joint

and also in the ROS2 control config:

passthrough_trajectory_controller:
  ros__parameters:
    joints:
      - ur_shoulder_pan_joint
      - ur_shoulder_lift_joint
      - ur_elbow_joint
      - ur_wrist_1_joint
      - ur_wrist_2_joint
      - ur_wrist_3_joint
    # command_interfaces:  # I tried both, with and without this with the same result
    #   - position
    #   - velocity
    state_interfaces:
      - position
      - velocity
    speed_scaling_interface_name: ur_speed_scaling/speed_scaling_factor
    tf_prefix: "ur_"
    # Adding goal tolerance configuration
    constraints:
      stopped_velocity_tolerance: 0.05
      goal_time: 60.0        
      goal_time_tolerance: 60.0
    allow_partial_joints_goal: false
    action_monitor_rate: 20.0

I'm setting passthrough_trajectory_controller as initial_joint_controller as well.

I've also checked that the external control program is running while trying to move the UR. Am I missing something??

I'm adding here logs from where i extracted the ones sent above.

[ur_ros2_control_node-34] [INFO 1763639959.606066601] [passthrough_trajectory_controller]: Received new trajectory. (goal_received_callback() at ./src/passthrough_trajectory_controller.cpp:372)
[ur_ros2_control_node-34] [DEBUG 1763639959.606100019] [rcl]: Sending service response (rcl_send_response() at ./src/rcl/service.c:303)
[ur_ros2_control_node-34] [DEBUG 1763639959.606158509] [passthrough_trajectory_controller.rclcpp_action]: Accepted goal 31734dc458c6168cef856e5793f292 (execute_goal_request_received() at ./src/server.cpp:443)
[ur_ros2_control_node-34] [INFO 1763639959.606204701] [passthrough_trajectory_controller]: Accepted new trajectory with 481 points. (goal_accepted_callback() at ./src/passthrough_trajectory_controller.cpp:530)
[ur_ros2_control_node-34] [INFO 1763639959.606224691] [passthrough_trajectory_controller]: Goal time tolerance: 0 sec (goal_accepted_callback() at ./src/passthrough_trajectory_controller.cpp:558)
[ur_ros2_control_node-34] [DEBUG 1763639959.606236683] [rcl]: Initializing timer with period: 50000000ns (rcl_timer_init() at ./src/rcl/timer.c:142)
[ur_ros2_control_node-34] [DEBUG 1763639959.606255831] [controller_manager]: update_loop_counter: '392 ' controller_go: 'True ' controller_name: 'joint_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.606291399] [joint_state_broadcaster]: ur_shoulder_pan_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606314871] [joint_state_broadcaster]: ur_shoulder_pan_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606329006] [joint_state_broadcaster]: ur_shoulder_pan_joint/effort: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606342684] [joint_state_broadcaster]: ur_shoulder_lift_joint/position: -1.500000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606355070] [joint_state_broadcaster]: ur_shoulder_lift_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606367173] [joint_state_broadcaster]: ur_shoulder_lift_joint/effort: 3.910857
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606378807] [joint_state_broadcaster]: ur_elbow_joint/position: -1.220000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606389824] [joint_state_broadcaster]: ur_elbow_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606401206] [joint_state_broadcaster]: ur_elbow_joint/effort: 6.790654
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606412158] [joint_state_broadcaster]: ur_wrist_1_joint/position: -1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606422828] [joint_state_broadcaster]: ur_wrist_1_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606434206] [joint_state_broadcaster]: ur_wrist_1_joint/effort: 0.448670
[ur_ros2_control_node-34]  (update() at ./shttps://github.com/UniversalRobots/Universal_Robots_ROS2_Driver/issues/1537#issuecomment-3405917348rc/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606445912] [joint_state_broadcaster]: ur_wrist_2_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606445870] [rcl]: Service server taking service request (rcl_take_request_with_info() at ./src/rcl/service.c:256)
[ur_ros2_control_node-34] [DEBUG 1763639959.606468250] [rcl]: Service take request succeeded: true (rcl_take_request_with_info() at ./src/rcl/service.c:275)
[ur_ros2_control_node-34] [DEBUG 1763639959.606458104] [joint_state_broadcaster]: ur_wrist_2_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606505525] [joint_state_broadcaster]: ur_wrist_2_joint/effort: -0.138640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606520240] [joint_state_broadcaster]: ur_wrist_3_joint/position: -1.570800
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606533826] [joint_state_broadcaster]: ur_wrist_3_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606547670] [joint_state_broadcaster]: ur_wrist_3_joint/effort: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606561218] [joint_state_broadcaster]: ur_speed_scaling/speed_scaling_factor: 0.966453
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606575449] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.x: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606588663] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.y: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606601800] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.z: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606619343] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.x: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606632648] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.y: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606645312] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.z: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606658590] [joint_state_broadcaster]: ur_gpio/digital_output_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606671860] [joint_state_broadcaster]: ur_gpio/digital_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606685372] [joint_state_broadcaster]: ur_gpio/digital_output_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606698769] [joint_state_broadcaster]: ur_gpio/digital_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606712755] [joint_state_broadcaster]: ur_gpio/digital_output_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606726350] [joint_state_broadcaster]: ur_gpio/digital_input_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606740042] [joint_state_broadcaster]: ur_gpio/digital_output_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606753563] [joint_state_broadcaster]: ur_gpio/digital_input_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606767699] [joint_state_broadcaster]: ur_gpio/digital_output_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606781706] [joint_state_broadcaster]: ur_gpio/digital_input_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606808722] [joint_state_broadcaster]: ur_gpio/digital_output_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606822914] [joint_state_broadcaster]: ur_gpio/digital_input_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606836975] [joint_state_broadcaster]: ur_gpio/digital_output_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606850517] [joint_state_broadcaster]: ur_gpio/digital_input_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606865034] [joint_state_broadcaster]: ur_gpio/digital_output_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606878702] [joint_state_broadcaster]: ur_gpio/digital_input_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606892216] [joint_state_broadcaster]: ur_gpio/digital_output_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606924556] [joint_state_broadcaster]: ur_gpio/digital_input_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606940975] [joint_state_broadcaster]: ur_gpio/digital_output_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606954482] [joint_state_broadcaster]: ur_gpio/digital_input_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606967959] [joint_state_broadcaster]: ur_gpio/digital_output_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606981532] [joint_state_broadcaster]: ur_gpio/digital_input_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.606994818] [joint_state_broadcaster]: ur_gpio/digital_output_11: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607010251] [joint_state_broadcaster]: ur_gpio/digital_input_11: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607023949] [joint_state_broadcaster]: ur_gpio/digital_output_12: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607037631] [joint_state_broadcaster]: ur_gpio/digital_input_12: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607051014] [joint_state_broadcaster]: ur_gpio/digital_output_13: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607063983] [joint_state_broadcaster]: ur_gpio/digital_input_13: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607076941] [joint_state_broadcaster]: ur_gpio/digital_output_14: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607090226] [joint_state_broadcaster]: ur_gpio/digital_input_14: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607103634] [joint_state_broadcaster]: ur_gpio/digital_output_15: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607116759] [joint_state_broadcaster]: ur_gpio/digital_input_15: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607129522] [joint_state_broadcaster]: ur_gpio/digital_output_16: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607142542] [joint_state_broadcaster]: ur_gpio/digital_input_16: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607155482] [joint_state_broadcaster]: ur_gpio/digital_output_17: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607168759] [joint_state_broadcaster]: ur_gpio/digital_input_17: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607181496] [joint_state_broadcaster]: ur_gpio/safety_status_bit_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607194416] [joint_state_broadcaster]: ur_gpio/safety_status_bit_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607207180] [joint_state_broadcaster]: ur_gpio/safety_status_bit_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607220107] [joint_state_broadcaster]: ur_gpio/safety_status_bit_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607233212] [joint_state_broadcaster]: ur_gpio/safety_status_bit_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607246571] [joint_state_broadcaster]: ur_gpio/safety_status_bit_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607259541] [joint_state_broadcaster]: ur_gpio/safety_status_bit_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607272326] [joint_state_broadcaster]: ur_gpio/safety_status_bit_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607285055] [joint_state_broadcaster]: ur_gpio/safety_status_bit_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607304394] [joint_state_broadcaster]: ur_gpio/safety_status_bit_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607319123] [joint_state_broadcaster]: ur_gpio/safety_status_bit_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607332319] [joint_state_broadcaster]: ur_gpio/analog_io_type_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607345746] [joint_state_broadcaster]: ur_gpio/robot_status_bit_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607359085] [joint_state_broadcaster]: ur_gpio/analog_io_type_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607373944] [joint_state_broadcaster]: ur_gpio/robot_status_bit_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607387594] [joint_state_broadcaster]: ur_gpio/analog_io_type_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607400963] [joint_state_broadcaster]: ur_gpio/robot_status_bit_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607414922] [joint_state_broadcaster]: ur_gpio/analog_io_type_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607432206] [joint_state_broadcaster]: ur_gpio/robot_status_bit_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607444786] [joint_state_broadcaster]: ur_gpio/tool_analog_input_type_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607457711] [joint_state_broadcaster]: ur_gpio/tool_analog_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607470051] [joint_state_broadcaster]: ur_gpio/standard_analog_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607482422] [joint_state_broadcaster]: ur_gpio/standard_analog_output_0: 0.004000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607495845] [joint_state_broadcaster]: ur_gpio/tool_analog_input_type_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607512801] [joint_state_broadcaster]: ur_gpio/tool_analog_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607525940] [joint_state_broadcaster]: ur_gpio/standard_analog_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607538901] [joint_state_broadcaster]: ur_gpio/standard_analog_output_1: 0.004000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607552571] [joint_state_broadcaster]: ur_gpio/tool_output_voltage: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607566001] [joint_state_broadcaster]: ur_gpio/robot_mode: 7.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607579379] [joint_state_broadcaster]: ur_gpio/safety_mode: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607592444] [joint_state_broadcaster]: ur_gpio/tool_mode: 253.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607606842] [joint_state_broadcaster]: ur_gpio/tool_output_current: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607620252] [joint_state_broadcaster]: ur_gpio/tool_temperature: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607633429] [joint_state_broadcaster]: ur_system_interface/initialized: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607646578] [joint_state_broadcaster]: ur_gpio/program_running: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607659968] [joint_state_broadcaster]: ur_tcp_pose/position.x: 0.691006
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607673808] [joint_state_broadcaster]: ur_tcp_pose/position.y: -0.355300
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607692214] [joint_state_broadcaster]: ur_tcp_pose/position.z: 1.527722
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607706440] [joint_state_broadcaster]: ur_tcp_pose/orientation.x: 0.621831
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607719779] [joint_state_broadcaster]: ur_tcp_pose/orientation.y: -0.336640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607734411] [joint_state_broadcaster]: ur_tcp_pose/orientation.z: 0.336640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607747324] [joint_state_broadcaster]: ur_tcp_pose/orientation.w: 0.621831
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607760370] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_major: 5.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607774605] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_minor: 22.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607794658] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_bugfix: 2.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607808256] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_build: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607821251] [joint_state_broadcaster]: ur_tool_contact/tool_contact_result: nan
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607833711] [joint_state_broadcaster]: ur_tool_contact/tool_contact_state: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607846842] [joint_state_broadcaster]: ewellix_lift_top_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.607891317] [controller_manager]: update_loop_counter: '392 ' controller_go: 'True ' controller_name: 'io_and_status_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.607934654] [controller_manager]: update_loop_counter: '392 ' controller_go: 'True ' controller_name: 'speed_scaling_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.607958829] [controller_manager]: update_loop_counter: '392 ' controller_go: 'True ' controller_name: 'passthrough_trajectory_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.608107912] [controller_manager]: update_loop_counter: '392 ' controller_go: 'True ' controller_name: 'forward_position_controller_zstage ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [INFO 1763639959.608170091] [URPositionHardwareInterface]: Got a new trajectory with 481 points. (check_passthrough_trajectory_controller() at ./src/hardware_interface.cpp:1466)
[ur_ros2_control_node-34] [DEBUG 1763639959.608240966] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'joint_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.608263329] [joint_state_broadcaster]: ur_shoulder_pan_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608280388] [joint_state_broadcaster]: ur_shoulder_pan_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608294262] [joint_state_broadcaster]: ur_shoulder_pan_joint/effort: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608308224] [joint_state_broadcaster]: ur_shoulder_lift_joint/position: -1.500000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608321863] [joint_state_broadcaster]: ur_shoulder_lift_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608334670] [joint_state_broadcaster]: ur_shoulder_lift_joint/effort: 3.910857
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608347526] [joint_state_broadcaster]: ur_elbow_joint/position: -1.220000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608375854] [joint_state_broadcaster]: ur_elbow_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608391310] [joint_state_broadcaster]: ur_elbow_joint/effort: 6.790654
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608404441] [joint_state_broadcaster]: ur_wrist_1_joint/position: -1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608417256] [joint_state_broadcaster]: ur_wrist_1_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608430007] [joint_state_broadcaster]: ur_wrist_1_joint/effort: 0.448670
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608445856] [joint_state_broadcaster]: ur_wrist_2_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608456015] [joint_state_broadcaster]: ur_wrist_2_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608466478] [joint_state_broadcaster]: ur_wrist_2_joint/effort: -0.138640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608477414] [joint_state_broadcaster]: ur_wrist_3_joint/position: -1.570800
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608488194] [joint_state_broadcaster]: ur_wrist_3_joint/velocity: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608499367] [joint_state_broadcaster]: ur_wrist_3_joint/effort: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608510504] [joint_state_broadcaster]: ur_speed_scaling/speed_scaling_factor: 0.966602
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608521326] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.x: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608531398] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.y: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608541557] [joint_state_broadcaster]: ur_tcp_fts_sensor/force.z: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608551425] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.x: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608563157] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.y: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608573362] [joint_state_broadcaster]: ur_tcp_fts_sensor/torque.z: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608583428] [joint_state_broadcaster]: ur_gpio/digital_output_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608594170] [joint_state_broadcaster]: ur_gpio/digital_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608604627] [joint_state_broadcaster]: ur_gpio/digital_output_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608614950] [joint_state_broadcaster]: ur_gpio/digital_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608625025] [joint_state_broadcaster]: ur_gpio/digital_output_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608635056] [joint_state_broadcaster]: ur_gpio/digital_input_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608644947] [joint_state_broadcaster]: ur_gpio/digital_output_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608655332] [joint_state_broadcaster]: ur_gpio/digital_input_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608665585] [joint_state_broadcaster]: ur_gpio/digital_output_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608675672] [joint_state_broadcaster]: ur_gpio/digital_input_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608690498] [joint_state_broadcaster]: ur_gpio/digital_output_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608702081] [joint_state_broadcaster]: ur_gpio/digital_input_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608712554] [joint_state_broadcaster]: ur_gpio/digital_output_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608722838] [joint_state_broadcaster]: ur_gpio/digital_input_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608733212] [joint_state_broadcaster]: ur_gpio/digital_output_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608743384] [joint_state_broadcaster]: ur_gpio/digital_input_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608753237] [joint_state_broadcaster]: ur_gpio/digital_output_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608763190] [joint_state_broadcaster]: ur_gpio/digital_input_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608773068] [joint_state_broadcaster]: ur_gpio/digital_output_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608783062] [joint_state_broadcaster]: ur_gpio/digital_input_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608800713] [joint_state_broadcaster]: ur_gpio/digital_output_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608811157] [joint_state_broadcaster]: ur_gpio/digital_input_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608821363] [joint_state_broadcaster]: ur_gpio/digital_output_11: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608831883] [joint_state_broadcaster]: ur_gpio/digital_input_11: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608843307] [joint_state_broadcaster]: ur_gpio/digital_output_12: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608853767] [joint_state_broadcaster]: ur_gpio/digital_input_12: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608863868] [joint_state_broadcaster]: ur_gpio/digital_output_13: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608874118] [joint_state_broadcaster]: ur_gpio/digital_input_13: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608884182] [joint_state_broadcaster]: ur_gpio/digital_output_14: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608894318] [joint_state_broadcaster]: ur_gpio/digital_input_14: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608904471] [joint_state_broadcaster]: ur_gpio/digital_output_15: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608914624] [joint_state_broadcaster]: ur_gpio/digital_input_15: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608924747] [joint_state_broadcaster]: ur_gpio/digital_output_16: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608934918] [joint_state_broadcaster]: ur_gpio/digital_input_16: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608945105] [joint_state_broadcaster]: ur_gpio/digital_output_17: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608955387] [joint_state_broadcaster]: ur_gpio/digital_input_17: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608965643] [joint_state_broadcaster]: ur_gpio/safety_status_bit_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608976143] [joint_state_broadcaster]: ur_gpio/safety_status_bit_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.608986598] [joint_state_broadcaster]: ur_gpio/safety_status_bit_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609003159] [joint_state_broadcaster]: ur_gpio/safety_status_bit_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609014440] [joint_state_broadcaster]: ur_gpio/safety_status_bit_4: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609024826] [joint_state_broadcaster]: ur_gpio/safety_status_bit_5: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609034998] [joint_state_broadcaster]: ur_gpio/safety_status_bit_6: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609045117] [joint_state_broadcaster]: ur_gpio/safety_status_bit_7: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609055316] [joint_state_broadcaster]: ur_gpio/safety_status_bit_8: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609065582] [joint_state_broadcaster]: ur_gpio/safety_status_bit_9: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609075637] [joint_state_broadcaster]: ur_gpio/safety_status_bit_10: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609085839] [joint_state_broadcaster]: ur_gpio/analog_io_type_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609095855] [joint_state_broadcaster]: ur_gpio/robot_status_bit_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609105986] [joint_state_broadcaster]: ur_gpio/analog_io_type_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609116113] [joint_state_broadcaster]: ur_gpio/robot_status_bit_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609130858] [joint_state_broadcaster]: ur_gpio/analog_io_type_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609140356] [joint_state_broadcaster]: ur_gpio/robot_status_bit_2: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609149897] [joint_state_broadcaster]: ur_gpio/analog_io_type_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609159543] [joint_state_broadcaster]: ur_gpio/robot_status_bit_3: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609169284] [joint_state_broadcaster]: ur_gpio/tool_analog_input_type_0: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609179113] [joint_state_broadcaster]: ur_gpio/tool_analog_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609188554] [joint_state_broadcaster]: ur_gpio/standard_analog_input_0: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609198272] [joint_state_broadcaster]: ur_gpio/standard_analog_output_0: 0.004000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609208503] [joint_state_broadcaster]: ur_gpio/tool_analog_input_type_1: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609218664] [joint_state_broadcaster]: ur_gpio/tool_analog_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609236501] [joint_state_broadcaster]: ur_gpio/standard_analog_input_1: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609246716] [joint_state_broadcaster]: ur_gpio/standard_analog_output_1: 0.004000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609257181] [joint_state_broadcaster]: ur_gpio/tool_output_voltage: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609267253] [joint_state_broadcaster]: ur_gpio/robot_mode: 7.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609277727] [joint_state_broadcaster]: ur_gpio/safety_mode: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609288036] [joint_state_broadcaster]: ur_gpio/tool_mode: 253.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609311679] [joint_state_broadcaster]: ur_gpio/tool_output_current: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609323242] [joint_state_broadcaster]: ur_gpio/tool_temperature: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609333579] [joint_state_broadcaster]: ur_system_interface/initialized: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609344227] [joint_state_broadcaster]: ur_gpio/program_running: 1.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609355927] [joint_state_broadcaster]: ur_tcp_pose/position.x: 0.691006
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609368799] [joint_state_broadcaster]: ur_tcp_pose/position.y: -0.355300
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609381115] [joint_state_broadcaster]: ur_tcp_pose/position.z: 1.527722
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609393595] [joint_state_broadcaster]: ur_tcp_pose/orientation.x: 0.621831
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609406763] [joint_state_broadcaster]: ur_tcp_pose/orientation.y: -0.336640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609419783] [joint_state_broadcaster]: ur_tcp_pose/orientation.z: 0.336640
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609434330] [joint_state_broadcaster]: ur_tcp_pose/orientation.w: 0.621831
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609447488] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_major: 5.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609460836] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_minor: 22.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609472156] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_bugfix: 2.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609483158] [joint_state_broadcaster]: ur_get_robot_software_version/get_version_build: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609494493] [joint_state_broadcaster]: ur_tool_contact/tool_contact_result: nan
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609505397] [joint_state_broadcaster]: ur_tool_contact/tool_contact_state: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609516823] [joint_state_broadcaster]: ewellix_lift_top_joint/position: 0.000000
[ur_ros2_control_node-34]  (update() at ./src/joint_state_broadcaster.cpp:351)
[ur_ros2_control_node-34] [DEBUG 1763639959.609550154] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'io_and_status_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609579478] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'speed_scaling_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609596644] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'passthrough_trajectory_controller ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609629706] [controller_manager]: update_loop_counter: '393 ' controller_go: 'True ' controller_name: 'forward_position_controller_zstage ' (update() at ./src/controller_manager.cpp:2182)
[ur_ros2_control_node-34] [DEBUG 1763639959.609678860] [controller_manager]: update_loop_counter: '394 ' controller_go: 'True ' controller_name: 'joint_state_broadcaster ' (update() at ./src/controller_manager.cpp:2182)

mjimenezm00 avatar Nov 20 '25 12:11 mjimenezm00

OK, from a ROS standpoint everything seems fine. Does the teach pendant say anything? The log section should look something like this:

Image

urfeex avatar Nov 21 '25 07:11 urfeex

Those logs you mention do not appear in mine.

Image Image

These are the versions I'm using:

Image

mjimenezm00 avatar Nov 24 '25 06:11 mjimenezm00

Those logs you mention do not appear in mine.

Image Image These are the versions I'm using:

Image

Update When running ur_ros2_control_node with debug log level, I'm able to see these timeout logs:

Image

mjimenezm00 avatar Nov 24 '25 09:11 mjimenezm00