DistanceMeasurements Testing + Sensor Model Tweaks

Fully tested DistanceMeasurements class, and all of its methods (mainly
the getProbabilityByDifference). Through that, found and fixed a few
logic errors.