基于卡尔曼滤波的chan-加权质心室内定位方法技术

本发明专利技术涉及一种基于卡尔曼滤波的chan‑加权质心室内定位方法，通过无线传感器网络测得待定位标签距各基站的距离；将其中一个基站为参考基站，计算待定位标签距其他基站与待定位标签距参考基站的距离差；将距离差数据输入卡尔曼滤波器进行滤波，得到消除部分噪声干扰的距离差；将经过滤波的距离差和基站坐标信息输入chan算法模型得到初始标签坐标；重复执行N次步骤S1至步骤S4，得到N个初始标签坐标；将N个初始标签坐标输入至一加权质心算法模型确定所述待定位标签最终坐标。本发明专利技术在chan定位算法的基础上，采用卡尔曼滤波算法对距离差测量值进行预处理，并采用加权质心算法对得到的初始定位结果进行优化处理，提高室内定位的稳定性和精确度。

【技术实现步骤摘要】
基于卡尔曼滤波的chan-加权质心室内定位方法
本专利技术涉及基于chan算法的室内定位技术，特别是一种基于卡尔曼滤波的chan-加权质心室内定位方法。
技术介绍
随着无线传感网络和物联网技术的快速发展，人们对于室内定位的需求越来越多，在商场，仓库，超市，医院，监狱等各个场所，对人或物的精确定位有利于提高人员物资的管理效率，在室外环境中，GPS能够提供高精度的定位，但是在室内环境下，由于墙壁，高楼等障碍物的遮挡，使得GPS难以发挥其优势。因此，很难找到一个适合所有室内场景的高精度室内定位方法。国内外众多学者也针对不同的场景提出了不同的定位方法。针对不同的定位参数，对标签(TAG)定位的方法可分为TOA(到达时间)，RSSI(接受信号强度指示)，AOA(到达角度)，TDOA(到达时间差)等，其中TDOA算法通过测量TAG到达两个基站(BS)的时间差方法得到相应的距离差，有效的抵消了单一测距的误差，针对TDOA模型，国内外学者研究了各种定位算法，如jacobi(雅可比迭代)，Fang算法，Taylor级数展开以及chan算法等。其中Fang算法只适用于有限的基站个数，不能使用冗余的测量值，Taylor算法需要一个比较精确的初始值，通过迭代得到最终解，若初始位置坐标与真实值误差较大，将导致结果发散。chan算法在测量误差较小且服从高斯分布时，其定位结果的均方根误差能够达到CRLB(克拉美罗下界)，但是在室内非视距环境的影响下，会导致测量误差增大，从而使chan算法定位精度急剧下降。为了改善chan算法的定位效果，人们提出了许多减小误差的方法，有的通过NLOS的鉴别，判断标签与基站受否为视距传播，对极大影响定位效果的非视距情况进行误差补偿，或者在chan算法求出初始定位后经过无迹卡尔曼滤波以及粒子滤波等方法进行二次定位，同时，有的学者结合chan和taylor算法的优点，利用taylor迭代可以获得较精确的解特点，对chan的定位结果进行修正，但是存在结果不收敛的隐患。
技术实现思路
本专利技术的目的在于提供一种基于卡尔曼滤波的chan-加权质心室内定位方法，以克服现有技术中存在的缺陷。为实现上述目的，本专利技术的技术方案是：一种基于卡尔曼滤波的chan-加权质心室内定位方法，按照如下步骤实现：步骤S1：通过无线传感器网络测得待定位标签到各基站的距离；步骤S2：将其中一个基站为参考基站，计算所述待定位标签到其他基站与所述待定位标签到参考基站的距离差；步骤S3：将距离差数据输入卡尔曼滤波器进行滤波，得到消除部分噪声干扰的距离差；步骤S4：将经过滤波的距离差和基站坐标信息输入chan算法模型得到初始标签坐标；步骤S5：重复执行N次步骤S1至步骤S4，得到N个初始标签坐标；步骤S6：将N个初始标签坐标输入至一加权质心算法模型确定所述待定位标签最终坐标。在本专利技术一实施例中，在所述步骤S3中，通过如下方式通过卡尔曼滤波器进行滤波：其中，表示第k-1次距离差向量的估计值，R2，1，R3，1，…Rm，1分别为待定位标签其他基站与待定位标签到参考基站的距离差，式中，将参考基站下标记为1，m代表基站总个数。Wk表示系统噪声向量，A为状态转移矩阵，Pk为第k次估计值的协方差矩阵，QK为系统噪声的协方差矩阵，Hk为量测矩阵，Zk为测量值向量，Rk为测量误差的协方差矩阵。在本专利技术一实施例中，在所述步骤S4中，通过chan算法模型得到初始标签坐标包括如下步骤：在二维空间定位中，当基站个数m＝3时，由chan算法模型能得到关于初始标签坐标的线性方程组，该方程组方程个数等于未知数个数，能求出唯一解，获取初始标签坐标；在三维空间定位中，当基站个数m＝4时，与二维空间定位相同，能获取初始标签坐标；随着基站个数的增加，方程组的方程个数大于未知数，方程无唯一解，其求解分为两步加权最小二乘法求解：第一次加权最小二乘为：其中，Za＝[ZpT，r1]T，Zp＝[x，y]Tr1表示标签到第一个基站的距离，Ψ是误差协方差矩阵，Ga，h为系数矩阵；以第一次得到的结果为基础进行第二次加权最小二乘：其中，Z′a＝[(x-x1)，(y-y1)]T，x，y表示标签坐标，x1，y1是基站1的坐标，Ψ′是误差协方差矩阵，G′a，h′为系数矩阵，以获取标签坐标Zp。在本专利技术一实施例中，在所述步骤S6中，还包括如下步骤：步骤S61：计算N个初始标签坐标中各初始标签坐标到各基站的距离差向量；步骤S62：将所述步骤S61所得的每个距离差向量与所述步骤S3所得的滤波后距离差求残差平方和，再开根号作为标签误差，记为error(i)i∈[1，N]，获取N个标签的误差和为：步骤S63：获取每个初始标签坐标的权重向量为：并按从大到小的顺序对权重向量中的元素进行排序；步骤S64：将N个初始标签坐标按照步骤S62获取的标签误差进行从小到大排序；按照误差小的分配高权重，误差大的分配小权重的原则，并采用点乘运算，对坐标进行加权求解。相较于现有技术，本专利技术具有以下有益效果：本专利技术提出的一种基于卡尔曼滤波的chan-加权质心室内定位方法，在现有chan定位算法的基础上，采用卡尔曼滤波算法对距离差测量值进行预处理，为chan提供了较精确的初值，并采用加权质心算法对得到的初始定位结果进行附加权重处理，有效抵消了误差的影响，提高了定位精度。附图说明图1为本专利技术一实施例中室内定位系统结构图。图2为本专利技术中基于卡尔曼滤波的chan-加权质心室内定位方法的整体算法流程图。图3是本专利技术一实施例中加权质心算法流程图。图4是本专利技术一实施例的实施效果图。具体实施方式下面结合附图，对本专利技术的技术方案进行具体说明。本专利技术提供一种基于卡尔曼滤波的chan-加权质心室内定位方法，按照如下步骤实现：步骤S1：通过无线传感器网络测得待定位标签距各基站的距离；步骤S2：将其中一个基站为参考基站，计算待定位标签距其他基站与待定位标签距参考基站的距离差；步骤S3：将距离差数据输入卡尔曼滤波器进行滤波，得到消除部分噪声干扰的距离差；步骤S4：将经过滤波的距离差和基站坐标信息输入chan算法模型得到初始标签坐标；步骤S5：重复执行N次步骤S1至步骤S4，得到N个初始标签坐标；步骤S6：将N个初始标签坐标输入至一加权质心算法模型确定待定位标签最终坐标。在本实施例中，在步骤S1中，记标签到各基站的距离即标签到无线传感器网络中第i个基站的距离Ri。在本实施例中，在步骤S2中，距离差为标签到其他基站与标签到参考基站的距离差，记为：R2，1，R3，1，…Rm，1，式中，将参考基站下标记为1，m代表基站总个数。在本实施例中，在步骤S3中，通过如下方式通过卡尔曼滤波器进行滤波：其中，表示第k-1次距离差向量的估计值，wk表示系统噪声向量，A为状态转移矩阵，Pk为第k次估计值的协方差矩阵，QK为系统噪声的协方差矩阵，Hk为量测矩阵，ZK为测量值向量，Rk为测量误差的协方差矩阵。只要给出初始值X1，P1，以及一系列的量测值Zk，就可得到经过滤波的距离差。在本实施例中，在步骤S4中，通过chan算法模型得到初始标签坐标包括如下步骤：在二维空间定位中，当基站个数m＝3时，由chan算法模型能得到关于初始标签坐标的线性方程组，该方程组方程个数等于未知数个数，能求出唯本文档来自技高网...

【技术保护点】
1.一种基于卡尔曼滤波的chan‑加权质心室内定位方法，其特征在于，按照如下步骤实现：步骤S1：通过无线传感器网络测得待定位标签距到各基站的距离；步骤S2：将其中一个基站为参考基站，计算所述待定位标签到其他基站与所述待定位标签到参考基站的距离差；步骤S3：将距离差数据输入卡尔曼滤波器进行滤波，得到消除部分噪声干扰的距离差；步骤S4：将经过滤波的距离差和基站坐标信息输入chan算法模型得到初始标签坐标；步骤S5：重复执行N次步骤S1至步骤S4，得到N个初始标签坐标；步骤S6：将N个初始标签坐标输入至一加权质心算法模型确定所述待定位标签最终坐标。

【技术特征摘要】
1.一种基于卡尔曼滤波的chan-加权质心室内定位方法，其特征在于，按照如下步骤实现：步骤S1：通过无线传感器网络测得待定位标签距到各基站的距离；步骤S2：将其中一个基站为参考基站，计算所述待定位标签到其他基站与所述待定位标签到参考基站的距离差；步骤S3：将距离差数据输入卡尔曼滤波器进行滤波，得到消除部分噪声干扰的距离差；步骤S4：将经过滤波的距离差和基站坐标信息输入chan算法模型得到初始标签坐标；步骤S5：重复执行N次步骤S1至步骤S4，得到N个初始标签坐标；步骤S6：将N个初始标签坐标输入至一加权质心算法模型确定所述待定位标签最终坐标。2.根据权利要求1所述的基于卡尔曼滤波的chan-加权质心室内定位方法，其特征在于，在所述步骤S3中，通过如下方式通过卡尔曼滤波器进行滤波：其中，表示第k-1次距离差向量的估计值，R2,1,R3,1,…Rm,1分别为待定位标签到其他基站与待定位标签到参考基站的距离差，Wk表示系统噪声向量，A为状态转移矩阵，Pk为第k次估计值的协方差矩阵，QK为系统噪声的协方差矩阵，Hk为量测矩阵，ZK为测量值向量，Rk为测量误差的协方差矩阵。3.根据权利要求1所述的基于卡尔曼滤波的chan-加权质心室内定位方法，其特征在于，在所述步骤S4中，通过chan算法模型得到初始标签坐标包括如下步骤：在二维空间定位中，当基站个数m＝3时，由chan算法模型能得到关于初始标签坐标的线性...

【专利技术属性】
技术研发人员：林伟，张小权，
申请(专利权)人：福州大学，
类型：发明
国别省市：福建,35