Stochastic models, estimation and control - Maybeck, Peter S.