TESTS: Added tests for kalman.py