add imu and gps sync for kf
Add gps measurement input