-
Notifications
You must be signed in to change notification settings - Fork 13
Conversation
@@ -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) |
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.
This needs to be removed because wholeBodyDynamics can be used with robots that have an arbitrary number of FT sensors.
break; | ||
} | ||
} | ||
if( isNaN ) |
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 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; |
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 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.
Ok, I'll do the modifications and merge |
4eeca94
to
30ec03f
Compare
@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