separate Kalman Filters

- P is now stable for each modality
- on/off switch for EMCs or OCS
- on/off switch for velocity update
- on/off switch for UKF/KF
all 8 combinations should work