一种基于R-T-S平滑的POS系统双捷联解算后处理方法，该方法首先利用载波相位差分GPS数据与惯性数据进行捷联解算及Kalman滤波，得到GPS采样点的组合滤波值及相应滤波参数，然后对滤波参数进行反向R-T-S固定区间平滑，得到Kalman滤波参数的误差校正值，利用该值对GPS采样点的捷联解算值进行校正可以得到GPS采样点的平滑输出。在每相邻GPS采样点之间采用双向捷联解算的方法，提高GPS采样点之间的POS系统输出精度。本发明专利技术具有同时提高POS系统GPS采样点输出精度以及滤波区间输出精度的特点，尤其在GPS信号失锁的情况下，能有效提高POS系统事后处理输出精度。
【技术实现步骤摘要】
【技术保护点】
一种基于R?T?S平滑的POS系统双捷联解算后处理方法，其特征在于包括下列步骤：（1）采集飞行试验或车载试验过程中POS系统输出的惯性测量数据及GPS基站数据及GPS流动站数据；（2）对步骤（1）中获取的惯性测量数据进行温度误差补偿，补偿后的惯性数据包括三轴陀螺仪数据和三轴加速度计数据x,y,z轴的陀螺仪数据分别为x,y,z轴的加速度计数据分别为；对步骤（1）中获取的GPS数据进行载波相位差分处理，处理后其位置包括纬度Lgps，经度λgps及高度Hgps，速度包括东向速度VEgps，北向速度VNgps和天向速度VUgps；（3）利用步骤（2）补偿后的惯性数据及载波相位差分GPS数据进行捷联解算及Kalman滤波，记录每个GPS采样点的捷联解算输出和Kalman滤波参数，捷联解算输出包括位置、速度、姿态，其中位置包括纬度Li，经度λi及高度Hi，速度包括东向速度VEi，北向速度VNi，天向速度VUi,姿态包括航向角ψi，俯仰角θi，滚动角γi；Kalman滤波参数包括离散化状态转移矩阵预测协方差矩阵状态预测值协方差矩阵状态估计值其中，带有下标kf的参数是由Kalman滤波计算估计得到的结果，带有上标’?‘和’+’的参数分别为预测结果和估计结果，k和k?1分别表示第k和第k?1个GPS采样点；（4）从最后一个GPS采样点开始，利用步骤（3）记录的与其相邻的前一GPS采样点处的捷联解算输出及Kalman滤波参数，进行反向R?T?S平滑解算，得到其相邻的前一GPS采样点平滑后的误差状态估计和误差状态协方差矩阵Ps，利用平滑的误差状态估计对前一GPS采样点处的捷联解算结果进行修正，得到其平滑位置、速度、 姿态，其中位置包括纬度Ls，经度λs及高度Hs，速度包括东向速度VE,s，北向速度VN,s，天向速度VU,s，姿态包括航向角ψs，俯仰角θs，滚动角γs，其中带有下标s的参数表示是经过平滑后的结果；依次向前迭代进行R?T?S平滑解算，直至计算至第一个GPS采样点，得到每一个GPS采样点的平滑结果。（5）从第一个GPS采样点开始，在相邻两个GPS采样点的滤波区间内执行双捷联解算，以左GPS采样点的R?T?S平滑位置、速度、姿态作为正向捷联解算的初始值，从左GPS采样点至滤波区间中点执行正向捷联解算；以右GPS采样点的R?T?S平滑位置、速度、姿态作为反向捷联解算的初始值，从右GPS采样点至滤波区间中点，按时间反向顺序执行反向捷联解算，得到每相邻两个GPS采样点构成的滤波区间的POS系统输出，依次向后迭代计算至最后一个GPS采样点。FDA00003494347200011.jpg,FDA00003494347200012.jpg,FDA00003494347200013.jpg,FDA00003494347200014.jpg,FDA00003494347200015.jpg,FDA00003494347200016.jpg,FDA00003494347200017.jpg,FDA00003494347200018.jpg,FDA00003494347200019.jpg,FDA000034943472000110.jpg,FDA000034943472000111.jpg,FDA000034943472000112.jpg...
【技术特征摘要】
【专利技术属性】
技术研发人员：房建成，马艳海，李建利，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。