Python Kalman Filtering Matlab