Tuned KF

Switched to using 1st order model and tuned uncertainty estimates.