Skip to content

Expose tool transformation for FT sensor - #603

Merged
JohnTGZ merged 4 commits into
phase_2from
kaushik/add-ft-sensor-tool-transform
Jul 28, 2026
Merged

Expose tool transformation for FT sensor#603
JohnTGZ merged 4 commits into
phase_2from
kaushik/add-ft-sensor-tool-transform

Conversation

@kaushikbalasundar

Copy link
Copy Markdown
Collaborator

Summary

This PR updates the aic_flowstate_ros_bridge configuration schema to support the newly added Force/Torque sensor tool transformation feature from upstream sdk-ros. Related to : intrinsic-ai/sdk-ros#138

By exposing these fields, we can mathematically shift and rotate the F/T sensor wrench into the tool's coordinate frame (e.g. ati/tool_link) directly from Flowstate, mimicking the hardware tool transformation capabilities found in physical EtherCAT setups.

Changes

  • aic_flowstate_ros_bridge.proto: Added the ToolTransformationConfig message (x, y, z in meters, roll, pitch, yaw in degrees) to match the upstream definition.
  • aic_flowstate_ros_bridge_main.cpp: Added parameter unpacking logic to read force_torque_tool_transform from the runtime_config.pb and emplace it as a std::vector<double> parameter. This ensures the parameter is correctly passed to the dynamically loaded FlowstateROSBridge plugin.

Dependencies

Requires the corresponding sdk-ros PR which implements the Eigen mathematical transformations inside WorldBridge.

@JohnTGZ JohnTGZ left a comment

Copy link
Copy Markdown
Contributor

Choose a reason for hiding this comment

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

We would also need to update the commit hash in flowstate/flowstate.repos to point to the new commit. I think we can do that once we merge intrinsic-ai/sdk-ros#138

double pitch = 5;
double yaw = 6;
}

Copy link
Copy Markdown
Contributor

Choose a reason for hiding this comment

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

We should update the default configs at flowstate/aic_flowstate_ros_bridge/aic_flowstate_ros_bridge_default_config.pbtxt too.

@kaushikbalasundar kaushikbalasundar Jul 24, 2026

Copy link
Copy Markdown
Collaborator Author

Choose a reason for hiding this comment

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

I defaulted them to 0s for now to keep it standardized with how ICON reports it. We might need to do some testing before finalizing the config for AIC. I'll open another PR with those updates once with a participant policy.

Copy link
Copy Markdown
Collaborator Author

Choose a reason for hiding this comment

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

Updated commit hash after the merge

@kaushikbalasundar
kaushikbalasundar force-pushed the kaushik/add-ft-sensor-tool-transform branch from 516bfe9 to ab3d0ca Compare July 26, 2026 22:58

@JohnTGZ JohnTGZ left a comment

Copy link
Copy Markdown
Contributor

Choose a reason for hiding this comment

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

LGTM!

@JohnTGZ

JohnTGZ commented Jul 28, 2026

Copy link
Copy Markdown
Contributor

I have tested and verified the tool transformation. Merging it in

@JohnTGZ
JohnTGZ merged commit 4c6feec into phase_2 Jul 28, 2026
6 checks passed
@JohnTGZ
JohnTGZ deleted the kaushik/add-ft-sensor-tool-transform branch July 28, 2026 09:35
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.

2 participants