[发明专利]基于非视距环境下超宽频测距实现室内定位方法

摘要

本发明涉及一种基于非视距环境下超宽频测距实现室内定位方法，测试系统由被定位目标上的一个标签和n个基站组成，每个基站与标签之间通信采用超宽频传输技术，所有的基站安装在同一水平面上，被定位目标运动平面与基站平面要求定高，采用飞行时间TOF原理测距。根据多组测量距离信息与系统预测模型所估计出的距离信息进行比较，一方面通过测量距离与估计距离差值阈值进行是否为非视距测距数据的认定，另一方面，通过计算测量距离与估计距离差值在估计点对实际坐标偏移大小的阈值进行是否作为非视距测距数据的认定。两种判定方案共同决定距离数据是否为非视距测距数据，然后对非视距测量数据进行排除，再进行相应的定位运算，从而提高定位精度。

主权项

一种基于非视距环境下超宽频测距实现室内定位方法，其特征在于，具体包括如下步骤：1)建立室内测试系统：被定位目标上的一个标签和n个基站组成，标签与基站均采用超宽带模块，每个基站与标签之间通信采用超宽频传输技术，所有的基站安装在同一水平面上，被定位目标与基站可在同一水平面，也可不在同一水平面上，但被定位目标运动平面与基站平面要求定高，每个基站与标签之间采用飞行时间TOF原理测距；2)将所有基站和被测目标设在同一水平面，针对二维环境下进行定位计算：A:对步骤1)建立的室内测试系统进行预测模型估计：预测阶段如下：Xk|k‑1＝AXk‑1|k‑1Pk|k‑1＝APk‑1|k‑1AT+Q其中，X＝[x y vx vy]T，Xk‑1|k‑1为k‑1时刻状态变量X的最优估计，Xk|k‑1为k时刻对于状态变量X的预测向量，Pk|k‑1为k时刻的预测误差协方差矩阵，Pk‑1|k‑1为k‑1时刻的校正误差协方差矩阵，Q为过程噪声协方差矩阵，设置为对角矩阵；校正阶段如下：h(Xk|k-1)=(xk|k-1-x1)2+(yk|k-1-y1)2...(xk|k-1-xi)2+(yk|k-1-yi)2...(xk|k-1-xn)2+(yk|k-1-yn)2]]>其中(xi,yi)为第i个基站的位置信息，h(Xk|k‑1)为k时刻每个基站与被测目标之间的估计距离所组成的列向量；B：通过建立一个矩阵，让多组测量距离信息与系统预测模型所估计出的距离信息进行比较，判定出非视距测距数据：根据基站个数n，定义一个矩阵满足：C＝I‑CA·CB其中，I为n×n维度的单位阵，对于cAi，满足其中，dvar为距离差阈值，为正数，dk,i为第k时刻第i个基站与被测目标之间的水平距离，hk,i为第k时刻h(Xk|k‑1)中第i行元素；对于其中，为的模，evar为误差阈值，ΔX‾i=(ATA)-1ATf(r1,...,rn,Δr‾1,...,Δr‾j,...,Δr‾n),i=1,...,n,j=1,...,n]]>其中，为根据第i个基站所测量的误差所估计出的目标坐标误差列向量，ri为第i个基站与被测目标之间的距离；C:定位运算：定义H为h的雅克比矩阵：Hk=xk|k-1-x1h1(X)yk|k-1-y1h1(X)00............xk|k-1-xihi(X)yk|k-1-yihi(X)00............xk|k-1-xnhn(X)xk|k-1-xnhn(X)00]]>H′k＝CHk+(I‑C)Hk‑1卡尔曼增益如下所示：Kk=Pk|k-1Hk′T(Hk′Pk|k-1Hk′T+R)]]>其中R为测量协方差矩阵，设置为对角矩阵，状态校正式如下：Xk|k＝Xk|k‑1+KkC(dk‑hk)Pk|k＝Pk|k‑1‑KkH′kPk|k‑1其中，dk为第k时刻测量的距离向量，Pk|k为校正误差协方差矩阵，Xk|k即为在第k时刻的坐标最优估计列向量；3)若被测目标与基站不在同一水平面上，采用直角三角形的几何关系来求解出被测目标与基站之间的水平距离：其中，d测为实际测量距离，Δh为基站与目标的高度差，d为目标与基站的水平距离。