welch & bishop , an introduction to the kalman filter 2 1 the discrete kalman filter in 1960 .
stochastic models , estimation and control .