基于高度辅助修正的室内定位的TDOA定位方法技术

本发明专利技术公开了一种基于高度辅助修正的室内定位的TDOA定位方法，包括以下步骤：步骤(1)：在室内立体环境下，设定包括主基站在内有M个基站；得到目标节点无线信号到达各个基站的时间；步骤(2)：输入目标节点的经验高度或者利用辅助传感器得到的测量高度

【技术实现步骤摘要】
基于高度辅助修正的室内定位的TDOA定位方法
本专利技术属于无线定位技术，涉及一种可用于超宽带、CSS等基于到达时间差测量的室内定位系统的位置解算的基于高度辅助修正的室内定位的TDOA定位方法。
技术介绍
室内定位是指在室内环境中，采用WiFi、蓝牙、ZigBee、RFID、CSS，超宽带等其他技术来实现位置定位。其中CSS、超宽带无线定位系统中，广泛采用TDOA来完成位置解算，TDOA通过测量信号到达不同基站的时间差来估算目标节点的坐标值，多个TDOA测量值可以构成一组关于目标节点位置的双曲线方程组，但常用的解析算法如Fang、Chan、Friedlander等不能满足室内定位的需求，在于室内环境通常属于近场定位，忽略基站的高度进行二维定位会导致水平位置的定位偏差；结合室内环境，基站往往需要沿四周布设，定位基站通常为圆周布设，而目前常用的解析算法，在基站为圆周布设分布时，在近场会出现定位坐标误差偏大的情况，无法进行有效定位。为了克服以上缺陷，满足实际室内定位应用的需要，必须针对室内定位的特点，寻求适应室内定位环境的定位方法。
技术实现思路
本专利技术针对现有定位方法在室内定位场景时的不足，提出一种基于高度辅助修正的室内定位的TDOA定位方法。为解决上述技术问题，本专利技术采用的技术方案是，该基于高度辅助修正的室内定位的TDOA定位方法，包括以下步骤：步骤(1)：在室内立体环境下，设定包括主基站在内有M个基站；采用有线或者无线同步，使主基站和从基站位于一个基准时钟，目标节点发送无线信号，定位基站得到目标节点无线信号到达各个基站的时间；步骤(2)：输入目标节点的经验高度或者利用辅助传感器得到的测量高度并读取基站与目标节点的TOA原始数据；以主基站为参考基站，各个从基站的到达时间和主基站的到达时间做差，处理得到M-1个TDOA值；步骤(3)：根据定位基站的位置，以及目标节点的到达时差，来解算目标节点的位置。在上述技术方案中，针对传统TDOA解析算法在近场定位，由于忽略基站高度，基站圆周分布时定位精度下降的问题，通过引入高度辅助修正，并对传统TDOA解析算法数学模型进行改进，通过分离高度辅助修正下，TDOA距差项，形成新的解算模型；该方法利用高度辅助修正的方法，将三维环境的定位问题转化为高度已知的二维定位问题。优选的，在所述步骤(3)中，定义为目标节点的位置坐标，其中是目标节点的经验高度或者利用辅助传感器得到的测量高度，其中xi＝[xi,yi,zi]T为基站的已知坐标信息，基站的数目为M,且M≥4，则TDOA量测距离为：ri,1＝di,1+ni,1i＝2,3,...,M(1)其中，ni,1为量测距差误差(噪声)，di,1＝di-d1，di为标签到第i个基站之间的距离。优选的，在所述步骤(3)中，该定位方法的位置解算方程为：其中，η＝[x-x1y-y1]T，m＝[m2,1…mM,1]T。其中，R1为目标节点到主基站之间距离。优选的，针对位置解算方程，考虑目标节点坐标和到主基站的距离的约束关系，采用最大似然估计，则目标节点的位置解算问题转化为η的估计问题：其中，W＝(E{mmT})-1，为目标节点到第1个基站之间距离的估计，若定义则约束条件等价于假设误差ni是不相关的均值为零方差为的高斯白噪声，并且将ni,1建模为ni-n1；忽略二阶误差单元，则加权矩阵近似为这里，为目标节点到各个从基站的距离。优选的，在所述步骤(3)中，步骤3.1：构建拉格朗日函数并使拉格朗日函数最小，求得并使拉格朗日函数最小，即分别对未知量进行微分，并令其为零，求得及关于的一元二次方程的表达式，具体为：其中：步骤3.2：拉格朗日乘子求解，定义A＝[Gg2]，将带入约束条件，经过特征值分解，可得到关于拉格朗日乘子的多项式为：其中，ATWAΣ＝Udiag(ξ1,ξ2,ξ3)U-1，[u1,u2,u3]T＝UTΣATWb，[w1,w2,w3]T＝U-1ATWb，步骤3.3：求解ATWA和Σ的广义特征值，并将特征值按升序排列分别为β0,β1,β2，确立区间I＝(1/β2,1/β1)，求解多项式，并选择选择位于区间I的实根作为最优拉格朗日乘子λopt；步骤3.4：根据关于的一元二次方程，求解并选择最优当的两个根都小于0时，直接取为0；当存在一正根和一负根时，选择正根；当存在两正根时，根据和信号强度的匹配度，选择匹配度最高的步骤3.5：根据公式(9)求解目标节点的坐标；步骤3.6：更新加权矩阵，重复步骤3.2到步骤3.5，得到目标节点的二次估计。在构造新的位置解算的数学模型中，求解拉格朗日乘子，采用新的方法选择拉格朗日乘子；建立关于的一元二次方程及目标水平坐标的方程；利用信号强度的一致性约束及通信距离的约束，选择并利用新数学模型下的目标水平坐标求解公式计算位置；为目标节点到主基站之间距离的估计。本专利技术的有益效果还在于，在构建了新的位置解算数学模型中，本专利技术能够减少室内定位近场时由于忽略基站高度所引起的位置偏差，并能够适用于基站圆周分布时的室内定位，相比Chan定位算法，更加适用于室内定位的近场定位以及基站圆周布设定位。附图说明图1基站分布图；图2定位方法流程图；图3Chan定位算法近场定位GDOP图；图4本专利技术方法近场定位效果GDOP图；具体实施方式下面结合附图以及具体实施例来详细说明本专利技术，以便更好的理解本专利技术，但本专利技术的保护范围并不限于此。本专利技术的基于高度辅助修正的室内定位的TDOA定位方法，包括以下步骤：步骤(1)：在室内立体环境下，设定包括主基站在内有M个基站；采用有线或者无线同步，使主基站和从基站位于一个基准时钟，目标节点发送无线信号，定位基站得到目标节点无线信号到达各个基站的时间；步骤(2)：输入目标节点的经验高度或者利用辅助传感器得到的测量高度并读取基站与目标节点的TOA原始数据；以主基站为参考基站，各个从基站的到达时间和主基站的到达时间做差，处理得到M-1个TDOA值；步骤(3)：根据定位基站的位置，以及目标节点的到达时差，来解算目标节点的位置。在所述步骤(3)中，定义为目标节点的位置坐标，其中是目标节点的经验高度或者利用辅助传感器得到的测量高度，其中xi＝[xi,yi,zi]T为基站的已知坐标信息，基站的数目为M,且M≥4，则TDOA量测距离为：ri,1＝di,1+ni,1i＝2,3,...,M(1)其中，ni,1为量测距差误差(噪声)，di,1＝di-d1，di为目标节点到第i个基站之间的距离，即将(2)带入到(1)中，则：将(3)的两边平方，并且引入一个中间变量R1此时，我们能得到下列方程：其中，TDOA定位，即根据TDOA量测及基站的已知位置信息来估计目标节点的位置，我们通过将目标节点的高度作为已知量，通过拆分高度辅助修正项，距差项，在所述步骤(3)中，该定位方法的位置解算方程为：其中，η＝[x-x1y-y1]T，m＝[m2,1…mM,1]T；针对位置解算方程，考虑目标节点坐标和到主基站的距离的约束关系，采用最大似然估计，则目标节点的位置解算问题转化为η的估计问题：其中，W＝(E{mmT})-1，若定义则约束条件等价于假设误差ni是不相关的均值为零方差为的高斯白噪声，并且将ni,1建模为ni-n1；忽略二阶误差单元，则加权矩阵近似本文档来自技高网...

【技术保护点】
一种基于高度辅助修正的室内定位的TDOA定位方法，其特征在于，包括以下步骤：步骤(1)：在室内立体环境下，设定包括主基站在内有M个基站；采用有线或者无线同步，使主基站和从基站位于一个基准时钟，目标节点发送无线信号，定位基站得到目标节点无线信号到达各个基站的时间；步骤(2)：输入目标节点的经验高度或者利用辅助传感器得到的测量高度

【技术特征摘要】
1.一种基于高度辅助修正的室内定位的TDOA定位方法，其特征在于，包括以下步骤：步骤(1)：在室内立体环境下，设定包括主基站在内有M个基站；采用有线或者无线同步，使主基站和从基站位于一个基准时钟，目标节点发送无线信号，定位基站得到目标节点无线信号到达各个基站的时间；步骤(2)：输入目标节点的经验高度或者利用辅助传感器得到的测量高度并读取基站与目标节点的TOA原始数据；以主基站为参考基站，各个从基站的到达时间和主基站的到达时间做差，处理得到M-1个TDOA值；步骤(3)：根据定位基站的位置，以及目标节点的到达时差，来解算目标节点的位置。2.根据权利要求1所述的基于高度辅助修正的室内定位的TDOA定位方法，其特征在于，在所述步骤(3)中，定义为目标节点的位置坐标，其中是目标节点的经验高度或者利用辅助传感器得到的测量高度，其中xi＝[xi,yi,zi]T为基站的已知坐标信息，基站的数目为M,且M≥4，则TDOA量测距离为：ri,1＝di,1+ni,1i＝2,3,...,M(1)其中，ni,1为量测距差误差(噪声)，di,1＝di-d1，di为标签到第i个基站之间的距离。3.根据权利要求2所述的基于高度辅助修正的室内定位的TDOA定位方法，其特征在于，在所述步骤(3)中，该定位方法的位置解算方程为：其中，η＝[x-x1y-y1]T，m＝[m2,1…mM,1]T。4.根据权利要求3所述的基于高度辅助修正的室内定位的TDOA定位方法，其特征在于，针对位置解算方程，考虑目标节点坐标和到主基站的距离的约束关系，采用最大似然估计，则目标节点的位置解算问题转化为η的估计问题：其中，W＝(E{mmT})-1，若定义则约束条件等价于假设误差ni是不相关的均值为零方差为的高斯白噪声，并且将ni,1建模为ni-n1；忽略二阶误差单元，则加权矩阵近似为这里，为目标节点到各个从基站的距离。5.根据权利要求...

【专利技术属性】
技术研发人员：张绘军，刘丽珍，张怀良，王洋，范帅芳，肖岩，徐月娜，
申请(专利权)人：广州中海达定位技术有限公司，
类型：发明
国别省市：广东,44