GPS漂移点过滤算法
2021-11-11 11:40:36 1 举报GPS漂移点过滤算法主要为了处理在做户外出行轨迹记录的时候，往往因为基站切换，导致定位点偏差过大，于是需要纠偏，实现轨迹纠偏。
作者其他创作
大纲/内容
将P点加入PList集合中
否
取出PList，为有效数据
是否超过最大偏移？
是
是否为第一个定位点？
不处理
WT为疑似偏移权重点
PList数据>5?
将P点加入PTList并更新WT
PTList数据>5?
计算P与WT之间距离
W为权重点
WT是否为空？
W是否为空？
取出PList，为有效数据并清空
将P点加入PList并更新W
设置P点PT1，计算WT，并把P点加入PTList集合中
PList为有效点集合
计算P与P1点之间距离
取出PTList，为有效数据并清空
计算P与W点之间距离
P为当前坐标点
PT1为上一个疑似偏移点
收到定位点P
将P点加入PList并更新W，清空PTList并设置WT为空
P1为上一个有效点
PTList为疑似偏移点集合
0 条评论
下一页
