check forcetorque data
ensure that the timestamp is the right one
TODO use GetLastMeasureTime, not GetLastUpdateTime
TODO check orientation data
TODO ensure that the timestamp is the right one