Continuous Kalman Filter Matlab Code