Added kalman filtering script for microcone. Also, updated kalman filtering to include the state covariance to avoid the degenerating covariance problem