Interbotix / interbotix_ros_rovers

ROS Packages for Interbotix Rovers
BSD 3-Clause "New" or "Revised" License
31 stars 31 forks source link

[Bug]: dynamixel ID 2, 11 not found #18

Closed aaravrav142 closed 2 years ago

aaravrav142 commented 2 years ago

What happened?

After installation of the software on the NUC on the locobot_wx250 and launching with the following command roslaunch interbotix_xslocobot_control xslocobot_control.launch robot_model:=locobot_wx250s use_base:=true use_camera:=true use_lidar:=true

I am getting the following response. Basically the dynamixel ID 2, 11 are not found. Earlier I had the same issue with the 10 and 11 so I checked with the Dynamixel wizard tool and found that the pan tilt motors were on 57600 baud rate. As instructed I changed the baud rate to 1 MBPS. Soon after this, the ID 2 and 11 disappeared from the scan list. Also the realsense is not getting recognized on my NUC (New robot system). locobot@locobot:~$ roslaunch interbotix_xslocobot_control xslocobot_control.launch robot_model:=locobot_wx250s use_base:=true use_camera:=true use_lidar:=true

... logging to /home/locobot/.ros/log/017a18f2-08b9-11ed-ae27-cbc681687424/roslaunch-locobot-4134.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://192.168.1.242:40471/

SUMMARY
========

PARAMETERS
 * /locobot/camera/realsense2_camera/accel_fps: 250
 * /locobot/camera/realsense2_camera/accel_frame_id: locobot/camera_ac...
 * /locobot/camera/realsense2_camera/accel_optical_frame_id: locobot/camera_ac...
 * /locobot/camera/realsense2_camera/align_depth: False
 * /locobot/camera/realsense2_camera/aligned_depth_to_color_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/aligned_depth_to_fisheye1_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/aligned_depth_to_fisheye2_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/aligned_depth_to_fisheye_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/aligned_depth_to_infra1_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/aligned_depth_to_infra2_frame_id: locobot/camera_al...
 * /locobot/camera/realsense2_camera/allow_no_texture_points: False
 * /locobot/camera/realsense2_camera/base_frame_id: locobot/camera_link
 * /locobot/camera/realsense2_camera/calib_odom_file: 
 * /locobot/camera/realsense2_camera/clip_distance: -2.0
 * /locobot/camera/realsense2_camera/color_fps: 30
 * /locobot/camera/realsense2_camera/color_frame_id: locobot/camera_co...
 * /locobot/camera/realsense2_camera/color_height: 480
 * /locobot/camera/realsense2_camera/color_optical_frame_id: locobot/camera_co...
 * /locobot/camera/realsense2_camera/color_width: 640
 * /locobot/camera/realsense2_camera/depth_fps: 30
 * /locobot/camera/realsense2_camera/depth_frame_id: locobot/camera_de...
 * /locobot/camera/realsense2_camera/depth_height: 480
 * /locobot/camera/realsense2_camera/depth_optical_frame_id: locobot/camera_de...
 * /locobot/camera/realsense2_camera/depth_width: 640
 * /locobot/camera/realsense2_camera/device_type: 
 * /locobot/camera/realsense2_camera/enable_accel: False
 * /locobot/camera/realsense2_camera/enable_color: True
 * /locobot/camera/realsense2_camera/enable_depth: True
 * /locobot/camera/realsense2_camera/enable_fisheye1: False
 * /locobot/camera/realsense2_camera/enable_fisheye2: False
 * /locobot/camera/realsense2_camera/enable_fisheye: False
 * /locobot/camera/realsense2_camera/enable_gyro: False
 * /locobot/camera/realsense2_camera/enable_infra1: False
 * /locobot/camera/realsense2_camera/enable_infra2: False
 * /locobot/camera/realsense2_camera/enable_infra: False
 * /locobot/camera/realsense2_camera/enable_pointcloud: False
 * /locobot/camera/realsense2_camera/enable_pose: False
 * /locobot/camera/realsense2_camera/enable_sync: False
 * /locobot/camera/realsense2_camera/filters: 
 * /locobot/camera/realsense2_camera/fisheye1_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye1_optical_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye2_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye2_optical_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye_fps: 30
 * /locobot/camera/realsense2_camera/fisheye_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye_height: 480
 * /locobot/camera/realsense2_camera/fisheye_optical_frame_id: locobot/camera_fi...
 * /locobot/camera/realsense2_camera/fisheye_width: 640
 * /locobot/camera/realsense2_camera/gyro_fps: 400
 * /locobot/camera/realsense2_camera/gyro_frame_id: locobot/camera_gy...
 * /locobot/camera/realsense2_camera/gyro_optical_frame_id: locobot/camera_gy...
 * /locobot/camera/realsense2_camera/imu_optical_frame_id: locobot/camera_im...
 * /locobot/camera/realsense2_camera/infra1_frame_id: locobot/camera_in...
 * /locobot/camera/realsense2_camera/infra1_optical_frame_id: locobot/camera_in...
 * /locobot/camera/realsense2_camera/infra2_frame_id: locobot/camera_in...
 * /locobot/camera/realsense2_camera/infra2_optical_frame_id: locobot/camera_in...
 * /locobot/camera/realsense2_camera/infra_fps: 30
 * /locobot/camera/realsense2_camera/infra_height: 480
 * /locobot/camera/realsense2_camera/infra_rgb: False
 * /locobot/camera/realsense2_camera/infra_width: 640
 * /locobot/camera/realsense2_camera/initial_reset: False
 * /locobot/camera/realsense2_camera/json_file_path: 
 * /locobot/camera/realsense2_camera/linear_accel_cov: 0.01
 * /locobot/camera/realsense2_camera/odom_frame_id: locobot/camera_od...
 * /locobot/camera/realsense2_camera/pointcloud_texture_index: 0
 * /locobot/camera/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_COLOR
 * /locobot/camera/realsense2_camera/pose_frame_id: locobot/camera_po...
 * /locobot/camera/realsense2_camera/pose_optical_frame_id: locobot/camera_po...
 * /locobot/camera/realsense2_camera/publish_odom_tf: True
 * /locobot/camera/realsense2_camera/publish_tf: True
 * /locobot/camera/realsense2_camera/rosbag_filename: 
 * /locobot/camera/realsense2_camera/serial_no: 
 * /locobot/camera/realsense2_camera/tf_publish_rate: 0.0
 * /locobot/camera/realsense2_camera/topic_odom_in: odom_in
 * /locobot/camera/realsense2_camera/unite_imu_method: 
 * /locobot/camera/realsense2_camera/usb_port_id: 
 * /locobot/diagnostic_aggregator/analyzers/input_ports/contains: ['Digital Input',...
 * /locobot/diagnostic_aggregator/analyzers/input_ports/path: Input Ports
 * /locobot/diagnostic_aggregator/analyzers/input_ports/remove_prefix: mobile_base_nodel...
 * /locobot/diagnostic_aggregator/analyzers/input_ports/timeout: 5.0
 * /locobot/diagnostic_aggregator/analyzers/input_ports/type: diagnostic_aggreg...
 * /locobot/diagnostic_aggregator/analyzers/kobuki/contains: ['Watchdog', 'Mot...
 * /locobot/diagnostic_aggregator/analyzers/kobuki/path: Kobuki
 * /locobot/diagnostic_aggregator/analyzers/kobuki/remove_prefix: mobile_base_nodel...
 * /locobot/diagnostic_aggregator/analyzers/kobuki/timeout: 5.0
 * /locobot/diagnostic_aggregator/analyzers/kobuki/type: diagnostic_aggreg...
 * /locobot/diagnostic_aggregator/analyzers/power/contains: ['Battery']
 * /locobot/diagnostic_aggregator/analyzers/power/path: Power System
 * /locobot/diagnostic_aggregator/analyzers/power/remove_prefix: mobile_base_nodel...
 * /locobot/diagnostic_aggregator/analyzers/power/timeout: 5.0
 * /locobot/diagnostic_aggregator/analyzers/power/type: diagnostic_aggreg...
 * /locobot/diagnostic_aggregator/analyzers/sensors/contains: ['Cliff Sensor', ...
 * /locobot/diagnostic_aggregator/analyzers/sensors/path: Sensors
 * /locobot/diagnostic_aggregator/analyzers/sensors/remove_prefix: mobile_base_nodel...
 * /locobot/diagnostic_aggregator/analyzers/sensors/timeout: 5.0
 * /locobot/diagnostic_aggregator/analyzers/sensors/type: diagnostic_aggreg...
 * /locobot/diagnostic_aggregator/base_path: 
 * /locobot/diagnostic_aggregator/pub_rate: 1.0
 * /locobot/joint_state_publisher/rate: 100
 * /locobot/joint_state_publisher/source_list: ['dynamixel/joint...
 * /locobot/mobile_base/acceleration_limiter: True
 * /locobot/mobile_base/base_frame: locobot/base_foot...
 * /locobot/mobile_base/battery_capacity: 16.5
 * /locobot/mobile_base/battery_dangerous: 13.2
 * /locobot/mobile_base/battery_low: 14.0
 * /locobot/mobile_base/cmd_vel_timeout: 2.0
 * /locobot/mobile_base/device_port: /dev/kobuki
 * /locobot/mobile_base/odom_frame: locobot/odom
 * /locobot/mobile_base/publish_tf: True
 * /locobot/mobile_base/use_imu_heading: True
 * /locobot/mobile_base/wheel_left_joint_name: wheel_left_joint
 * /locobot/mobile_base/wheel_right_joint_name: wheel_right_joint
 * /locobot/robot_description: <?xml version="1....
 * /locobot/rplidarNode/angle_compensate: True
 * /locobot/rplidarNode/frame_id: locobot/laser_fra...
 * /locobot/rplidarNode/inverted: False
 * /locobot/rplidarNode/serial_baudrate: 115200
 * /locobot/rplidarNode/serial_port: /dev/rplidar
 * /locobot/use_base: True
 * /locobot/xs_sdk/load_configs: True
 * /locobot/xs_sdk/mode_configs: /home/locobot/int...
 * /locobot/xs_sdk/motor_configs: /home/locobot/int...
 * /rosdistro: noetic
 * /rosversion: 1.15.14

NODES
  /locobot/
    diagnostic_aggregator (diagnostic_aggregator/aggregator_node)
    joint_state_publisher (joint_state_publisher/joint_state_publisher)
    mobile_base (nodelet/nodelet)
    mobile_base_nodelet_manager (nodelet/nodelet)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rplidarNode (rplidar_ros/rplidarNode)
    xs_sdk (interbotix_xs_sdk/xs_sdk)
  /locobot/camera/
    realsense2_camera (nodelet/nodelet)
    realsense2_camera_manager (nodelet/nodelet)

auto-starting new master
process[master]: started with pid [4150]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to 017a18f2-08b9-11ed-ae27-cbc681687424
process[rosout-1]: started with pid [4163]
started core service [/rosout]
process[locobot/joint_state_publisher-2]: started with pid [4170]
process[locobot/robot_state_publisher-3]: started with pid [4171]
process[locobot/xs_sdk-4]: started with pid [4172]
process[locobot/mobile_base_nodelet_manager-5]: started with pid [4173]
process[locobot/mobile_base-6]: started with pid [4174]
process[locobot/diagnostic_aggregator-7]: started with pid [4180]
process[locobot/rplidarNode-8]: started with pid [4185]
process[locobot/camera/realsense2_camera_manager-9]: started with pid [4191]
process[locobot/camera/realsense2_camera-10]: started with pid [4201]
[ INFO] [1658382621.648694451]: [xs_sdk] Loaded mode configs from '/home/locobot/interbotix_ws/src/interbotix_ros_rovers/interbotix_ros_xslocobots/interbotix_xslocobot_control/config/modes_all.yaml'.
[ INFO] [1658382621.668980071]: [xs_sdk] Loaded motor configs from '/home/locobot/interbotix_ws/src/interbotix_ros_rovers/interbotix_ros_xslocobots/interbotix_xslocobot_control/config/locobot_wx250s.yaml'.
[ INFO] [1658382621.672242335]: [xs_sdk] Pinging all motors specified in the motor_config file. (Attempt 1/3)
[ INFO] [1658382621.680014662]: RPLIDAR running on ROS package rplidar_ros, SDK Version:2.0.0
[ INFO] [1658382621.713058005]: Initializing nodelet with 4 worker threads.
[ INFO] [1658382621.733476473]: RPLIDAR S/N: 9EAC9AF2C1EA98D4BEEB9CF0117F3517
[ INFO] [1658382621.733512873]: Firmware Ver: 1.27
[ INFO] [1658382621.733529989]: Hardware Rev: 5
[ERROR] [1658382621.742260374]: [xs_sdk]    Can't find DYNAMIXEL ID: 11, Joint Name: 'tilt':
          '[TxRxResult] There is no status packet!'
[ INFO] [1658382621.777400303]: [xs_sdk]    Found DYNAMIXEL ID:  8, Model: 'XL430-W250', Joint Name: 'wrist_rotate'.
[ INFO] [1658382621.788478650]: RPLidar health status : OK.
[ INFO] [1658382621.826360322]: [xs_sdk]    Found DYNAMIXEL ID:  7, Model: 'XM430-W350', Joint Name: 'wrist_angle'.
[ INFO] [1658382621.858439462]: RealSense ROS v2.2.20
[ INFO] [1658382621.858470564]: Built with LibRealSense v2.40.0
[ INFO] [1658382621.858489747]: Running with LibRealSense v2.40.0
[ WARN] [1658382621.865063409]: No RealSense devices were found!
[ INFO] [1658382621.874373541]: [xs_sdk]    Found DYNAMIXEL ID:  5, Model: 'XM430-W350', Joint Name: 'elbow_shadow'.
[ INFO] [1658382621.922382374]: [xs_sdk]    Found DYNAMIXEL ID:  4, Model: 'XM430-W350', Joint Name: 'elbow'.
[ INFO] [1658382621.970418814]: [xs_sdk]    Found DYNAMIXEL ID:  6, Model: 'XM430-W350', Joint Name: 'forearm_roll'.
[ERROR] [1658382622.018356547]: [xs_sdk]    Can't find DYNAMIXEL ID:  2, Joint Name: 'shoulder':
          '[TxRxResult] Incorrect status packet!'
[ INFO] [1658382622.054445235]: [xs_sdk]    Found DYNAMIXEL ID: 10, Model: 'XL430-W250-2', Joint Name: 'pan'.
[ INFO] [1658382622.067569942]: current scan mode: Stability, sample rate: 4 Khz, max_distance: 12.0 m, scan frequency:10.0 Hz, 
[ INFO] [1658382622.102419581]: [xs_sdk]    Found DYNAMIXEL ID:  9, Model: 'XL430-W250', Joint Name: 'gripper'.
[ INFO] [1658382622.149393963]: [xs_sdk]    Found DYNAMIXEL ID:  3, Model: 'XM430-W350', Joint Name: 'shoulder_shadow'.
[ INFO] [1658382622.197351071]: [xs_sdk]    Found DYNAMIXEL ID:  1, Model: 'XM430-W350', Joint Name: 'waist'.
[ INFO] [1658382622.209404307]: [xs_sdk] Pinging all motors specified in the motor_config file. (Attempt 2/3)
[ERROR] [1658382622.277893933]: [xs_sdk]    Can't find DYNAMIXEL ID: 11, Joint Name: 'tilt':
          '[TxRxResult] There is no status packet!'
[ INFO] [1658382622.313361565]: [xs_sdk]    Found DYNAMIXEL ID:  8, Model: 'XL430-W250', Joint Name: 'wrist_rotate'.
[ INFO] [1658382622.360344318]: [xs_sdk]    Found DYNAMIXEL ID:  7, Model: 'XM430-W350', Joint Name: 'wrist_angle'.
[ INFO] [1658382622.408301032]: [xs_sdk]    Found DYNAMIXEL ID:  5, Model: 'XM430-W350', Joint Name: 'elbow_shadow'.
[ INFO] [1658382622.456352028]: [xs_sdk]    Found DYNAMIXEL ID:  4, Model: 'XM430-W350', Joint Name: 'elbow'.
[ INFO] [1658382622.504349577]: [xs_sdk]    Found DYNAMIXEL ID:  6, Model: 'XM430-W350', Joint Name: 'forearm_roll'.
[ERROR] [1658382622.552385584]: [xs_sdk]    Can't find DYNAMIXEL ID:  2, Joint Name: 'shoulder':
          '[TxRxResult] Incorrect status packet!'
[ INFO] [1658382622.588357959]: [xs_sdk]    Found DYNAMIXEL ID: 10, Model: 'XL430-W250-2', Joint Name: 'pan'.
[ INFO] [1658382622.635318022]: [xs_sdk]    Found DYNAMIXEL ID:  9, Model: 'XL430-W250', Joint Name: 'gripper'.
[ INFO] [1658382622.682325544]: [xs_sdk]    Found DYNAMIXEL ID:  3, Model: 'XM430-W350', Joint Name: 'shoulder_shadow'.
[ INFO] [1658382622.730337696]: [xs_sdk]    Found DYNAMIXEL ID:  1, Model: 'XM430-W350', Joint Name: 'waist'.
[ INFO] [1658382622.742539243]: [xs_sdk] Pinging all motors specified in the motor_config file. (Attempt 3/3)
[ERROR] [1658382622.811002390]: [xs_sdk]    Can't find DYNAMIXEL ID: 11, Joint Name: 'tilt':
          '[TxRxResult] There is no status packet!'
[ INFO] [1658382622.846360862]: [xs_sdk]    Found DYNAMIXEL ID:  8, Model: 'XL430-W250', Joint Name: 'wrist_rotate'.
[ INFO] [1658382622.893327811]: [xs_sdk]    Found DYNAMIXEL ID:  7, Model: 'XM430-W350', Joint Name: 'wrist_angle'.
[ INFO] [1658382622.941334274]: [xs_sdk]    Found DYNAMIXEL ID:  5, Model: 'XM430-W350', Joint Name: 'elbow_shadow'.
[ INFO] [1658382622.989330805]: [xs_sdk]    Found DYNAMIXEL ID:  4, Model: 'XM430-W350', Joint Name: 'elbow'.
[ INFO] [1658382623.037357919]: [xs_sdk]    Found DYNAMIXEL ID:  6, Model: 'XM430-W350', Joint Name: 'forearm_roll'.
[ERROR] [1658382623.117517961]: [xs_sdk]    Can't find DYNAMIXEL ID:  2, Joint Name: 'shoulder':
          '[TxRxResult] Incorrect status packet!'
[ INFO] [1658382623.153305745]: [xs_sdk]    Found DYNAMIXEL ID: 10, Model: 'XL430-W250-2', Joint Name: 'pan'.
[ INFO] [1658382623.200301467]: [xs_sdk]    Found DYNAMIXEL ID:  9, Model: 'XL430-W250', Joint Name: 'gripper'.
[ INFO] [1658382623.247311201]: [xs_sdk]    Found DYNAMIXEL ID:  3, Model: 'XM430-W350', Joint Name: 'shoulder_shadow'.
[ INFO] [1658382623.295339401]: [xs_sdk]    Found DYNAMIXEL ID:  1, Model: 'XM430-W350', Joint Name: 'waist'.
[FATAL] [1658382623.307323918]: [xs_sdk] Failed to find all motors specified in the motor_config file after three attempts. Shutting down...
[FATAL] [1658382623.307375328]: [xs_sdk] For troubleshooting, please see 'https://www.trossenrobotics.com/docs/interbotix_xsarms/troubleshooting/index.html'
[locobot/xs_sdk-4] process has finished cleanly
log file: /home/locobot/.ros/log/017a18f2-08b9-11ed-ae27-cbc681687424/locobot-xs_sdk-4*.log
[ WARN] [1658382627.876197577]: No RealSense devices were found!
[ WARN] [1658382633.880016476]: No RealSense devices were found!
[ WARN] [1658382639.893466137]: No RealSense devices were found!
[ WARN] [1658382645.905147990]: No RealSense devices were found!
[ WARN] [1658382651.916776891]: No RealSense devices were found!
[ WARN] [1658382657.927400359]: No RealSense devices were found!
[ WARN] [1658382663.941613925]: No RealSense devices were found!
[ WARN] [1658382669.952314678]: No RealSense devices were found!
[ WARN] [1658382675.963724925]: No RealSense devices were found!
[ WARN] [1658382681.974209903]: No RealSense devices were found!
`

Robot Model

locobot_wx250

Operating System

Ubuntu 20.04

ROS Distro

ROS1 Noetic

Steps To Reproduce

No response

Relevant log output

No response

Anything Else

The motors are powered because earlier I could see all the motors in the dynamixel wizard plus there is no red led flashing on any of the motors. The problem might be that by default the ID 2 is identical on the pan and the shoulder but I cannot change them as I cannot see the motors on the dynamixel wizard. I am not familiar with dyamixel motors so would like to avoid any disassembly of the arm at this point and would appreciate if there is any way I can fix this issue. Thanks

lukeschmitt-tr commented 2 years ago

You may have an ID conflict somewhere along the chain. Try to remove the arm's 3-pin cable from the power hub so that the U2D2 can only see the pan/tilt two-axis servo. Run the Dynamixel Wizard, scan using the typical search parameters, and see if you can find the missing servos. If you can, set the IDs and baudrates according to the default servo configuration.

To the realsense issue, try running the command realsense-viewer command to see if librealsense can detect the camera without the ROS wrapper.

aaravrav142 commented 2 years ago

Closing this for now. The problem with the Realsense still exists.