pauls estimator: Added NaN guard before publishing

@thomasgubler @julianoes This is an additional guard against NaN values.