用于室内定位的基于实时轨迹动态进行二维跳点修正方法

摘要

本发明提供了用于室内定位的基于实时轨迹动态进行二维跳点修正方法，包括：步骤1，获取当前二维定位解算结果ff和所有历史解算的定位结果放入Fn；步骤2，若解算结果条数sizefn等于0，将ff存入Fn作为历史轨迹数据，否则转步骤3；步骤3，计算阈值threshold和距离dis；步骤4，sizefn大于1转步骤5，若dis大于threshold，删除Fn最后一条，否则将ff存入Fn末尾；步骤5，dis小于threshold，转步骤7，否则转步骤6；步骤6，重算dis，dis大于threshold则循环步骤6，否则转步骤7；步骤7，将ff结果存入Fn的末尾作为历史解算数据。