Fundamentals of Kalman Filtering: A Practical Approach