对csv文件中位置(x y z)进行处理,并采用扩展卡尔曼滤波方式进行数据处理。是个EKF很好的实例