Implement Kalman handler struct
Compile success - Tests looking good