步骤1:对导航轨迹中的轨迹点进行去噪处理：

步骤2:对导航轨迹中的缺失点进行补全处理：

步骤3:采用卡尔曼滤波对经过去噪和补全后的导航轨迹点，进行偏移矫正。