gps_smooth_problem.m