基于变参考历元TDCP/MEMS IMU的实时动态定位方法及系统

专利主权项内容

1.基于变参考历元TDCP/MEMSIMU的实时动态定位方法，其特征在于，包括以下步骤：步骤1，载体初始历元位置、姿态信息获取；步骤2，变参考历元确定及TDCP观测量构建；无时延情况下：令t表示当前的GNSS观测历元，记为当前历元，t表示当前历元的参考历元，其中tt，i为非负整数，j为正整数，且t和t的时间差为GNSS采样间隔t的整数倍，t表示初始历元；jii<jijGNSS0当前历元的TDCP观测量的等效距离表示为其中λ表示波长，/>表示载波相位观测量；对参考历元的双频伪距和载波相位观测数据进行实时存储；参考历元确定准则基于模糊度解算时的Ratio值R和载波相位观测量组建的无几何观测量判断条件为：1)模糊度解算时的Ratio值R(t)大于给定阈值R；j02)所有载波相位观测量构建的无几何观测量满足下式：式中，表示载波相位标准差，θ表示卫星高度角；ele在上述两个判断条件都满足的条件下，则将t设定为下一个当前历元的参考历元；j在上述两个判断条件至少一个不满足的情况下，则下一个当前历元的参考历元仍然为t；i步骤3，基于变参考历元TDCP/MEMS的载体位置估计；无时延情况下：在有GNSS观测的历元，即GNSS观测历元，TDCP最小二乘解估算的位置信息表示为将该位置信息与INS机械编排得到的位置信息的差值作为滤波观测量，参与TDCP/MEMSIMU松组合的量测更新，并将滤波后的位置表示为/>由于此时能够同步获取基站和移动站的GNSS观测数据，此位置滤波解将构建三个伪观测方程与伪距和载波相位双差观测方程共同参与RTK解算；若此历元为参考历元，则该历元的位置表示为RTK获取的最优解/>否则，位置/>为当前历元的位置信息；在无GNSS观测的历元，仅有IMU输出值，在最邻近GNSS观测历元位置基础上，采用INS机械编排的方式获取该历元的位置信息；当前历元定位结束，下一个历元无GNSS观测时，则对无GNSS观测的历元重复上述步骤3内容获取位置信息，下一个历元有GNSS观测时，则将该GNSS观测历元设置为当前历元，重复上述步骤2～3内容进行动态定位。