(KalmanFilter) : Revive old KalmanFilter code. We can select both old KalmanFilter and new KalmanFilter.
Merge remote-tracking branch 'origin/master' into revive_old_kf_codes_3
Merge pull request #317 from snozawa/revive_old_kf_codes

Revive old KalmanFilter code