Tweaks to Kalman Filter to generate better result