Skip to content
New issue

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

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

Already on GitHub? # to your account

Fix location of collision element in iCubGazeboV3 model #251

Merged
merged 1 commit into from
Sep 20, 2023

Conversation

traversaro
Copy link
Member

Fix robotology/icub-models#209 .

In #243 the location of the frames of the links of the soles ( with names like (r|l)_foot_(front|back) ) have been moved to the origin of the FT sensors that connect them with the (r|l)_ankle_2 link. All the quantities expressed in this frame have been automatically modified to account for its new location by the simmechanics-to-urdf script, except for the location of the assigned collision, that are hardcoded in the .yaml file . This created a regression, has it effectly moved the sole assigned collisions up, so the robot was actually touching the ground with the (r|l)_ankle_2 links, that do not have any contact parameter assigned.

This commit fixes the situation by taking the existing z value of the assigned collision origin, and adding the offset with which the other elements (visual, inertial) have been modified (see robotology/icub-models@799ae07#diff-9d811d6ae4a80f936a2466cdc3b852ac4fb6d6e3a4cd40d2c42e794f42d6415aL260), to obtain:

newCollisionZ = oldCollisionZ + (newVisualZ - oldVisualZ)
= 0.003 + (0.9241470000000105 - 0.9464470000000105 )
= -0.0193

Fix robotology/icub-models#209 .

In #243 the location of the frames of the links of the soles ( with names like `(r|l)_foot_(front|back)` ) have been moved to the origin of the FT sensors that connect them with the `(r|l)_ankle_2` link. All the quantities expressed in this frame have been automatically modified to account for its new location by the simmechanics-to-urdf script, except for the location of the assigned collision, that are hardcoded in the .yaml file . This created a regression, has it effectly moved the sole assigned collisions up, so the robot was actually touching the ground with the (r|l)_ankle_2 links, that do not have any contact parameter assigned.

This commit fixes the situation by taking the existing z value of the assigned collision origin, and adding the offset with which the other elements (visual, inertial) have been modified 
(see robotology/icub-models@799ae07#diff-9d811d6ae4a80f936a2466cdc3b852ac4fb6d6e3a4cd40d2c42e794f42d6415aL260), to obtain:

newCollisionZ = oldCollisionZ + (newVisualZ - oldVisualZ)
              = 0.003         + (0.9241470000000105     - 0.9464470000000105    )
              = -0.0193
@traversaro traversaro changed the title Fix location of collisions element in iCubGazeboV3 model Fix location of collision element in iCubGazeboV3 model Sep 20, 2023
@traversaro traversaro requested a review from Nicogene September 20, 2023 12:14
@traversaro traversaro merged commit dbc36cc into master Sep 20, 2023
@traversaro traversaro deleted the fix-icub-models-209 branch September 20, 2023 13:10
@traversaro
Copy link
Member Author

Similar to icub-tech-iit/ergocub-software#175 .

# for free to join this conversation on GitHub. Already have an account? # to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

iCubGazeboV3 model feet contacts are unstable in Gazebo v11.13
2 participants