Matlab scripts for smoothing of GPS INS