Fundamentals of Kalman filtering : a practical approach