Kalman filter library developed in C++