[发明专利]一种基于RSSI的近距离精确定位方法

权利要求书

1.一种基于RSSI的近距离精确定位方法，其特征在于该方法首先进行参数的标定，然后再进行定位，所述的RSSI为接收信号强度；

参数标定具体是：

第1步：固定低频基站位置和发射功率，依次分别选取等间隔距离的信号接收位置，d_i距离测量出对应的接收信号强度值p_i，如此便获得了n组(d_i,p_i)，设d_i＜d_i+1，此时将d_i距离时的常数参数k、信号衰减因子α与d_i+1时的常数参数k、信号衰减因子α看成近似相等；

第2步：对于(d₁,p₁),(d₂,p₂)有方程组

$\left\{\begin{array}{c}{d}_1={\left(\frac{k}{p_1}\right)}^{\frac{1}{\mathrm{\α}}}\\ d_2={\left(\frac{k}{p_2}\right)}^{\frac{1}{\mathrm{\α}}}\end{array}\right.$

由方程组可计算出k和α值，记为k_1,2,α_1,2；同理对于(d_i-1,p_i-1),(d_i,p_i)有方程组

$\left\{\begin{array}{c}{d}_{i-1}={\left(\frac{k}{p_{i-1}}\right)}^{\frac{1}{\mathrm{\α}}}\\ d_i={\left(\frac{k}{p_i}\right)}^{\frac{1}{\mathrm{\α}}}\end{array}\right.$

可计算出k_i-1,i,α_i-1,i；如此便可获得k_1,2,k_2,3,…k_i-1,i…,k_n-1,n和α_1,2,α_2,3,…α_i-1,i…,α_n-1,n；

第3步：令此时组成(n-1)对二元组(p_i-1,i,k_i-1,i)和(p_i-1,i,α_i-1,i)，i＝2,…,n；

第4步：利用多项式拟合出函数映射k(p):p→k，α(p):p→α；代入公式得到距离值d关于p的解析式

通过以上可得到RSSI到距离的映射系统，达到精确测距的目的；接下来就要完成测距的后续工作：利用未知节点与多个不同信标节点的距离数据进行未知节点的精确定位，具体是：

(1)采用与标定时完全相同的N个低频基站B₁,B₂,B₃,…,B_N作为信标节点；建立空间直角坐标系Oxyz，信标节点在Oxyz下三维坐标依次为B₁(x₁,y₁,z₁)，B₂(x₂,y₂,z₂)，B₃(x₃,y₃,z₃)，…，B_N(x_N,y_N,z_N)；依次开启第i个低频基站发射低频信号，测得未知节点接收到的接收信号强度为P_i，根据公式计算出距离d_i；

(2)于是，得到N个距离值d₁，d₂，d₃，…，d_N和N个接收信号强度P₁，P₂，P₃，…，P_N；即这N个距离值分别对应N个低频基站B₁,B₂,B₃,…,B_n发射信号在未知节点处的接收信号强度；

(3)从d₁，d₂，d₃，…，d_N中挑选出4个距离值，一共有种挑选方案，依次编号为1,2,3,…m…,假设其中某一编号m方案中的4个距离值为d_m1,d_m2,d_m3,d_m4，其中1≤d_m1＜d_m2＜d_m3＜d_m4≤N，对应的四个低频基站记为B_m1(x_m1,y_m1,z_m1)，B_m2(x_m2,y_m2,z_m2)，B_m3(x_m3,y_m3,z_m3)，B_m4(x_m4,y_m4,z_m4)；假设未知节点在Oxyz下的三维坐标为(x_m,y_m,z_m)，得到方程组

$\left\{\begin{array}{c}{(x_m-x_{m1})}^2+{(y_m-y_{m1})}^2+{(z_m-z_{m1})}^2={d_{m1}}^2\\ {(x_m-x_{m2})}^2+{(y_m-y_{m2})}^2+{(z_m-z_{m2})}^2={d_{m2}}^2\\ {(x_m-x_{m3})}^2+{(y_m-y_{m3})}^2+{(z_m-z_{m3})}^2={d_{m3}}^2\\ {(x_m-x_{m4})}^2+{(y_m-y_{m4})}^2+{(z_m-z_{m4})}^2={d_{m4}}^2\end{array}\right.$

为简化计算，将非线性方程组后面每个等式减去第一个等式得到3*3线性方程组，解线性方程组计算出(x_m,y_m,z_m)；

(4)对应不同的m得到个未知节点的三维坐标估算值(x₁,y₁,z₁)，(x₂,y₂,z₂)，(x₃,y₃,z₃)，…，(x_m,y_m,z_m)…，

(5)采用近似的高斯滤波算法对获得的个三维坐标估算值进行滤波；方法如下：

$u=\frac{1}{C_N^4}\underset{i=1}{\overset{C_N^4}{\Σ}}(x_i,y_i,z_i),\mathrm{\σ}=\sqrt{\frac{1}{C_N^4}\underset{i=1}{\overset{C_N^4}{\Σ}}{|(x_i,y_i,z_i)-u|}^2},$

其中u为期望，σ为标准差，且此处对三维坐标的运算视作对坐标各元素的运算；

以|(x_i,y_i,z_i)-u|≤1.2σ的值域为区间筛选所有的三维坐标估算值(x_i,y_i,z_i)；将筛选后的坐标点再次采用同样方法处理；对第二次筛选后的坐标点进行均值处理，最终得到未知节点的三维坐标值(x,y,z)。