Implement Kalman handler struct & proper measurement covariance init