基于分布式混合滤波的超宽带定位方法技术

基于分布式混合滤波的超宽带定位方法，在室内布置好UWB的基站，然后对室内的一移动物体建立连续动力学模型，模拟实际移动情况；再将该物体模型的不精确和受到的干扰考虑成由随机扰动和非随机扰动构成的混合扰动信号；进一步采取分布式混合滤波，多个传感器观测目标，进行融合，提高精度。在保障系统鲁棒性和抗干扰能力的前提下，对移动物体的位置(横坐标a和纵坐标b)进行实时高精度估计。估计结果可以满足实际应用的精度和实时性要求，并且无论使用的哪一种室内定位技术，算法都能很好地契合，满足室内定位的要求。

Ultra-Wideband Positioning Method Based on Distributed Hybrid Filtering

UWB positioning method based on distributed hybrid filtering is that the UWB base station is arranged indoors, then a continuous dynamic model is established to simulate the actual movement of a moving object in the room; then the inaccuracy of the object model and the disturbance received are considered as a mixed disturbance signal composed of random disturbance and non-random disturbance; furthermore, distributed hybrid filtering is adopted to transmit multiple signals. Sensor observation target is fused to improve accuracy. On the premise of guaranteeing the robustness and anti-jamming ability of the system, the position of moving objects (abscissa and ordinate b) is estimated with high accuracy in real time. The estimated results can meet the requirements of accuracy and real-time in practical application, and no matter which indoor positioning technology is used, the algorithm can fit well and meet the requirements of indoor positioning.

【技术实现步骤摘要】
基于分布式混合滤波的超宽带定位方法
本专利技术涉及一种基于分布式混合滤波的超宽带(UWB)定位方法。
技术介绍
GPS定位技术广泛应用于军事和民用领域中。而在室内，由于建筑物的遮挡，GPS技术会因接收不到足够的信号而无法进行精确的定位。因此室内定位技术被广泛研究，目前针对室内定位技术常用的是：Wi-Fi、蓝牙、红外线、RFID、ZigBee。但是这些技术均存在安全性低和穿透力弱的缺点。在室内定位中，比较常用的是卡尔曼滤波算法。众所周知，卡尔曼滤波在求解时不需要储存大量的观测数据，便于实时处理估计，因此其被广泛应用于动态数据处理中，尤其是GPS动态数据处理、导航等领域。同时，卡尔曼滤波器是以最小均方误差为原则的最优线性滤波器，因此具有较高的精度。但是卡尔曼滤波器的设计依赖于模型的准确性。而在实际应用中，建模精度常常不高，同时又存在着一些外界的非随机干扰，这些都会导致卡尔曼滤波算法的估计效果下降。
技术实现思路
为克服现有技术的上述缺点，本专利技术专利提供一种基于分布式混合滤波的超宽带(UWB)定位方法。本专利技术的工作原理如下：在室内布置好超宽带的基站，然后对室内的一移动物体建立连续动力学模型，模拟实际移动情况；再将该物体模型的不精确和受到的干扰考虑成由随机扰动和非随机扰动构成的混合扰动信号；进一步采取分布式混合滤波，多个传感器观测目标，进行融合，提高精度。基于分布式混合滤波的室内定位估计方法，具体步骤包括：1)在室内布置超宽带基站，对室内的移动物体运动情况建立连续动力学模型2)考虑复杂环境下的混合扰动以及模型的不精确，建立系统状态方程和输出方程，建立每个传感器的观测方程3)根据每个传感器的观测值构建其相应的状态滤波器4)给出系统误差模型，进一步给出基于最差非随机扰动的系统误差模型，设计并通过迭代算法求解每个滤波器的增益进一步，步骤1)中，我们把室内环境建立成一个平面直角坐标系，然后用来表示移动物体的位置，其中a表示物体的横坐标，b表示物体的纵坐标。进一步，步骤2)中，考虑室内环境下的混合扰动和模型的不精确性，建立系统状态方程和每个传感器的观测方程包括以下步骤：(2.1)系统的状态方程为：x(k+1)＝Ax(k)+B0ω0(k)+B1ω(k)(1)其中，k表示当前离散化时刻，k+1表示下一离散化时刻，估计对象x表示物体的位置，即x＝[ab]T，上标"T"表示矩阵的转置，A表示估计对象x的状态转移矩阵，ω0表示均值为零方差为1的高斯白噪声，B0表示高斯白噪声ω0的输入矩阵，ω表示非随机有界扰动信号，B1表示非随机有界扰动信号ω的输入矩阵。(2.2)第i个传感器的观测方程为：yi(k)＝C2；ix(k)+D1；iω0(k)+Diω(k)(2)其中，k表示离散化时刻，yi表示第i个传感器的观测向量，x表示估计对象，C2；i表示第i个传感器的估计对象的观测矩阵，ω0表示均值为0方差为1的高斯白噪声，D1；i表示第i个传感器的高斯白噪声ω0的观测矩阵，ω是非随机有界扰动信号，Di表示第i个传感器的非随机有界扰动信号的观测矩阵。进一步，步骤3)中，假设有N个节点，且每个节点上都有一个滤波器和一个传感器，定义η表示所有节点的集合，即η:＝{1,...,N}。分布式滤波中，对于第i个滤波器来说，它不仅能收到来自自身传感器的观测值yi(k)，而且能收到它邻居传感器的观测值定义ηi表示第i个节点收到邻居观测值的集合，即有定义Ji为第i个节点自身和它所有的邻居的集合，也就是Ji＝{i}∪ηi。定义表示第i个节点的所有观测值的集合；表示第i个节点的所有观测矩阵的集合；表示第i个节点所有高斯白噪声的观测矩阵的集合；表示第i个节点所有非随机有界扰动信号的观测矩阵的集合。在室内定位技术中，数据传输是通过无线传感网络的，对于第i个节点来说，它能通过无线传感网络收到邻居节点的观测值，但是在传输过程中会收到扰动，使得数据丢失。由于超宽带技术的穿透力非常高，所以我们可以忽略掉节点之间传输过程中的扰动。设计每一个节点的滤波器：其中，k表示当前离散化时刻，k+1表示下一离散化时刻，A表示估计对象x的状态转移矩阵，表示估计对象x的估计值，Li表示第i个节点的滤波增益，表示第i个节点的所有观测矩阵的集合，表示第i个节点所有高斯白噪声的观测矩阵的集合，表示第i个节点所有非随机有界扰动信号的观测矩阵的集合。该滤波器的作用是使得估计值接近系统输出z,z0，从而实现对估计对象x，即移动物体的实时高精度估计。进一步，步骤4)中，给出系统误差模型，进一步给出基于最差非扰动下的系统误差模型，设计并通过迭代算法求解滤波器增益，具体包括以下步骤：(4.1)通过(1)(2)(3)得到误差系统模型：其中，k表示当前离散时刻，k+1表示下一个离散时刻，ex；i表示估计对象x与对应估计值的差值，ei表示系统输出z与对应估计值的差值，e0；i表示系统输出z0与对应估计值的差值，A表示估计对象的状态转移矩阵，Li表示需要设计的滤波器增益，表示第i个节点的所有观测矩阵的集合；表示第i个节点所有高斯白噪声的观测矩阵的集合；表示第i个节点所有非随机有界扰动信号的观测矩阵的集合，B0为高斯白噪声ω0的输入矩阵，B1为非随机有界扰动信号ω的输入矩阵，ω0表示均值为0方差为1的高斯白噪声，ω为非随机有界扰动信号。(4.2)基于误差系统，定义最差的非随机有界扰动信号ω(k):ωi(k)＝Wiex；i(k)(5)将(5)代入式(4)，进一步得到最差非随机扰动下的系统误差模型：(4.3)当k＝0时，对中间变量P1；i和P2；i以及中间矩阵Wi和滤波器增益Li赋予初值，即P1；i(0)，P2；i(0)，Wi(0)，Li(0)(7)(4.4)基于误差系统，由H∞滤波算法得到最差的非随机有界扰动信号ωi：所以：其中，k表示当前离散时刻，ωi表示非随机有界扰动信号，γ为表示预设的H∞参数，上标"-1"表示矩阵的逆，上标"T"表示矩阵的转置，B1表示非随机有界扰动信号ω的输入矩阵，表示第i个节点所有高斯白噪声的观测矩阵的集合，AL；i、P1；i、AΩ；i和Δi均为中间矩阵，ex；i表示估计对象x与对应估计值的差值。(4.5)基于最差非随机扰动下的系统误差模型，通过H2滤波算法得到滤波器增益Li的表达式：其中，上标"-1"表示矩阵的逆，上标"T"表示矩阵的转置，表示第i个节点的所有观测矩阵的集合，表示第i个节点所有高斯白噪声的观测矩阵的集合，表示第i个节点所有非随机有界扰动信号的观测矩阵的集合，B0为高斯白噪声ω0的输入矩阵，B1为非随机有界扰动信号ω的输入矩阵，P2；i、Wi、AW；i和Λi均为中间矩阵。(4.6)当k＝1时，由式(9)(10)得到：Wi(1)＝γ-2Δi-1(B1TP1；i(0)AL；i+D1TAΩ；i)(11)其中，A表示估计对象的状态转移矩阵，γ表示预设的H∞参数，上标"-1"表示矩阵的逆，上标"T"表示矩阵的转置，Li表示需要设计的滤波器增益，表示第i个节点的所有观测矩阵的集合，表示第i个节点所有非随机有界扰动信号的观测矩阵的集合，B0为高斯白噪声ω0的输入矩阵，B1为非随机有界扰动信号ω的输入矩阵，AL；i、AΩ；i、Δi、Λi、AW；i、P1；i和P2；i均为中间矩阵。(4.7)本文档来自技高网...

【技术保护点】
1.基于分布式混合滤波的超宽带估计方法，具体步骤包括：步骤1)在室内布置UWB基站，对室内的移动物体运动情况建立连续动力学模型；把室内环境建立成一个平面直角坐标系，然后用

【技术特征摘要】
1.基于分布式混合滤波的超宽带估计方法，具体步骤包括：步骤1)在室内布置UWB基站，对室内的移动物体运动情况建立连续动力学模型；把室内环境建立成一个平面直角坐标系，然后用来表示移动物体的位置，其中a表示物体的横坐标，b表示物体的纵坐标；步骤2)考虑复杂环境下的混合扰动以及模型的不精确，建立系统状态方程和输出方程，建立每个传感器的观测方程；具体包括：考虑室内环境下的混合扰动和模型的不精确性，建立系统状态方程和每个传感器的观测方程包括以下步骤：(2.1)系统的状态方程为：x(k+1)＝Ax(k)+B0ω0(k)+B1ω(k)(1)其中，k表示当前离散化时刻，k+1表示下一离散化时刻，估计对象x表示物体的位置，即x＝[ab]T，上标"T"表示矩阵的转置，A表示估计对象x的状态转移矩阵，ω0表示均值为零方差为1的高斯白噪声，B0表示高斯白噪声ω0的输入矩阵，ω表示非随机有界扰动信号，B1表示非随机有界扰动信号ω的输入矩阵；(2.2)第i个传感器的观测方程为：yi(k)＝C2；ix(k)+D1；iω0(k)+Diω(k)(2)其中，k表示离散化时刻，yi表示第i个传感器的观测向量，x表示估计对象，C2；i表示第i个传感器的估计对象的观测矩阵，ω0表示均值为0方差为1的高斯白噪声，D1；i表示第i个传感器的高斯白噪声ω0的观测矩阵，ω是非随机有界扰动信号，Di表示第i个传感器的非随机有界扰动信号的观测矩阵；步骤3)根据每个传感器的观测值构建其相应的滤波器；具体包括：假设有N个节点，且每个节点上都有一个滤波器和一个传感器，定义η表示所有节点的集合，即η:＝{1,...,N}；分布式滤波中，对于第i个滤波器来说，它不仅能收到来自自身传感器的观测值yi(k)，而且能收到它邻居传感器的观测值定义ηi表示第i个节点收到邻居观测值的集合，即有定义Ji为第i个节点自身和它所有的邻居的集合，也就是Ji＝{i}∪ηi；定义表示第i个节点的所有观测值的集合；表示第i个节点的所有观测矩阵的集合；表示第i个节点所有高斯白噪声的观测矩阵的集合；表示第i个节点所有非随机有界扰动信号的观测矩阵的集合；在室内定位技术中，数据传输是通过无线传感网络的，对于第i个节点来说，它能通过无线传感网络收到邻居节点的观测值，但是在传输过程中会收到扰动，使得数据丢失；由于UWB技术的穿透力非常高，所以我们可以忽略掉节点之间传输过程中的扰动；设计每一个节点的滤波器：其中，k表示当前离散化时刻，k+1表示下一离散化时刻，A表示估计对象x的状态转移矩阵，表示估计对象x的估计值，Li表示第i个节点的滤波增益，C1，C0表示估计对象x的输出矩阵，表示第i个节点的所有观测矩阵的集合，表示第i个节点所有高斯白噪声的观测矩阵的集合，表示第i个节点所有非随机有界扰动信号的观测矩阵的集合；该滤波器的作用是使得估计值接近系统输出z,z0，从而实现对估计对象x，即移动物体的实时高精度估计；步骤4)给出系统误差模型，进一步给出基于最差非随机扰动的系统误差模型，设计并通过迭代算法求解每个滤波器的增益；具体包括：给出系统误差模型，进一步给出基于最差非扰动下的系统误差模型，设计并通过迭代算法求解滤波器增益，具体包括以下步骤：(4.1)通过(1)(2)(3)得到误差系统模型：其中，k表示当前离散时刻，k+1表示下一个离散时刻，ex；i表示估计对象x与对应估计值的差值，ei表示系统输出z与对应估计值的差值，e0；i表示系统输出z0与对应估计值的差值，A表示估计对象的状态转移矩阵，Li表示需要设计的滤波器增益，表示第i个节点的所有观测矩阵的集合；表示第i个节点所有高斯白噪声的观测矩阵的集合；表示第i个节点所有非随机有界扰动信号的观测矩阵的集合，B0为高斯白噪声ω0的输入矩阵，B1为非随机有界扰动信号ω的输入矩阵，ω0表示均值为0方差为1的高斯白噪声，ω为非随机有界扰动...

【专利技术属性】
技术研发人员：冯宇，陈焯明，寿宇航，吴珺，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33