天线位姿信息测量方法、装置、设备、介质和程序产品与流程

文档序号:30057802发布日期:2022-05-17 19:36阅读:125来源:国知局
天线位姿信息测量方法、装置、设备、介质和程序产品与流程

1.本技术涉及天线技术领域,特别是涉及一种天线位姿信息测量方法、装置、设备、介质和程序产品。


背景技术:

2.无线定位基站可以测量终端相对于无线定位基站的阵列天线的到达角,从而利用到达角得到终端的方位角和俯仰角信息,进而依据多个无线定位基站阵列天线的位置和姿态信息以及测量的终端的方位角和俯仰角就可以估计终端的位置。因此,精确测量无线定位基站阵列天线的位置信息和姿态信息有助于提升估计终端位置的准确度。
3.传统技术中,无线定位基站位置的标定通常使用全球导航卫星系统(global navigation satellite system,gnss),无线定位基站姿态的标定通常使用加速度计、磁强计和陀螺仪。
4.然而,传统技术中,天线的位置测量精度通常在米级,姿态测量精度通常在度级且易受周围电磁环境影响,因此,该方法对位置和姿态的测量精度无法满足高精度定位需求。


技术实现要素:

5.基于此,有必要针对上述技术问题,提供一种能够实现无线定位基站阵列天线位置和姿态的精确测量的天线位姿信息测量方法、装置、设备、介质和程序产品。
6.第一方面,本技术提供了一种天线位姿信息测量方法。该方法包括:确定全站仪坐标系与直角坐标系之间的第一转换参数;获取目标天线的天线罩上的多个第一标记点在该全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标;基于该第一转换参数和各第一标记点的第一坐标确定各第一标记点在该直角坐标系下的第三坐标;基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数;根据该第二转换参数,确定该目标天线的位姿信息。
7.在其中一个实施例中,确定全站仪坐标系与直角坐标系之间的第一转换参数,包括:获取该目标天线的天线罩周围目标空间范围内多个第二标记点在该直角坐标系下的第四坐标以及在该全站仪坐标系下的第五坐标;根据各第二标记点的第四坐标以及第五坐标,构建该全站仪坐标系与该直角坐标系的第一转换关系式;基于该第一转换关系式进行求解运算,得到该第一转换参数。
8.在其中一个实施例中,该第一转换关系式为:其中,和为该第一转换参数,为估计误差,为该第四坐标,为该第五坐标。
9.在其中一个实施例中,该基于该第一转换关系式进行求解运算,得到该第一转换
参数,包括:基于该第一转换关系式构建状态空间模型;利用贝叶斯滤波器,对该状态空间模型进行递归求解运算,得到该第一转换参数。
10.在其中一个实施例中,该状态空间模型为:其中,,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,n为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第一转换参数。
[0011]
在其中一个实施例中,该基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数,包括:根据各第一标记点的第二坐标以及第三坐标,构建该直角坐标系与该无线定位基站阵列天线坐标系的第二转换关系式;基于该第二转换关系式进行求解运算,得到该第二转换参数。
[0012]
在其中一个实施例中,该第二转换关系式为:其中,和为该第二转换参数,为估计误差,为该第二坐标,为该第三坐标。
[0013]
在其中一个实施例中,该基于该第二转换关系式进行求解运算,得到该第二转换参数,包括:基于该第二转换关系式构建状态空间模型;利用贝叶斯滤波器,根据该状态空间模型进行递归求解运算,得到该第二转换参数。
[0014]
在其中一个实施例中,该状态空间模型为:其中,,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,m为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第二转换参数。
[0015]
在其中一个实施例中,根据该第二转换参数,确定该目标天线的位姿信息,包括:根据确定该目标天线的位置坐标;根据确定该目标天线的位姿角。
[0016]
第二方面,本技术还提供了一种天线位姿信息测量装置。该装置包括:第一确定模块,用于确定全站仪坐标系与直角坐标系之间的第一转换参数;第一获取模块,用于获取目标天线的天线罩上的多个第一标记点在该全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标;第二确定模块,用于基于该第一转换参数和各第一标记点的第一坐标确定各第一标记点在该直角坐标系下的第三坐标;第二获取模块,用于基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐
标系与该无线定位基站阵列天线坐标系之间的第二转换参数;第三确定模块,用于根据该第二转换参数,确定该目标天线的位姿信息。
[0017]
在其中一个实施例中,该第一确定模块,具体用于:获取该目标天线的天线罩周围目标空间范围内多个第二标记点在该直角坐标系下的第四坐标以及在该全站仪坐标系下的第五坐标;根据各第二标记点的第四坐标以及第五坐标,构建该全站仪坐标系与该直角坐标系的第一转换关系式;基于该第一转换关系式进行求解运算,得到该第一转换参数。
[0018]
在其中一个实施例中,该第一转换关系式为:其中,和为该第一转换参数,为估计误差,为该第四坐标,为该第五坐标。
[0019]
在其中一个实施例中,该第一确定模块,具体用于:基于该第一转换关系式构建状态空间模型;利用贝叶斯滤波器,对该状态空间模型进行递归求解运算,得到该第一转换参数。
[0020]
在其中一个实施例中,该状态空间模型为:其中,,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,n为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第一转换参数。
[0021]
在其中一个实施例中,该第二获取模块,具体用于:根据各第一标记点的第二坐标以及第三坐标,构建该直角坐标系与该无线定位基站阵列天线坐标系的第二转换关系式;基于该第二转换关系式进行求解运算,得到该第二转换参数。
[0022]
在其中一个实施例中,该第二转换关系式为:其中,和为该第二转换参数,为估计误差,为该第二坐标,为该第三坐标。
[0023]
在其中一个实施例中,该第二获取模块,具体用于:基于该第二转换关系式构建状态空间模型;利用贝叶斯滤波器,根据该状态空间模型进行递归求解运算,得到该第二转换参数。
[0024]
在其中一个实施例中,该状态空间模型为:其中,,
,为状态噪声矢量,为观测噪声矢量,k为迭代次数,m为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第二转换参数。
[0025]
在其中一个实施例中,该第三确定模块,具体用于:根据确定该目标天线的位置坐标;根据确定该目标天线的位姿角。
[0026]
第三方面,本技术还提供了一种计算机设备,包括存储器和处理器,该存储器存储有计算机程序,该处理器执行该计算机程序时实现上述第一方面任一项所述的方法的步骤。
[0027]
第四方面,本技术还提供了一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现上述第一方面中任一项所述的方法的步骤。
[0028]
第五方面,本技术还提供了一种计算机程序产品,该计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现上述第一方面中任一项所述的方法的步骤。
[0029]
上述天线位姿信息测量方法、装置、设备、介质和程序产品,通过先确定全站仪坐标系与直角坐标系之间的第一转换参数,然后获取目标天线的天线罩上的多个第一标记点在该全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标,从而基于该第一转换参数和各第一标记点的第一坐标确定各第一标记点在该直角坐标系下的第三坐标,可实现全站仪坐标系与直角坐标系之间的坐标转换。进一步的,基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数,并根据该第二转换参数,确定该目标天线的位姿信息。通过确定直角坐标系与无线定位基站阵列天线坐标系之间的第二转换参数,从而使得根据该第二转换参数确定的目标天线的位姿信息与无线定位基站密切相关,且不受周围环境影响,大大提升了获取目标天线的位姿信息的精准度,可得到高精度的目标天线的位姿信息测量结果,可以满足高精度定位需求,且该方法便于实施。
附图说明
[0030]
图1为一个实施例中天线位姿信息测量的流程示意图;图2为一个实施例中确定第一转换参数的流程示意图;图3为一个实施例中基于第一转换关系确定第一转换参数的流程示意图的流程示意图;图4为一个实施例中网格划分示意图;图5为一个实施例中位姿参数估计值确定的流程示意图;图6为一个实施例中确定第二转换参数的流程示意图;图7为一个实施例中第二转换关系式确定第二转换参数的流程示意图;图8为一个实施例中确定阵列天线位置信息和姿态信息的流程示意图;图9为一个实施例中天线位姿信息测量装置的结构框图;图10为一个实施例中计算机设备的内部结构图。
具体实施方式
[0031]
为了使本技术的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对
本技术进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本技术,并不用于限定本技术。
[0032]
无线定位基站可以测量终端相对于无线定位基站阵列天线的到达角(angle of arrival, aoa),从而得到终端的方位角和俯仰角信息。依据多个无线定位基站阵列天线的位置和姿态信息以及测量的终端方位角和俯仰角就可以估计终端的位置。
[0033]
在多无线定位基站纯aoa定位中,为实现终端的高精度定位(分米级或厘米级)需要对无线定位基站阵列天线的位置和姿态进行精确标定。无线定位基站无线定位基站位置的标定通常使用全球导航卫星系统(global navigation satellite system, gnss),无线定位基站姿态的标定通常使用加速度计、磁强计和陀螺仪,位置标定精度通常在米级,姿态标定精度通常在度级且易受周围电磁环境影响,该位姿标定精度无法满足高精度定位需求,此外,每个无线定位基站均需要安装gnss模块、加速度计、磁强计和陀螺仪,大大增加了部署成本。一些无线定位基站通常部署在室内区域,由于在室内通常没有卫星导航信号,因而无法使用gnss进行无线定位基站阵列天线的位置标定,此外,室内电磁环境非常复杂,也无法使用加速度计、磁强计和陀螺仪标定无线定位基站阵列天线的姿态,因此,需提出对无线定位基站阵列天线位置和姿态进行高精度标定的有效手段。
[0034]
在一个实施例中,如图1所示,提供了一种天线位姿信息测量方法,本实施例以该方法应用于终端进行举例说明,可以理解的是,该方法也可以应用于服务器,还可以应用于包括终端和服务器的系统,并通过终端和服务器的交互实现,其中,终端可以但不限于是各种个人计算机、笔记本电脑、智能手机和平板电脑等。服务器可以用独立的服务器或者是多个服务器组成的服务器集群来实现。本技术实施例中,该方法包括以下步骤:步骤101,确定全站仪坐标系与直角坐标系之间的第一转换参数。
[0035]
其中,为在直角坐标系下确定阵列天线坐标,从而实现对阵列天线的标定,首先需要确定全站仪坐标系(total station frame, tsf)与直角坐标系之间的第一转换参数,并利用该第一转换参数对阵列天线进行位置和姿态的标定。例如,可以采用全站仪对阵列天线附近的空间的标记点进行坐标测量,得到各个标记点在全站仪坐标系下的坐标;另外,获取各坐标点在直角坐标系下的坐标,利用各标记点在全站仪坐标系下的坐标以及在直角坐标系下的坐标,确定全站仪坐标系与直角坐标系之间的第一转换参数,从而可以利用该转换参数,将其它全站仪坐标系下的坐标转换为直角坐标系下的坐标。
[0036]
步骤102,获取目标天线的天线罩上的多个第一标记点在该全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标。
[0037]
其中,目标天线为需要进行位置和姿态标定的无线定位基站中的阵列天线。对于目标天线的位置和姿态的标定,可以通过目标天线的天线罩实现。具体的,在目标天线的天线罩上标记m个点,该m个点即为第一标记点,m为正整数,通常,m≥2。使用全站仪测量可直接得到上述各第一标记点在全站仪坐标系下的坐标,得到各第一标记点在全站仪坐标系下的第一坐标。另外,在目标天线安装与无线定位基站后,关于目标天线的无线定位基站阵列天线坐标系(array antenna frame, aaf)也相应确定,因此,可获取各第一标记点在无线定位基站阵列天线坐标系(array antenna frame, aaf)中的坐标。
[0038]
步骤103,基于该第一转换参数和各第一标记点的第一坐标确定各第一标记点在该直角坐标系下的第三坐标。
[0039]
其中,各第一标记点的第一坐标为全站仪坐标系下的坐标,而第一转换参数为直角坐标系与全站仪坐标系之间的转换参数,因此,可通过该第一转换成参数以及各第一标记点的第一坐标,得到各第一标记点在直角坐标系下的第三坐标,即可直接通过计算得到目标天线的天线罩上的各第一标记点在直角坐标系下的坐标,从而便于通过各第一标记点在直角坐标系下的坐标确定目标天线的位置和姿态信息。
[0040]
步骤104,基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数。
[0041]
其中,各第一标记点的第二坐标为在无线定位基站阵列天线坐标系下的坐标,且第三坐标为直角坐标系下的坐标,因此,可基于各第一标记点的第二坐标以及第三坐标确定直角坐标系与无线定位基站阵列天线坐标系之间的第二转换参数,利用该第二转换参数,可实现标记点从直角坐标系与无线定位基站阵列天线坐标系之间的坐标转换,其中,该第二转换参数与目标天线的位置信息和姿态信息相关。
[0042]
步骤105,根据该第二转换参数,确定该目标天线的位姿信息。
[0043]
其中,目标天线的位姿信息即目标天线的位置信息和姿态信息,位置信息例如为目标天线的位置坐标,姿态信息包括目标天线的方位角、俯仰角以及横滚角信息。由于该第二转换参数与目标天线的位姿信息相关,因此,当得到该第二转换参数后,可根据该第二转换参数,进一步提取得到该目标天线的位姿信息,实现对目标天线的位姿信息的测量标定。
[0044]
上述天线位姿信息测量方法、装置、设备、介质和程序产品,通过先确定全站仪坐标系与直角坐标系之间的第一转换参数,然后获取目标天线的天线罩上的多个第一标记点在该全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标,从而基于该第一转换参数和各第一标记点的第一坐标确定各第一标记点在该直角坐标系下的第三坐标,可实现全站仪坐标系与直角坐标系之间的坐标转换。进一步的,基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数,并根据该第二转换参数,确定该目标天线的位姿信息。通过确定直角坐标系与无线定位基站阵列天线坐标系之间的第二转换参数,从而使得根据该第二转换参数确定的目标天线的位姿信息与无线定位基站密切相关,且不受周围环境影响,大大提升了获取目标天线的位姿信息的精准度,可得到高精度的目标天线的位姿信息测量结果,可以满足高精度定位需求,且该方法便于实施。
[0045]
在一个实施例中,如图2所示,其示出了本技术实施例提供的一种确定第一转换参数的流程示意图。确定全站仪坐标系与直角坐标系之间的第一转换参数,包括:步骤201,获取该目标天线的天线罩周围目标空间范围内多个第二标记点在该直角坐标系下的第四坐标以及在该全站仪坐标系下的第五坐标。
[0046]
其中,在目标天线的天线罩附近的周围目标空间范围内标记n个点,该n个标记点记为第二标记点,n为正整数,通常,n≥2。其中,目标空间范围指目标天线的天线罩附近的空间,本技术实施例对目标空间范围具体范围大小不作限定。
[0047]
为获取直角坐标系与全站仪坐标系之间的第二转换参数,实现标记点直角坐标与全站仪坐标之间的转换,首先,可获取目标天线的天线罩周围目标空间范围内标记的各第二标记点在直角坐标系下的第四坐标,其中,该直角坐标系为当地直角坐标系或以其它任意方式定义的直角坐标系,例如地心地固坐标系(earth-centered, earth-fixed,ecef)。
[0048]
将各第二标记点在直角坐标系下的第四坐标记为,n=1,2,
……
,n,其中,为第四坐标的x轴坐标参数,为第四坐标的y轴坐标参数,为第四坐标的z轴坐标参数,[
·
]
t
表示矩阵转置。
[0049]
通常,无线定位基站的阵列天线可以位于室内或室外,对于目标天线,当目标天线位于室外,可直接获取目标天线的各第二标记点在直角坐标系下的第四坐标;当目标天线位于室内时,各第二标记点的第四坐标可由室外rtk(real
ꢀ‑ꢀ
time kinematic,实时差分定位)定位结果利用全站仪引入到室内并通过地心地固坐标系(earth-centered earth-fixed frame, ecef)与llf的转换关系得到。
[0050]
使用全站仪在目标天线的天线罩附近合适位置建立全站仪坐标系,同时使用全站仪测量各第二标记点在全站仪坐标系下的第五坐标,记为,n=1,2,
……
,n,其中,为第五坐标的x轴坐标参数,为第五坐标的y轴坐标参数,为第五坐标的z轴坐标参数,[
·
]
t
表示矩阵转置。
[0051]
步骤202,根据各第二标记点的第四坐标以及第五坐标,构建该全站仪坐标系与该直角坐标系的第一转换关系式。
[0052]
其中,利用各第二标记点在全站仪坐标系下的第五坐标以及各第二标记点在直角坐标系中的第四坐标计算全站仪坐标系和直角坐标系的坐标转换关系,可表示为:(1)其中,为全站仪在直角坐标系中的坐标,为全站仪坐标系和直角坐标系之间的旋转矩阵,和与目标天线位姿信息相关,为第一转换参数,通过确定第二转换参数,可进一步确定目标天线的位姿信息。
[0053]
考虑到估计误差的影响,公式(1)可改写为(2)其中,公式(2)即为第一转换关系,和为第一转换参数,v为的估计误差,为第四坐标,为第五坐标。
[0054]
由于上式中和包含6个未知位姿参数即且与姿态角有关,为方位角,为俯仰角,为横滚角,因此至少需要使用2个标记点即n≥2,进行位姿信息的确定。其中,可使用多个第二标记点以提升和的估计精度。
[0055]
步骤203,基于该第一转换关系式进行求解运算,得到该第一转换参数。
[0056]
其中,由于构建的第一转换关系式中包含第一转换参数和,因此,基于该第
一转换关系式,进行求解,从而确定第一转换参数,以对目标天线进行位姿信息的估计。
[0057]
在一个实施例中,如图3所示,其示出了本技术实施例提供的一种基于第一转换关系确定第一转换参数的流程示意图。基于该第一转换关系式进行求解运算,得到该第一转换参数,包括:步骤301,基于该第一转换关系式构建状态空间模型。
[0058]
其中,该状态空间模型为:(3)其中,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,n为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第一转换参数。k为迭代次数。可见,通过第一转换关系式可构建得到该状态空间模型。
[0059]
其中,为确定和,需对和包含的6个未知位姿参数进行估计,可基于该第一转换关系式构建状态空间模型,并基于该状态空间模型对未知位姿参数进行估计。具体的,状态空间模型中,,以及为未知位姿参数。为状态噪声矢量,其对应的协方差矩阵为;为观测噪声矢量,其对应的协方差矩阵为。
[0060]
步骤302,利用贝叶斯滤波器,对该状态空间模型进行递归求解运算,得到该第一转换参数。
[0061]
其中,当构建状态空间模型后,通过利用该状态空间模型,利用贝叶斯滤波器可递归未知位姿参数。其中,贝叶斯滤波器包括粒子滤波器(particle filter, pf)和卡尔曼滤波器(kalman filter, kf),具体地,可以通过粒子滤波器和卡尔曼滤波器可以递归估计这些未知位姿参数,需要说明的是,粒子滤波器和卡尔曼滤波器分别包含多种具体类型,例如,粒子滤波器可以为无迹粒子滤波器等,卡尔曼滤波器可以为无迹卡尔曼滤波器等多种类型,本技术实施例对滤波器不做具体型号的限定。
[0062]
由于公式(3)中观测方程是非线性的,因此,不失一般性。
[0063]
以无迹卡尔曼滤波器(unscented kalman filter, ukf)为例进行阐述并提出一种用于未知位姿参数估计的ukf算法,采用该ukf进行位置位姿参数的估计,从而确定第一转换参数。可选的,实际中也可以采用其它类型的kf进行未知位姿参数估计。
[0064]
具体过程如下:请参考图4,其示出了本技术实施例提供的一种网格划分示意图。首先依据n个空间标记点的坐标对无线定位基站天线罩附近区域进行网格划分得到网格点的坐标,然后进行粒子滤波器初始化,即,结合网格点坐标从先验概率密度函数中抽取个粒子
,且粒子滤波器的初始权重为。随后进行重要性采样,即,利用先验转移概率密度函数获取个粒子,同时计算粒子滤波器对应的权重,即(4)公式(4)中,为粒子的似然函数,为归一化后的值。当确定粒子滤波器权重后,采用确定权重后的粒子滤波器进行重采样,得到粒子集。
[0065]
的后验分布估计可以表示为:(5)公式(5)中,表示狄拉克函数。
[0066]
同时,的估计值可以表示为:(6)公式(6)中,表示数学期望,将公式(6)得到的作为ukf算法的初值进行未知位姿参数的精确估计,用于未知位姿参数估计的ukf算法可以表示为:(1)滤波器初始化:(7)(2)时间更新:(8)(3)计算sigma点:(9)(4)测量更新:
(10)其中,为公式(6)中得到的,和分别为初始的未知位姿参数估计值和估计误差协方差矩阵,和为第k-1次迭代的未知位姿参数估计值和估计误差协方差矩阵,和为第k次迭代的未知位姿参数预测值和预测误差协方差矩阵,为sigma点的预测值,和为第k次迭代的观测预测值和预测误差协方差矩阵,为第k次迭代的未知位姿参数预测值和观测预测值的互协方差矩阵,为第k次迭代的卡尔曼增益矩阵,k为迭代次数,为状态噪声矢量对应的协方差矩阵;为观测噪声矢量对应的协方差矩阵。即为通过ukf算法计算得到的未知位姿参数,通过可确定第一转换参数。
[0067]
公式(10)中,为状态矢量的维数,为矩阵平方根的第列,为正整数。ukf算法中sigma点对应的权重为:(11)公式(11)中,为缩放因子,,通常设置为
,对于高斯分布。
[0068]
基于状态空间模型,通过粒子滤波器和卡尔曼滤波器,精准得到第一转换参数。通过上述方法进行未知位姿参数的估计,可得到高精度的无线定位基站阵列天线位姿参数估计结果,并且,无需计算复杂非线性函数的雅可比矩阵或者海塞矩阵,便于实施。同时,可以得到未知位姿参数的估计误差协方差矩阵,为后续定位误差分析奠定基础。如图5所示,其示出了本技术实施例提供的一种位姿参数估计值确定的流程示意图。
[0069]
在一个实施例中,如图6所示,其示出了本技术实施例提供的一种确定第二转换参数的流程示意图。该基于各第一标记点的第二坐标以及各第一标记点的第三坐标获取该直角坐标系与该无线定位基站阵列天线坐标系之间的第二转换参数,包括:步骤601,根据各第一标记点的第二坐标以及第三坐标,构建该直角坐标系与该无线定位基站阵列天线坐标系的第二转换关系式。
[0070]
该第二转换关系式为:(12)其中,和为该第二转换参数,为估计误差,为该第二坐标,为该第三坐标。
[0071]
步骤602,基于该第二转换关系式进行求解运算,得到该第二转换参数。
[0072]
其中,各第一标记点的第二坐标为无线定位基站阵列天线坐标系下的坐标,各第一标记点的第三坐标为直角坐标系下的坐标。
[0073]
使用全站仪测量各第一标记点在全站仪坐标系下的坐标,记为,,其中,为第一标记点的x轴坐标参数,为第一标记点的y轴坐标参数,为第一标记点的z轴坐标参数。
[0074]
利用第一转换参数将各第一标记点的坐标从全站仪坐标系下转换到直角坐标系下,即(13)为各第一标记点在直角坐标系下的坐标。
[0075]
将各第一标记点在无线定位基站阵列天线坐标系下的第二坐标记为,。
[0076]
利用无线定位基站阵列天线在直角坐标系中的位置以及从无线定位基站阵列天线坐标系到直角坐标系中的旋转矩阵 可以得到各第一标记点在直角坐标系中的坐标与在无线定位基站阵列天线坐标系中坐标的关系,即:(14)考虑到估计误差的影响,上式可以改写为:
(15)公式(15)即为第二转换关系式,其中,表示的估计误差,可使用多个标记点提高和的估计精度。其中,和中包含6个未知位姿参数且与姿态角有关,通过确定未知位姿参数,确定第二转换参数,并进一步确定目标天线的位姿信息。
[0077]
在一个实施例中,如图7所示,其示出了本技术实施例提供的一种基于第二转换关系式确定第二转换参数的流程示意图。基于该第二转换关系式进行求解运算,得到该第二转换参数,包括:步骤701,基于该第二转换关系式构建状态空间模型。
[0078]
其中,该状态空间模型为:(16)其中,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,m为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第二转换参数。
[0079]
步骤702,利用贝叶斯滤波器,根据该状态空间模型进行递归求解运算,得到该第二转换参数。
[0080]
其中,状态空间模型中,,、以及为未知位姿参数。为状态噪声矢量,为观测噪声矢量。k为迭代次数。yk与第二转换关系相关,可见,通过第二转换关系式可构建得到该状态空间模型。
[0081]
其中,当构建状态空间模型后,通过利用该状态空间模型,利用贝叶斯滤波器可递归未知位姿参数。其中,贝叶斯滤波器包括粒子滤波器(particle filter, pf)和卡尔曼滤波器(kalman filter, kf),具体地,可以通过粒子滤波器和卡尔曼滤波器可以递归估计这些未知位姿参数。
[0082]
与求解第一转换参数相似,以无迹卡尔曼滤波器(unscented kalman filter, ukf)为例进行阐述并提出一种用于未知位姿参数估计的ukf算法,采用该ukf进行位置位姿参数的估计,从而确定第二转换参数。可选的,实际中也可以采用其它类型的kf进行未知位姿参数估计。
[0083]
具体过程与上文采用该ukf进行位置位姿参数的估计,从而确定第一转换参数的过程相同,在此不再赘述。
[0084]
基于状态空间模型,通过粒子滤波器和卡尔曼滤波器,精准得到第二转换参数。通过上述方法进行未知位姿参数的估计,可得到高精度的无线定位基站阵列天线位姿参数估计结果,并且,无需计算复杂非线性函数的雅可比矩阵或者海塞矩阵,便于实施。同时,可以
得到未知位姿参数的估计误差协方差矩阵,为后续定位误差分析奠定基础。
[0085]
在一个实施例中,根据该第二转换参数,确定该目标天线的位姿信息,包括:根据确定该目标天线的位置坐标;根据确定该目标天线的位姿角。
[0086]
当确定第二转换参数后,第二转换参数中和与目标天线的位姿参数相关,因此,可直接通过第二转换参数中的得到目标天线的位置坐标。通过得到目标天线的位姿角,位姿角包括方位角、俯仰角以及横滚角。
[0087]
在一个实施例中,如图8所示,其示出了本技术实施例提供的一种确定阵列天线位置信息和姿态信息的流程示意图。确定无线定位基站在当地直角坐标系中的位置信息和姿态信息包括:步骤801,在阵列天线的天线罩附近空间中标记n个标记点,其中,n≥2。
[0088]
步骤802,使用全站仪测量n个标记点在全站仪坐标系中的坐标。
[0089]
步骤803,计算全站仪坐标系和当地直角坐标系之间的坐标转换关系。
[0090]
其中,可利用n个标记点在当地直角坐标系中的坐标以及在全站仪坐标系中的坐标构建该全站仪坐标系和当地直角坐标系之间的坐标转换关系。其中,该坐标转换关系中包括全站仪在当地直角坐标系中的坐标,以及为当地直角坐标系和全站仪坐标系的旋转矩阵。
[0091]
步骤804,在阵列天线的天线罩上的外侧标记m个点,其中,m≥2。
[0092]
步骤805,使用全站仪测量m个标记点在全站仪坐标系中的坐标。
[0093]
步骤806,将m个标记点的坐标从全站仪坐标系转到当地直角坐标系。
[0094]
其中,可利用m个标记点在全站仪坐标系中的坐标、全站仪在当地直角坐标系中的坐标和为当地直角坐标系和全站仪坐标系的旋转矩阵,确定m个标记点在当地直角坐标系下的坐标。获取m个标记点在无线定位基站阵列天线坐标系中的坐标,并通过m个标记点在无线定位基站阵列天线坐标系中的坐标以及m个标记点在当地直角坐标系下的坐标构建无线定位基站阵列天线坐标系与直角坐标系之间的转换关系,其中,该转换关系中包括阵列天线在当地直角坐标系中的位置以及从无线定位基站阵列天线坐标系到当地直角坐标系的旋转矩阵。
[0095]
步骤807,计算阵列天线在当地直角坐标系中的位置和姿态。
[0096]
基于构建的状态空间模型,通过粒子滤波器以及卡尔曼滤波器确定与阵列天线在当地直角坐标系中的位置以及从无线定位基站阵列天线坐标系到当地直角坐标系的旋转矩阵相关的未知位姿参数,并通过该未知位姿参数进一步确定阵列天线在当地直角坐标系中的位置和姿态。
[0097]
应该理解的是,虽然如上所述的各实施例所涉及的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,如上所述的各实施例所涉及的流程图中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的
步骤或者阶段的至少一部分轮流或者交替地执行。
[0098]
基于同样的发明构思,本技术实施例还提供了一种用于实现上述所涉及的天线位姿信息测量方法的天线位姿信息测量装置。该装置所提供的解决问题的实现方案与上述方法中所记载的实现方案相似,故下面所提供的一个或多个天线位姿信息测量装置实施例中的具体限定可以参见上文中对于天线位姿信息测量方法的限定,在此不再赘述。
[0099]
在一个实施例中,如图9所示,提供了一种天线位姿信息测量装置,该天线位姿信息测量装置900包括:第一确定模块901、第一获取模块902、第二确定模块903、第二获取模块904和第三确定模块905,其中:第一确定模块901,用于确定全站仪坐标系与直角坐标系之间的第一转换参数;第一获取模块902,用于获取目标天线的天线罩上的多个第一标记点在所述全站仪坐标系中的第一坐标以及在无线定位基站阵列天线坐标系下的第二坐标;第二确定模块903,用于基于所述第一转换参数和各所述第一标记点的第一坐标确定各所述第一标记点在所述直角坐标系下的第三坐标;第二获取模块904,用于基于各所述第一标记点的第二坐标以及各所述第一标记点的第三坐标获取所述直角坐标系与所述无线定位基站阵列天线坐标系之间的第二转换参数;第三确定模块905,用于根据所述第二转换参数,确定所述目标天线的位姿信息。
[0100]
在一个实施例中,该第一确定模块901,具体用于:获取该目标天线的天线罩周围目标空间范围内多个第二标记点在该直角坐标系下的第四坐标以及在该全站仪坐标系下的第五坐标;根据各第二标记点的第四坐标以及第五坐标,构建该全站仪坐标系与该直角坐标系的第一转换关系式;基于该第一转换关系式进行求解运算,得到该第一转换参数。
[0101]
在一个实施例中,该第一转换关系式为:其中,和为该第一转换参数,为估计误差,为该第四坐标,为该第五坐标。
[0102]
在一个实施例中,该第一确定模块901,具体用于:基于该第一转换关系式构建状态空间模型;利用贝叶斯滤波器,对该状态空间模型进行递归求解运算,得到该第一转换参数。
[0103]
在一个实施例中,该状态空间模型为:其中,,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,n为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第一转换参数。
[0104]
在一个实施例中,该第二获取模块904,具体用于:根据各第一标记点的第二坐标
以及第三坐标,构建该直角坐标系与该无线定位基站阵列天线坐标系的第二转换关系式;基于该第二转换关系式进行求解运算,得到该第二转换参数。
[0105]
在一个实施例中,该第二转换关系式为:其中,和为该第二转换参数,为估计误差,为该第二坐标,为该第三坐标。
[0106]
在一个实施例中,该第二获取模块904,具体用于:基于该第二转换关系式构建状态空间模型;利用贝叶斯滤波器,根据该状态空间模型进行递归求解运算,得到该第二转换参数。
[0107]
在一个实施例中,该状态空间模型为:其中,,,为状态噪声矢量,为观测噪声矢量,k为迭代次数,m为正整数,[
·
]
t
为矩阵转置,通过递归求解得到,并通过得到该第二转换参数。
[0108]
在一个实施例中,该第三确定模块905,具体用于:根据确定该目标天线的位置坐标;根据确定该目标天线的位姿角。
[0109]
上述天线位姿信息测量装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
[0110]
在一个实施例中,提供了一种计算机设备,该计算机设备可以是服务器,其内部结构图可以如图10所示。该计算机设备包括通过系统总线连接的处理器、存储器和网络接口。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质和内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储天线位姿信息测量数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种天线位姿信息测量方法。
[0111]
本领域技术人员可以理解,图10中示出的结构,仅仅是与本技术方案相关的部分结构的框图,并不构成对本技术方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
[0112]
在一个实施例中,还提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现上述各方法实施例中的步骤。
[0113]
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现上述各方法实施例中的步骤。
[0114]
在一个实施例中,提供了一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现上述各方法实施例中的步骤。
[0115]
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本技术所提供的各实施例中所使用的对存储器、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(read-only memory,rom)、磁带、软盘、闪存、光存储器、高密度嵌入式非易失性存储器、阻变存储器(reram)、磁变存储器(magnetoresistive random access memory,mram)、铁电存储器(ferroelectric random access memory,fram)、相变存储器(phase change memory,pcm)、石墨烯存储器等。易失性存储器可包括随机存取存储器(random access memory,ram)或外部高速缓冲存储器等。作为说明而非局限,ram可以是多种形式,比如静态随机存取存储器(static random access memory,sram)或动态随机存取存储器(dynamic random access memory,dram)等。本技术所提供的各实施例中所涉及的数据库可包括关系型数据库和非关系型数据库中至少一种。非关系型数据库可包括基于区块链的分布式数据库等,不限于此。本技术所提供的各实施例中所涉及的处理器可为通用处理器、中央处理器、图形处理器、数字信号处理器、可编程逻辑器、基于量子计算的数据处理逻辑器等,不限于此。
[0116]
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
[0117]
以上所述实施例仅表达了本技术的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本技术专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本技术构思的前提下,还可以做出若干变形和改进,这些都属于本技术的保护范围。因此,本技术的保护范围应以所附权利要求为准。
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1