[发明专利]一种室内超声波差分定位方法

摘要

一种室内超声波差分定位方法,所述定位系统结构包括室内超声波定位系统由中心站、信标节点、定位终端以及参考站四部分。本发明所述室内超声波差分定位方法可以消除由于超声波速度误差、硬件延时误差、安装误差以及其他误差引起的测量伪距误差，从而提高定位解算精度；引入了扩频编码技术可以消除各路超声波信号之间的串扰现象；相对于现有的超声波定位方法而言，通过超声波差分定位方法得到的定位终端的位置信息精度更高。

主权项

一种室内超声波差分定位方法,其特征在于：定位系统结构包括：室内超声波定位系统由中心站、信标节点、定位终端以及参考站四部分；所述室内超声波差分定位方法步骤为：设布设在屋顶固定位置处的三个信标节点坐标分别为(x1,y1,z1)，(x2,y2,z2)，(x3,y3,z3)，设定参考站位置坐标为(xu,yu,zu)，下标u为参考站标号；(1)中心站发射射频信号，作为时间同步信号；(2)参考站和定位终端接收到中心站发送来的时间同步信号后，发射经过伪随机码调制超声波信号；参考站和定位终端同时发射超声波信号，在信标节点处接收到的超声波信号会存在串扰现象；针对这一问题，该系统采用了扩频编码方式即CDMA：参考站及定位终端分别采用两种不同的伪随机码调制超声波信号并发射；信标节点处，接收并处理超声波信号以区分参考站及定位终端信号达到时间；(3)安装在室内固定位置处的信标节点接收到中心站发来的时间同步信号后，启动定时器，接收超声波信号，并进行自相关运算以区分参考站及定位终端信号。进行测距，分别得到参考站及定位终端到信标节点k的距离信息ρ′uk,ρ′rk；上述k为三个信标节点编号，k＝1,2,3；上述ρ′uk为测得的参考站到信标节点k的距离，ρ′rk为测得的定位终端到信标节点k的距离；(4)将参考站到信标节点之间距离测量值与标准值通过公式(1)比较得到参考站到信标节点k的测量伪距误差Δuk，Δuk为参考站到信标节点k的测量伪距误差距离；Δuk＝ρuk‑ρ′uk   (1)式中ρuk为参考站到信标节点k的标准距离；(5)根据第(4)步得到的伪距修正数Δuk通过公式(2)修正定位终端到信标节点之间的测量距离；ρrk＝ρ′rk+Δuk      (2)(6)当得到定位终端到三个信标节点之间的修正后的伪距测量值，通过公式(3)即可解算出三维坐标，得到更高精度的定位终端位置坐标信息；(x-x1)2+(y-y1)2+(z-z1)2=ρr12(x-x2)2+(y-y2)2+(z-z2)2=ρr22(x-x3)2+(y-y2)2+(z-z2)2=ρr32---(3)]]>由此可知，根据参考站得到目标节点到信标节点的测量伪距修正系数，通过差分方法即可精确测得目标节点的三维坐标(x,y,z)。