定位有效性判定方法
可根据下面数据综合判定当前uwb定位是否可靠,进而滤除或者切换到其他定位
- pos:标签当前坐标
- pos_noise:标签当前坐标噪声,可大致反应标签和当前参与定位的信标区域的内外关系,离区域中心越远则越大
- anchor_info:
- addr:信标id
- rx_rssi:信标信号的接收信号强度
- rx_rate:信标信号的收包率
为方便描述,下文用内部表示有信标覆盖的区域,外部表示无信标覆盖的区域
pos
正确部署情况下,实际在内部时,定位结果一定不会到外部,但只要定位结果到了外部,实际要么在外部,要么在“内部”定位较差实际未覆盖的区域,都可以滤掉
pos_noise
对于绝大部分场景,无三维定位区域时,只用关注pos_noise的x y分量,通常,在区域内,可大致使用以下判定来判定定位是否有效
pos_noise_x > 2 && pos_noise_y > 2
实际应用中也可适当调整阈值,但注意过小时容易滤除正常定位结果
anchor_info
在内部时,标签可 以稳定收到周边信标信号(但注意,信号是分批到达的,假设标签周边有多个定位区域,则标签每次定位数据可能是其中一个区域的信号),且信号强度和收包率应该都较高,而在外部则相反
信号强度和距离有关,算法可能不便做到通用,但部分场景,使用信号强度可更稳定的判定内外,酌情考虑使用
收包率则会有一段时间的延迟,可能影响切换实时性,但此项不依赖距离,不依赖设备,有一定的通用性,可考虑按如下方式使用
滑动窗口存储近n(如8)次定位结果,计算n次定位结果的anchor_info.rx_rate的中位数,中位数需要大于一个阈值(如60%)