Fixed the kalman equations and updated run_kalman.sh