【关于开发UWB模块所使用的二维和三维定位算法】
本文将介绍开发UWB模块中所使用到的二维定位算法(三点定位算法)
概念介绍
UWB室内定位系统,需要:
1/ 定位标签(label),需要电池供电,能够发射UWB信号来确定位置。
2/ 定位基站(base)是固定在一个地方的發射站,接收从label发送过来的信号;二维和三维需要的基站数量会不同。
3/ 综合并解读位置信息的算法和平台,可通过wifi模块实现无线传输,本文只集中讨论在电脑上解读传输信息的算法。
需要的材料
比如 BP-TWR-50 UWB 模块:
二维空间:三个base,一个label
三维空间:四个base,一个label
label会有一个显示屏,用以接收并计算base传送过来的距离信息。
算法
欧几里得距离 (Euclidean distance)
在数学中,Euclidean distance是欧氏空间中两点间的直线距离。使用这个距离,欧氏空间成为度量空间。
公式为:
d ( p , q ) = ∑ i = 1 n ( q i − p i ) 2 d(p,q) = \sqrt{\sum_{i=1}^n(q_i-p_i)^2} d(p,q)=i=1∑n<