EKF2: range measurement rejection in rain/fog

[haumarco]

When there's rain or fog the range sensor can provide wrong distance measurements. The goal was to create somewhat of a sanity check for the distance sensor while moving horizontally. Currently we only have the kin-consistency check without horizontal movement.

The current implementation is dependent on a new param and the magic hardcoded factor 2.