made some test changes in ekf.m
Merge branch 'test2'