complete integration tests for kalman filter
add more integration tests