Skip to content
This repository has been archived by the owner on Apr 6, 2020. It is now read-only.

Fixed NaN during calibration #243

Merged
merged 2 commits into from
Sep 29, 2017
Merged

Fixed NaN during calibration #243

merged 2 commits into from
Sep 29, 2017

Conversation

francesco-romano
Copy link
Collaborator

@francesco-romano francesco-romano commented Sep 29, 2017

@traversaro we have to understand if we want to keep the prints or not.

Of course, once we decide we can divide the PR in two commits: the actual fix and the prints

@@ -1088,6 +1088,29 @@ bool WholeBodyDynamicsDevice::readFTSensors(bool verbose)
yWarning() << "wholeBodyDynamics warning : FT sensor " << sensorName << " was not readed correctly, using old measurement";
}

if (ftMeasurement.size() != 6)
Copy link
Contributor

Choose a reason for hiding this comment

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

This needs to be removed because wholeBodyDynamics can be used with robots that have an arbitrary number of FT sensors.

break;
}
}
if( isNaN )
Copy link
Contributor

Choose a reason for hiding this comment

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

I think this check should remain, sanity checking on data read from another software module is a good practice.

@@ -1210,12 +1233,47 @@ void WholeBodyDynamicsDevice::filterSensorsAndRemoveSensorOffsets()

iDynTree::Wrench rawFTMeasureWithOffsetRemoved = ftProcessors[ft].filt(rawFTMeasure);


bool isNaN = false;
Copy link
Contributor

Choose a reason for hiding this comment

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

I would remove this check, in the end once we removed the bugs from the processing of data, this should always be fine, and I don't think it make sense to have checks on all the points of the code.

@francesco-romano
Copy link
Collaborator Author

Ok, I'll do the modifications and merge

Sign up for free to subscribe to this conversation on GitHub. Already have an account? Sign in.
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants