一种UWB室内卫星导航系统的定位终端时钟漂移自解算方法

摘要: 本发明涉及定位,具体涉及一种uwb室内卫星导航系统的定位终端时钟漂移自解算方法。背景技术:1、全球卫星导航系统在室外定位表现优异,但信号穿透建筑物时衰减严重,难...
一种UWB室内卫星导航系统的定位终端时钟漂移自解算方法

本发明涉及定位,具体涉及一种uwb室内卫星导航系统的定位终端时钟漂移自解算方法。

背景技术:

1、全球卫星导航系统在室外定位表现优异,但信号穿透建筑物时衰减严重,难以满足室内等场景的定位需求,uwb(ultra-wideband,超宽带)技术因高精度、高抗多径干扰等特点成为室内定位的理想方案之一,其相关定位方式需依赖基站时间同步,而定位终端的时钟漂移会直接影响定位精度,现有解决该问题的方案存在成本高、功耗大或增加系统通信负担等局限,无法适配实际应用需求,因此对高精度、高可靠性的室内定位技术存在迫切需求。

技术实现思路

1、为了解决或至少部分解决上述技术问题,本发明实施例提供了一种uwb室内卫星导航系统的定位终端时钟漂移自解算方法。超宽带室内卫星导航系统包括已知坐标的同步控制器、多个已知坐标的定位基站以及定位终端;所述方法包括以下步骤:

2、控制所述同步控制器广播携带自身第一坐标的同步帧,用于所述定位基站的时间同步校准;

3、控制所述定位基站接收同步帧后,根据自身第二坐标与所述同步控制器的第一坐标计算时间修正值,结合自身延迟发送时间得到同步校准时间,将所述同步校准时间写入定位帧,并按照延迟发送时间向所述定位终端发送所述定位帧;

4、控制所述定位终端接收同步帧后启动定位,在预设时间间隔内接收各定位基站发送的所述定位帧,并记录所述定位帧的接收时间戳;

5、控制所述定位终端基于所述同步校准时间、所述接收时间戳以及所述定位基站的第二坐标,将时钟漂移参数作为待求参数建立定位解算模型,对所述定位解算模型进行线性化处理后迭代求解,同时得到定位终端的第三坐标和时钟漂移参数;

6、控制所述定位终端利用时钟漂移参数修正后续定位过程中的观测数据,消除时钟漂移对定位结果的影响。

7、进一步地,建立定位解算模型的过程为:

8、控制定位终端根据定位基站的第二坐标与定位终端的第三坐标,计算定位终端与各定位基站之间的理论距离;

9、根据接收时间戳、同步校准时间以及时钟漂移参数,计算得到有效时间差;

10、建立所述理论距离与光速、有效时间差之间的对应关系,形成所述定位解算模型。

11、进一步地,对所述定位解算模型进行线性化处理的过程为:

12、控制定位终端获取第三坐标的初始估计值和时钟漂移参数的初始估计值;

13、控制定位终端定义第三坐标的偏差量、时钟漂移参数的偏差量,所述偏差量为对应参数的真实值与所述初始估计值的差值;

14、将定位解算模型在初始估计值处进行一阶泰勒展开,忽略高阶项,得到线性化方程。

15、进一步地,所述迭代求解的过程包括:

16、控制定位终端根据第三坐标的初始估计值、定位基站的第二坐标以及接收时间戳,计算线性化方程中各待求参数对应的偏导数,基于所述偏导数构建系数矩阵;

17、控制定位终端根据定位解算模型的理论计算结果与实际观测结果的偏差,构建残差向量;

18、控制定位终端基于系数矩阵和残差向量,采用最小二乘方法求解,得到第三坐标偏差量和时钟漂移参数偏差量的解;

19、控制定位终端基于第三坐标偏差量与第三坐标的初始估计值确定定位终端的第三坐标,基于时钟漂移参数偏差量与时钟漂移参数的初始估计值确定时钟漂移参数。

20、进一步地,所述迭代求解的过程还包括:

21、控制定位终端获取各定位基站对应的观测误差信息;

22、控制定位终端基于所述观测误差信息确定加权矩阵;

23、控制定位终端结合所述加权矩阵、系数矩阵和残差向量进行求解,得到第三坐标偏差量和时钟漂移参数偏差量的加权解。

24、进一步地,确定加权矩阵的过程为:

25、当定位终端未获取到各定位基站对应的观测误差先验信息时,所述加权矩阵设置为单位矩阵,所述单位矩阵的对角线元素取值为1,非对角线元素取值为0。

26、进一步地,确定加权矩阵的过程为:

27、当定位终端获取到各定位基站对应的观测误差方差信息时,所述加权矩阵设置为对角矩阵,所述对角矩阵的对角线元素分别对应各定位基站的观测误差方差的倒数,所述对角矩阵的非对角线元素取值为0。

28、进一步地,当定位终端获取到各定位基站对应的观测误差协方差信息时,所述加权矩阵设置为观测误差协方差矩阵的逆矩阵,所述观测误差协方差矩阵的元素为任意两个定位基站观测误差之间的协方差,非对应位置的元素根据观测误差相关性确定。

29、进一步地,所述迭代求解的过程还包括:

30、控制定位终端计算第三坐标偏差量的增量模长和时钟漂移参数偏差量的增量模长,或计算残差向量的模长;

31、控制定位终端判断增量模长是否小于预设的增量阈值,或判断残差向量的模长是否小于预设的残差阈值;

32、若满足任一条件,则停止迭代;若均不满足,则将得到的第三坐标和时钟漂移参数作为新的初始估计值,重新进行迭代计算。

33、进一步地,当进行二维坐标定位时,所述定位基站的数量不小于4个;当进行三维坐标定位时,所述定位基站的数量不小于5个;

34、二维定位场景下,所述定位基站非共线分布;三维定位场景下,所述定位基站分布在不同高度层,形成非共面的空间构型;

35、二维定位场景下,定位区域内任意定位点均被至少3个所述定位基站覆盖;三维场景下,定位区域内任意定位点均被至少4个所述定位基站覆盖;所述定位基站之间的间距不超过视距覆盖半径的70%。

36、本发明提供的方法具有以下有益效果:

37、本发明通过同步控制器广播携带自身第一坐标的同步帧,为定位基站的时间同步校准提供了精准依据,定位基站接收同步帧后,结合自身第二坐标与同步控制器的第一坐标计算时间修正值,并融入延迟发送时间得到同步校准时间,这种同步方式无需定位终端与基站进行频繁的时钟同步握手,有效减少了系统的通信负担,保障了定位刷新率的稳定。定位终端接收同步帧后启动定位,在预设时间间隔内收集各定位基站的定位帧并记录接收时间戳,随后将时钟漂移参数作为待求参数建立定位解算模型,通过线性化处理与迭代求解,同步获得自身第三坐标和时钟漂移参数,无需为定位终端配备高昂的温补或恒温晶振,大幅降低了设备成本,契合uwb定位终端低成本、低功耗的设计需求。同时,定位终端利用解算出的时钟漂移参数修正后续定位的观测数据,从根源上削弱了时钟漂移对定位结果的不利影响,显著提升了室内定位的精度与可靠性,无需外部额外干预即可实现稳定高效的定位,能够更好地适配物联网、智能仓储、应急救援等领域对室内高精度定位的需求,具备良好的大规模部署可行性。

1.一种uwb室内卫星导航系统的定位终端时钟漂移自解算方法,其特征在于,超宽带室内卫星导航系统包括已知坐标的同步控制器、多个已知坐标的定位基站以及定位终端;所述方法包括以下步骤:

2.根据权利要求1所述的方法,其特征在于,建立定位解算模型的过程为:

3.根据权利要求2所述的方法,其特征在于,对所述定位解算模型进行线性化处理的过程为:

4.根据权利要求3所述的方法,其特征在于,所述迭代求解的过程包括:

5.根据权利要求4所述的方法,其特征在于,所述迭代求解的过程还包括:

6.根据权利要求5所述的方法,其特征在于,确定加权矩阵的过程为:

7.根据权利要求5所述的方法,其特征在于,确定加权矩阵的过程为:

8.根据权利要求5所述的方法,其特征在于,确定加权矩阵的过程为:

9.根据权利要求4所述的方法,其特征在于,所述迭代求解的过程还包括:

10.根据权利要求1所述的方法,其特征在于: