Remove old Kalman Filter

We were previously running the old KF (that had spatial states and didn't use the constraint equations) in parallel with the new KF. Now the new KF is more thoroughly tested we should remove the old one.