-
Notifications
You must be signed in to change notification settings - Fork 7
Updates to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo in lab_sim #419
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
Conversation
1cead62 to
70fc0c2
Compare
37418d6 to
a154fbf
Compare
src/moveit_pro_franka_configs/franka_dual_arm_sim/description/mujoco/franka3.xml
Show resolved
Hide resolved
src/moveit_pro_franka_configs/franka_dual_arm_sim/objectives/sort_blocks.xml
Show resolved
Hide resolved
shaur-k
left a comment
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
smallest nitpick
src/moveit_pro_franka_configs/franka_dual_arm_sim/description/mujoco/scene.xml
Show resolved
Hide resolved
kineticsystem
left a comment
There was a problem hiding this 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]"
d65f0f9 to
7c02a6d
Compare
Updates to franka_dual_arm_sim, add sorting benchmark, add stationary admittance demo in lab_sim
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:
Sort Blocks) to accomplish the task, measuring and logging the cycle time.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.