Skip to content

Conversation

@marioprats
Copy link

@marioprats marioprats commented Sep 17, 2025

A fix to the dual arm franka config to correct a mismatch in the arms orientation in Mujoco vs the URDF

Then converts the config into a bi-manual sorting benchmark:

  • Adds a table in front of the robot with green and red boxes
  • Adds red and green tables to the left and right
  • The robot task is to put red blocks in the red table, green blocks in the green table
  • Adds Objective (e.g. Sort Blocks) to accomplish the task, measuring and logging the cycle time.
  • Adds necessary subtrees to support the Objective mentioned above
Screenshot from 2025-09-19 15-49-57 image

The config is still compatible with the drawing demo: it wll 'draw' on the table. Therefore both can potentially be used in HW demos.

Finally, this PR adds an stationary admittance demo to lab_sim, the same we run in the office in the UR on rail, which creates an stationary trajectory with an admittance overlay. The robot in sim won't move, but at least we have an example and Behavior coverage.

Uses four Behaviors that were previously unused: BiasedCoinFlip, StopwatchBegin, StopwatchEnd, CreateStationaryTrajectory.

@marioprats marioprats changed the title Fixes to franka_dual_arm_sim and sorting benchmark Fixes to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo Sep 18, 2025
@marioprats marioprats changed the title Fixes to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo Updates to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo in lab_sim Sep 19, 2025
Copy link
Collaborator

@shaur-k shaur-k left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

smallest nitpick

@marioprats marioprats requested a review from shaur-k September 23, 2025 11:09
Copy link

@kineticsystem kineticsystem left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I found two issues in the objective:
1 - the robot tries to grab the same cube multiple times, even if the cube is not there anymore
2 - after a while it throws "Objective Server Error - Execution of behavior tree for Objective Sort Blocks terminated due to an error: Caught exception while ticking behavior tree: Lookup would require extrapolation into the past. Requested time 1758635483.619006 but the earliest data is at time 1758635497.068961, when looking up transform from frame [scene_camera_optical_frame] to frame [world]"

@shaur-k shaur-k enabled auto-merge September 24, 2025 21:04
@shaur-k shaur-k merged commit 1613ef2 into main Sep 24, 2025
5 checks passed
@kineticsystem kineticsystem deleted the sorting_franka branch September 26, 2025 13:36
shaur-k added a commit that referenced this pull request Sep 30, 2025
Updates to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo in lab_sim
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

4 participants