Digital and Kalman Filtering: an Introduction to Discrete-Time Filtering and Optimum Linear Estimation, Second Edition