Changed the point at which process noise covariance is added to the state covariance, to make it consistent with the measurement step
Changed the point at which process noise covariance is added to the state covariance, to make it consistent with the measurement step

sfwa/ukf,sfwa/ukf