Update KF_Extraction.m