Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

[Bug]: WidowX gripper moving in y-direction opposite to the commanded input #239

Open
abadithela opened this issue Jan 5, 2025 · 6 comments
Labels
bug Something isn't working manipulators Issues related to manipulators

Comments

@abadithela
Copy link

What happened?

Hi,

I am using the WidowX 250s on UBuntu 22.04 with ROS Noetic. I have two questions. First, I am using a policy to command changes in gripper position, and I am using the bot.arm.set_ee_cartesian_trajectory(x=dx, y=dy, z=dz, roll=droll, pitch=dpitch, yaw=dyaw) to update the gripper position. We're noticing the following failure mode about once or twice every 10 trials. The gripper moves in a dy position opposite to the commanded dy. For example, the commanded dy position can take a small positive value (which is supposed to shift the gripper to the left), and followed by a larger negative value (which is supposed to shift it to the right) as given below. However, what we observe is that it does not properly execute the commands of step 22, and continues shifting further to the left.

Running Step: 20

dx: -0.0025309075135737658
dy: 0.0035765364300459623
dz: 0.0039052797947078943
droll: 0.03742938116192818
dpitch: -0.002348142210394144
dyaw: -0.010451313108205795
Gripper: -0.002302885986864567


dx: -0.0013802630128338933
dy: 0.0037133574951440096
dz: 0.0026718107983469963
droll: 0.019720030948519707
dpitch: 0.002738431328907609
dyaw: -0.007126897107809782
Gripper: 0.002539239125326276

Running Step: 22

dx: 0.0013360296143218875
dy: -0.015529503114521503
dz: 0.011899501085281372
droll: -0.010677888989448547
dpitch: -0.006024511530995369
dyaw: 0.02880163863301277
Gripper: 0.014854628592729568


dx: 0.022568529471755028
dy: -0.03731013089418411
dz: 0.019864581525325775
droll: -0.05908364802598953
dpitch: -0.021504143252968788
dyaw: 0.08463582396507263
Gripper: -0.008733903057873249

The second question is regarding doing a Dynamixel firmware update. On the dynamixel wizard, all motors have an asterisk next to them, which I understand to mean that a firmware update is available. Would doing a firmware update resolve the above issue? More importantly, is the latest firmware update compatible with the ROS software of interbotix?

Robot Model

wx250s

Operating System

Ubuntu 22.04

ROS Distro

ROS 1 Noetic

Steps To Reproduce

No response

Relevant log output

No response

Additional Info

No response

@abadithela abadithela added bug Something isn't working manipulators Issues related to manipulators labels Jan 5, 2025
@lukeschmitt-tr
Copy link
Member

lukeschmitt-tr commented Jan 6, 2025

Please enable debug logging on the arm's xs_sdk provide the output when running your script.

Please also ensure that the commands you are providing to the arm do not exceed the joint limits and are feasible according to the solver used by the set_ee_cartesian_trajectory method.

Would doing a firmware update resolve the above issue?

I do not think that updating the firmware would resolve this issue but it wouldn't hurt to keep everything up-to-date.

More importantly, is the latest firmware update compatible with the ROS software of interbotix?

Yes, it is compatible.

@abadithela
Copy link
Author

What is the command to enable debug logging? We ran the following but it did not seem to do anything:

roslaunch interbotix_xsarm_control xsarm_control.launch robot_model:=wx250s xs_driver_logging_level:=debug

Yes, the commands we are providing to the arm do not exceed joint limits. Every argument to set_ee_cartesian_trajectory is on the order of 0.01 at most.

@lukeschmitt-tr
Copy link
Member

I didn't catch that you're running on ROS 1 Noetic. Debug logging is not available as a simple command line arg in that distro. You will instead have to configure rosconsole to achieve debug logging.

@abadithela
Copy link
Author

When I've tried debug logging, it gives me the following output on terminal when I'm seeing this failure:

[DEBUG] [1736289088.502407052]: [xs_sdk::robot_set_motor_registers] ID: 7, writing reg: Profile_Acceleration, value: 300.
[DEBUG] [1736289088.513375646]: [xs_sdk::robot_set_motor_registers] ID: 8, writing reg: Profile_Acceleration, value: 300.
[DEBUG] [1736289088.524488435]: Connection::drop(2)
[DEBUG] [1736289088.524571491]: TCP socket [17] closed
[DEBUG] [1736289088.524605756]: Connection::drop(0)
[DEBUG] [1736289088.524642868]: Connection::drop(2)
[DEBUG] [1736289088.524674965]: Connection::drop(2)
[DEBUG] [1736289088.527426722]: Time jumped forward by [0.052035] for timer of period [0.010000], resetting timer (current=1736289088.527397, next_expected=1736289088.475362)
[DEBUG] [1736289088.527668775]: Accepted connection on socket [7], new socket [17]
[DEBUG] [1736289088.528016503]: Adding tcp socket [17] to pollset
[DEBUG] [1736289088.528081768]: TCPROS received a connection from [128.112.36.33:48132]
[DEBUG] [1736289088.528143624]: Async socket[17] is connected
[DEBUG] [1736289088.528197920]: Connection: Creating ServiceClientLink for service [/wx250s/get_robot_info] connected to [callerid=[/wx250s_robot_manipulation] address=[TCPROS connection on port 57753 to [128.112.36.33:48132 on socket 17]]]
[DEBUG] [1736289088.528236881]: Service client [/wx250s_robot_manipulation] wants service [/wx250s/get_robot_info] with md5sum [873f2223b25122251d4d3641d8411cf6]
[DEBUG] [1736289088.532888031]: Parsing robot urdf xml string
[DEBUG] [1736289088.533912279]: successfully added a new material 'interbotix_black'
[DEBUG] [1736289088.533947897]: setting link 'world' material
[DEBUG] [1736289088.533969381]: successfully added a new link 'world'
[DEBUG] [1736289088.534101097]: setting link 'wx250s/base_link' material
[DEBUG] [1736289088.534131636]: setting link 'wx250s/base_link' material to 'interbotix_black'
[DEBUG] [1736289088.534161004]: setting link 'wx250s/base_link' material to 'interbotix_black'
[DEBUG] [1736289088.534192632]: successfully added a new link 'wx250s/base_link'
[DEBUG] [1736289088.534309757]: setting link 'wx250s/shoulder_link' material
[DEBUG] [1736289088.534340933]: setting link 'wx250s/shoulder_link' material to 'interbotix_black'
[DEBUG] [1736289088.534372364]: setting link 'wx250s/shoulder_link' material to 'interbotix_black'
[DEBUG] [1736289088.534401759]: successfully added a new link 'wx250s/shoulder_link'
[DEBUG] [1736289088.534514846]: setting link 'wx250s/upper_arm_link' material
[DEBUG] [1736289088.534545433]: setting link 'wx250s/upper_arm_link' material to 'interbotix_black'
[DEBUG] [1736289088.534575510]: setting link 'wx250s/upper_arm_link' material to 'interbotix_black'
[DEBUG] [1736289088.534605151]: successfully added a new link 'wx250s/upper_arm_link'
[DEBUG] [1736289088.534713001]: setting link 'wx250s/upper_forearm_link' material
[DEBUG] [1736289088.534744027]: setting link 'wx250s/upper_forearm_link' material to 'interbotix_black'
[DEBUG] [1736289088.534774274]: setting link 'wx250s/upper_forearm_link' material to 'interbotix_black'
[DEBUG] [1736289088.534803928]: successfully added a new link 'wx250s/upper_forearm_link'
[DEBUG] [1736289088.534917263]: setting link 'wx250s/lower_forearm_link' material
[DEBUG] [1736289088.534946454]: setting link 'wx250s/lower_forearm_link' material to 'interbotix_black'
[DEBUG] [1736289088.534976272]: setting link 'wx250s/lower_forearm_link' material to 'interbotix_black'
[DEBUG] [1736289088.535005619]: successfully added a new link 'wx250s/lower_forearm_link'
[DEBUG] [1736289088.535122201]: setting link 'wx250s/wrist_link' material
[DEBUG] [1736289088.535151825]: setting link 'wx250s/wrist_link' material to 'interbotix_black'
[DEBUG] [1736289088.535181944]: setting link 'wx250s/wrist_link' material to 'interbotix_black'
[DEBUG] [1736289088.535209313]: successfully added a new link 'wx250s/wrist_link'
[DEBUG] [1736289088.535320013]: setting link 'wx250s/gripper_link' material
[DEBUG] [1736289088.535351130]: setting link 'wx250s/gripper_link' material to 'interbotix_black'
[DEBUG] [1736289088.535379534]: setting link 'wx250s/gripper_link' material to 'interbotix_black'
[DEBUG] [1736289088.535409606]: successfully added a new link 'wx250s/gripper_link'
[DEBUG] [1736289088.535456848]: setting link 'wx250s/ee_arm_link' material
[DEBUG] [1736289088.535486272]: successfully added a new link 'wx250s/ee_arm_link'
[DEBUG] [1736289088.535602111]: setting link 'wx250s/gripper_prop_link' material
[DEBUG] [1736289088.535634199]: setting link 'wx250s/gripper_prop_link' material to 'interbotix_black'
[DEBUG] [1736289088.535661157]: setting link 'wx250s/gripper_prop_link' material to 'interbotix_black'
[DEBUG] [1736289088.535691472]: successfully added a new link 'wx250s/gripper_prop_link'
[DEBUG] [1736289088.535805887]: setting link 'wx250s/gripper_bar_link' material
[DEBUG] [1736289088.535834631]: setting link 'wx250s/gripper_bar_link' material to 'interbotix_black'
[DEBUG] [1736289088.535861725]: setting link 'wx250s/gripper_bar_link' material to 'interbotix_black'
[DEBUG] [1736289088.535891422]: successfully added a new link 'wx250s/gripper_bar_link'
[DEBUG] [1736289088.535938454]: setting link 'wx250s/fingers_link' material
[DEBUG] [1736289088.535968763]: successfully added a new link 'wx250s/fingers_link'
[DEBUG] [1736289088.536088282]: setting link 'wx250s/left_finger_link' material
[DEBUG] [1736289088.536119092]: setting link 'wx250s/left_finger_link' material to 'interbotix_black'
[DEBUG] [1736289088.536148369]: setting link 'wx250s/left_finger_link' material to 'interbotix_black'
[DEBUG] [1736289088.536177325]: successfully added a new link 'wx250s/left_finger_link'
[DEBUG] [1736289088.536306383]: setting link 'wx250s/right_finger_link' material
[DEBUG] [1736289088.536338165]: setting link 'wx250s/right_finger_link' material to 'interbotix_black'
[DEBUG] [1736289088.536367781]: setting link 'wx250s/right_finger_link' material to 'interbotix_black'
[DEBUG] [1736289088.536398223]: successfully added a new link 'wx250s/right_finger_link'
[DEBUG] [1736289088.536446784]: setting link 'wx250s/ee_gripper_link' material
[DEBUG] [1736289088.536477145]: successfully added a new link 'wx250s/ee_gripper_link'
[DEBUG] [1736289088.536510568]: Joint [fixed] missing origin tag under parent describing transform from Parent Link to Joint Frame, (using Identity transform).
[DEBUG] [1736289088.536545236]: successfully added a new joint 'fixed'
[DEBUG] [1736289088.536616328]: no damping, defaults to 0
[DEBUG] [1736289088.536653371]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.536682899]: successfully added a new joint 'waist'
[DEBUG] [1736289088.536748532]: no damping, defaults to 0
[DEBUG] [1736289088.536782941]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.536813054]: successfully added a new joint 'shoulder'
[DEBUG] [1736289088.536877318]: no damping, defaults to 0
[DEBUG] [1736289088.536921867]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.536951162]: successfully added a new joint 'elbow'
[DEBUG] [1736289088.537013661]: no damping, defaults to 0
[DEBUG] [1736289088.537046660]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537077988]: successfully added a new joint 'forearm_roll'
[DEBUG] [1736289088.537141273]: no damping, defaults to 0
[DEBUG] [1736289088.537172852]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537202825]: successfully added a new joint 'wrist_angle'
[DEBUG] [1736289088.537266294]: no damping, defaults to 0
[DEBUG] [1736289088.537298907]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537328281]: successfully added a new joint 'wrist_rotate'
[DEBUG] [1736289088.537376124]: successfully added a new joint 'ee_arm'
[DEBUG] [1736289088.537428838]: no lower, defaults to 0
[DEBUG] [1736289088.537456916]: no upper, , defaults to 0
[DEBUG] [1736289088.537492637]: no damping, defaults to 0
[DEBUG] [1736289088.537526878]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537556550]: successfully added a new joint 'gripper'
[DEBUG] [1736289088.537602468]: successfully added a new joint 'gripper_bar'
[DEBUG] [1736289088.537649308]: successfully added a new joint 'ee_bar'
[DEBUG] [1736289088.537711246]: no damping, defaults to 0
[DEBUG] [1736289088.537744165]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537773689]: successfully added a new joint 'left_finger'
[DEBUG] [1736289088.537839979]: no damping, defaults to 0
[DEBUG] [1736289088.537873775]: damping 0.000000 and friction 0.100000
[DEBUG] [1736289088.537904910]: successfully added a new joint 'right_finger'
[DEBUG] [1736289088.537950118]: successfully added a new joint 'ee_gripper'
[DEBUG] [1736289088.538262206]: Connection::drop(2)
[DEBUG] [1736289088.538334154]: TCP socket [17] closed
[DEBUG] [1736289088.538371675]: Connection::drop(0)
[DEBUG] [1736289088.538406691]: Connection::drop(2)
[DEBUG] [1736289088.538436046]: Connection::drop(2)
[DEBUG] [1736289088.541482230]: [xs_sdk::robot_write_joint_command] ID: 9, writing pwm command 250.000000.
[DEBUG] [1736289089.080532220]: [xs_sdk::robot_write_joint_command] ID: 9, writing pwm command 0.000000.
[DEBUG] [1736289089.540672215]: [xs_sdk::robot_write_commands] ID: 1, writing position command 2048.
[DEBUG] [1736289089.540759955]: [xs_sdk::robot_write_commands] ID: 2, writing position command 874.
[DEBUG] [1736289089.540800002]: [xs_sdk::robot_write_commands] ID: 4, writing position command 3058.
[DEBUG] [1736289089.540828219]: [xs_sdk::robot_write_commands] ID: 6, writing position command 2048.
[DEBUG] [1736289089.540851792]: [xs_sdk::robot_write_commands] ID: 7, writing position command 2569.
[DEBUG] [1736289089.540878445]: [xs_sdk::robot_write_commands] ID: 8, writing position command 2048.
[DEBUG] [1736289091.557650808]: Socket [20] received 0/4 bytes, closing
[DEBUG] [1736289091.557833999]: TCP socket [20] closed
[DEBUG] [1736289091.557881983]: Connection::drop(0)
[DEBUG] [1736289091.557931697]: Connection to publisher [TCPROS connection on port 33292 to [128.112.36.33:41161 on socket 20]] to topic [/wx250s/commands/joint_group] dropped
[DEBUG] [1736289091.557977133]: getsockopt failed on socket [-1]
[DEBUG] [1736289091.558015645]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289091.558090983]: Socket [21] received 0/4 bytes, closing
[DEBUG] [1736289091.558174175]: TCP socket [21] closed
[DEBUG] [1736289091.558205032]: Connection::drop(0)
[DEBUG] [1736289091.558241319]: Connection to publisher [TCPROS connection on port 33306 to [128.112.36.33:41161 on socket 21]] to topic [/wx250s/commands/joint_single] dropped
[DEBUG] [1736289091.558282113]: getsockopt failed on socket [-1]
[DEBUG] [1736289091.558316012]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289091.558467319]: Socket [22] received 0/4 bytes, closing
[DEBUG] [1736289091.558546086]: TCP socket [22] closed
[DEBUG] [1736289091.558581286]: Connection::drop(0)
[DEBUG] [1736289091.558612983]: Connection to publisher [TCPROS connection on port 33316 to [128.112.36.33:41161 on socket 22]] to topic [/wx250s/commands/joint_trajectory] dropped
[DEBUG] [1736289091.558656075]: getsockopt failed on socket [-1]
[DEBUG] [1736289091.558687197]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289091.558806433]: Socket 15 closed with (ERR|HUP|NVAL) events 8192: Success
[DEBUG] [1736289091.558884774]: TCP socket [15] closed
[DEBUG] [1736289091.558915158]: Connection::drop(0)
[DEBUG] [1736289091.558956381]: Connection to subscriber [callerid=[/wx250s_robot_manipulation] address=[TCPROS connection on port 57753 to [128.112.36.33:48098 on socket 15]]] to topic [/wx250s/joint_states] dropped
[DEBUG] [1736289091.558987580]: Connection::drop(2)
[DEBUG] [1736289091.559035591]: Connection::drop(2)
[DEBUG] [1736289091.649791219]: Received update for topic [/wx250s/commands/joint_group] (0 publishers)
[DEBUG] [1736289091.649851851]: Publisher update for [/wx250s/commands/joint_group]:  already have these connections: http://128.112.36.33:39009/, 
[DEBUG] [1736289091.649881750]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_group] at [http://128.112.36.33:39009/]
[DEBUG] [1736289091.649906484]: Connection::drop(2)
[DEBUG] [1736289091.649935604]: Connection::drop(2)
[DEBUG] [1736289091.649968305]: Connection::drop(2)
[DEBUG] [1736289091.651154071]: Received update for topic [/wx250s/commands/joint_single] (0 publishers)
[DEBUG] [1736289091.651189451]: Publisher update for [/wx250s/commands/joint_single]:  already have these connections: http://128.112.36.33:39009/, 
[DEBUG] [1736289091.651215293]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_single] at [http://128.112.36.33:39009/]
[DEBUG] [1736289091.651236551]: Connection::drop(2)
[DEBUG] [1736289091.651261500]: Connection::drop(2)
[DEBUG] [1736289091.651296860]: Connection::drop(2)
[DEBUG] [1736289091.652375084]: Received update for topic [/wx250s/commands/joint_trajectory] (0 publishers)
[DEBUG] [1736289091.652410981]: Publisher update for [/wx250s/commands/joint_trajectory]:  already have these connections: http://128.112.36.33:39009/, 
[DEBUG] [1736289091.652437254]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_trajectory] at [http://128.112.36.33:39009/]
[DEBUG] [1736289091.652465209]: Connection::drop(2)
[DEBUG] [1736289091.652495330]: Connection::drop(2)
[DEBUG] [1736289091.652522640]: Connection::drop(2)

@abadithela
Copy link
Author

For reference, here is the debug console output when I successfully command the robot to a certain state. I am curious about the [DEBUG] [1736289534.655163769]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1

[DEBUG] [1736289532.641370468]: [xs_sdk::robot_write_commands] ID: 1, writing position command 2048.
[DEBUG] [1736289532.641426540]: [xs_sdk::robot_write_commands] ID: 2, writing position command 874.
[DEBUG] [1736289532.641470506]: [xs_sdk::robot_write_commands] ID: 4, writing position command 3058.
[DEBUG] [1736289532.641515501]: [xs_sdk::robot_write_commands] ID: 6, writing position command 2048.
[DEBUG] [1736289532.641566570]: [xs_sdk::robot_write_commands] ID: 7, writing position command 2569.
[DEBUG] [1736289532.641617483]: [xs_sdk::robot_write_commands] ID: 8, writing position command 2048.
[DEBUG] [1736289534.654694451]: Socket [18] received 0/4 bytes, closing
[DEBUG] [1736289534.654874919]: TCP socket [18] closed
[DEBUG] [1736289534.654918014]: Connection::drop(0)
[DEBUG] [1736289534.654984207]: Connection to publisher [TCPROS connection on port 50784 to [128.112.36.33:45347 on socket 18]] to topic [/wx250s/commands/joint_group] dropped
[DEBUG] [1736289534.655126034]: getsockopt failed on socket [-1]
[DEBUG] [1736289534.655163769]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289534.655248454]: Socket [19] received 0/4 bytes, closing
[DEBUG] [1736289534.655335641]: TCP socket [19] closed
[DEBUG] [1736289534.655365889]: Connection::drop(0)
[DEBUG] [1736289534.655402802]: Connection to publisher [TCPROS connection on port 50794 to [128.112.36.33:45347 on socket 19]] to topic [/wx250s/commands/joint_single] dropped
[DEBUG] [1736289534.655461614]: getsockopt failed on socket [-1]
[DEBUG] [1736289534.655494054]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289534.655527065]: Socket [20] received 0/4 bytes, closing
[DEBUG] [1736289534.655599438]: TCP socket [20] closed
[DEBUG] [1736289534.655629903]: Connection::drop(0)
[DEBUG] [1736289534.655666590]: Connection to publisher [TCPROS connection on port 50800 to [128.112.36.33:45347 on socket 20]] to topic [/wx250s/commands/joint_trajectory] dropped
[DEBUG] [1736289534.655706785]: getsockopt failed on socket [-1]
[DEBUG] [1736289534.655737677]: Socket -1 closed with (ERR|HUP|NVAL) events 8193: Unknown error -1
[DEBUG] [1736289534.655947660]: Socket 11 closed with (ERR|HUP|NVAL) events 8192: Success
[DEBUG] [1736289534.656025198]: TCP socket [11] closed
[DEBUG] [1736289534.656055320]: Connection::drop(0)
[DEBUG] [1736289534.656099734]: Connection to subscriber [callerid=[/wx250s_robot_manipulation] address=[TCPROS connection on port 58241 to [128.112.36.33:53128 on socket 11]]] to topic [/wx250s/joint_states] dropped
[DEBUG] [1736289534.656137182]: Connection::drop(2)
[DEBUG] [1736289534.656185853]: Connection::drop(2)
[DEBUG] [1736289534.745119443]: Received update for topic [/wx250s/commands/joint_group] (0 publishers)
[DEBUG] [1736289534.745195970]: Publisher update for [/wx250s/commands/joint_group]:  already have these connections: http://128.112.36.33:45681/, 
[DEBUG] [1736289534.745233938]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_group] at [http://128.112.36.33:45681/]
[DEBUG] [1736289534.745259275]: Connection::drop(2)
[DEBUG] [1736289534.745299104]: Connection::drop(2)
[DEBUG] [1736289534.745331890]: Connection::drop(2)
[DEBUG] [1736289534.746541045]: Received update for topic [/wx250s/commands/joint_single] (0 publishers)
[DEBUG] [1736289534.746588650]: Publisher update for [/wx250s/commands/joint_single]:  already have these connections: http://128.112.36.33:45681/, 
[DEBUG] [1736289534.746613270]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_single] at [http://128.112.36.33:45681/]
[DEBUG] [1736289534.746643029]: Connection::drop(2)
[DEBUG] [1736289534.746678766]: Connection::drop(2)
[DEBUG] [1736289534.746703121]: Connection::drop(2)
[DEBUG] [1736289534.747844568]: Received update for topic [/wx250s/commands/joint_trajectory] (0 publishers)
[DEBUG] [1736289534.747888756]: Publisher update for [/wx250s/commands/joint_trajectory]:  already have these connections: http://128.112.36.33:45681/, 
[DEBUG] [1736289534.747922333]: Disconnecting from publisher [/wx250s_robot_manipulation] of topic [/wx250s/commands/joint_trajectory] at [http://128.112.36.33:45681/]
[DEBUG] [1736289534.747951734]: Connection::drop(2)
[DEBUG] [1736289534.747983963]: Connection::drop(2)
[DEBUG] [1736289534.748013840]: Connection::drop(2)

@abadithela
Copy link
Author

abadithela commented Jan 9, 2025

Hi,

We're still facing this issue about 1 in 3 experiments. Is there any way to diagnose this issue? I've plotted the joint states over the course of operation (the relevant part of the plot is after time step 100).

yreversal_error_trail298

I think the waist joint angle (dark blue / position[0] plot) illustrates this issue. It continues to be positive when the expected behavior should be that it eventually decrease and become negative.

Best,
Apurva

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
bug Something isn't working manipulators Issues related to manipulators
Projects
None yet
Development

No branches or pull requests

2 participants