fix to variance update, merge sensor data before applying to position to eliminate a variance calculation, tweak constants