in comparison plot: use raw sensor value and not the value copied to the EKF (which depends on flags)
newDistData should only be true if distance measurement is valid
Merge pull request #12 from thomasgubler/gnddist

Test Harness Gnd dist fixes