Skip to content
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

fix attaching both IMU and FTs as MAS network wrappers #167

Merged
merged 5 commits into from
Feb 9, 2023

Conversation

HosameldinMohamed
Copy link
Collaborator

This is a part of the investigation we are doing with @mebbaid using ergoCubGazeboV1 icub-tech-iit/ergocub-software#35

We couldn't attach both the IMU and the FTs as MAS.

With the previous logic before this PR, the software doesn't distinguish between them. As it seems both devices types implement all the MAS interfaces, including the interfaces ISixAxisForceTorqueSensors and IThreeAxisLinearAccelerometers.

@@ -1740,6 +1744,7 @@ bool WholeBodyDynamicsDevice::attachAllFTs(const PolyDriverList& p)
return false;
}

yDebug() << "Elobaid: remappedMASInterfaces= " << remappedMASInterfaces.ftMultiSensors->getNrOfSixAxisForceTorqueSensors();
Copy link
Member

Choose a reason for hiding this comment

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

Probably this can be deleted?

Copy link
Collaborator Author

Choose a reason for hiding this comment

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

Ah yes!, done in fca9e18

Copy link
Member

@traversaro traversaro left a comment

Choose a reason for hiding this comment

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

Just small comment.

@traversaro
Copy link
Member

For the CI you can see robotology/idyntree-yarp-tools#42 .

@HosameldinMohamed HosameldinMohamed changed the title fix attaching both IMU and FTs as MAS fix attaching both IMU and FTs as MAS in simulation Feb 9, 2023
@HosameldinMohamed
Copy link
Collaborator Author

For the CI you can see robotology/idyntree-yarp-tools#42 .

Thanks for the info, I'll do it in a new PR to keep it organized!

@HosameldinMohamed HosameldinMohamed marked this pull request as ready for review February 9, 2023 08:38
@HosameldinMohamed
Copy link
Collaborator Author

From recent tests with real robots (ergoCub, iCubGenova09), the issue solved by this PR happens only when attaching network wrappers multipleAnalogSensorServer because they implement all the MAS interfaces.

While attaching directly the FT devices embObjMultipleFTsensors and the IMU devices embObjIMU goes through with no errors because these devices implement only the corresponding interfaces.

CC @GiulioRomualdi

@HosameldinMohamed HosameldinMohamed changed the title fix attaching both IMU and FTs as MAS in simulation fix attaching both IMU and FTs as MAS network wrappers Feb 9, 2023
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