Velocity and Position Fusion : Added more robust data validity checks

The checks are now applied to position or height or velocity as measurement groups, and
a retry time has been added to each group to force a fusion if more than a specified number of seconds without fusing measurements.