Issues with force torque sensor in impedance control mode

Hey,

I’m using an Xarm7 (XS130510D43A14) with a Ufactory force-torque sensor (Al13021224008) and I’m facing a few issues while using the arm in impedance control mode:

  1. I notice that sometimes (not necessarily, but mostly after a collision / force-torque sensor overload) the robot does not move to the desired pose set using:
    set_position_aa(axis_angle_pose, speed=50, mvacc=500, is_radian=True, relative=False, wait=True
    but rather starts to move slightly down/in some other direction as well. I’m attaching two videos (with impedance K = 300 and K = 1000) both of which are supposed to go to the handle of the dishwasher (which it goes to in normal operation)

https://imgur.com/a/4wQT8Pa

Please note that the payload setting is correct and was set based on a calibrated value from the force sensor

  1. The arm sometimes goes into an uncontrollable shaking motion and stops due to velocity limits exceeded error:

https://imgur.com/a/kJbTxA5

Please note that the uncontrollable shake sometimes occurs while trying to grasp the handle as well.

  1. The speed in impedance control mode is often slower than the speed in normal mode.

Thank you

Force/Torque Sensor Diagnostic Instructions

1. Check if the sensor is functioning properly

  1. Remove the tool/gripper from the sensor.
  2. Move the robot to the home (zero) position.
  3. Open UFACTORY Studio:
    Settings > General > Debugging Tools
  4. Set the following:
    • Mode: Raw Data of 6-Axis Torque Sensor
    • Direction: All
    • Frequency: 200Hz
    • Check Observation
  5. Click Start and observe data for about 10 seconds.

Expected ranges (no load):

  • Force: Fx, Fy, Fz should be within ±60 N
  • Torque: Tx, Ty, Tz should be within ±2 N·m

image

2. Share your equivalent mass parameter

Please provide the equivalent mass (M) value in your script.