CN105928511B - 一种基于双磁信标的定位定向方法 - Google Patents

Abstract

一种基于双磁信标的定位定向方法，以两个相互垂直且线圈直径、匝数与通电电流已知的两组螺线管制作两个磁信标，然后将两个磁信标安装在已知位置作为信号源，定位目标安装磁强计，通过磁强计的实时测量数据；设定两个磁信标的输出频率，磁信标1中x轴频率为f₁、y轴频率为f₂，磁信标2中的x轴频率为f₃、y轴频率为f₄，两个磁信标在整个坐标系中的初始位置；从待定位目标所安装的磁力计上以大于磁信标最大频率的二倍以上的采样频率提取n个数据；对采集到的数据进行傅立叶分解，分别得到两个磁信标对应频率的两组信号，根据H₁、H₂、H₃、H₄确定目标，确定目标所在位置的方向向量：根据两方向向量，确定目标所在位置，根据两方向向量可确定两条直线。

Description

一种基于双磁信标的定位定向方法

技术领域

本发明涉及一种基于双磁信标的定位定向方法，属于定位定向方法技术领域。

背景技术

随着科技的发展，人们对定位服务的需求也日益强烈。在室外，随着GPS、北斗等卫星导航系统的完善和普及，定位精度服务已经基本满足人们的日常需求；然而这种定位方式，由于建筑物对信号强度的极大衰减导致室内卫星导航系统定位精度很差，甚至无法完成定位。复杂的室内环境给导航定位带来很大的困难。

目前，室内导航定位方法主要有以下几种：1、基于无线网络(WiFi、RFID、蓝牙等)的定位技术，该技术主要利用接收信号强度索引(RSSI)进行测距定位，当在信号的发射端和接收端存在障碍物时，信号强度会因室内的厚木板、水泥墙等引起大幅度的衰减，造成了接收端信号不稳定，从而导致导航定位精度变差。2、基于可见光的定位方法，该方法在存在遮挡或光线无法到达的环境中时无法实现导航定位，具有很大局限性。3、基于地磁信号的定位方法，该方法主要利用室内的地磁场信息实现导航定位，但是室内环境比较复杂，特别是墙内的钢筋等导磁性材料和众多电子设备的存在，对地磁信号的影响较大，无法实现精确定位。4、基于惯性导航系统的方法，该方法虽然短时间内能够提供精确的导航定位信息，但是由于其存在积累误差，随时间的增加，误差越来越大，不适合单独使用。

发明内容

本发明的目的是为了解决上述现有技术存在的问题，进而提供一种基于双磁信标的定位定向方法。

本发明的目的是通过以下技术方案实现的：

一种基于双磁信标的定位定向方法，

步骤1、以两个相互垂直且线圈直径、匝数与通电电流已知的两组螺线管制作两个磁信标，然后将两个磁信标安装在已知位置作为信号源，定位目标安装磁强计，通过磁强计的实时测量数据，分别解算出两个磁信标在目标位置所产生的方向矢量，通过两个方向矢量的交点最后可以解算出目标的位置方向信息；

步骤2、设定两个磁信标的输出频率，磁信标1中x轴频率为f₁、y轴频率为f₂，磁信标2中的x轴频率为f₃、y轴频率为f₄，两个磁信标在整个坐标系中的初始位置(p_1x,p_1y,p_1z)_，(p_2x,p_2y,p_2z)；

步骤3、从待定位目标所安装的磁力计上以大于磁信标最大频率的二倍以上的采样频率提取n个数据，n越大定位精度越高，记为H_i，i＝1…n；

步骤4、对采集到的数据进行傅立叶分解，分别得到两个磁信标对应频率的两组信号，其中H₁＝(h_1x,h_1y,h_1z)为磁信标1中x轴产生的磁场强度、H₂＝(h_2x,h_2y,h_2z)为磁信标1中y轴产生的磁场强度、H₃＝(h_3x,h_3y,h_3z)为磁信标2中x轴产生的磁场强度，以及H₄＝(h_4x,h_4y,h_4z)为磁信标2中y轴产生的磁场强度；

步骤5、根据H₁、H₂、H₃、H₄确定目标，确定目标所在位置的方向向量：

其中(x₁,y₁,z₁)为在磁信标1中，x轴正方向的实际方向向量，(x₁,y₁,z₁)＝(1,0,0)，(x₂,y₂,z₂)为在磁信标1中，y轴正方向的实际方向向量，(x₂,y₂,z₂)＝(0,1,0)，(x₃,y₃,z₃)为在磁信标2中，x轴正方向的实际方向向量，(x₃,y₃,z₃)＝(1,0,0)，(x₄,y₄,z₄)为在磁信标2中，y轴正方向的实际方向向量，(x₄,y₄,z₄)＝(0,1,0)；为垂直于平面o₁x₁P的法向量，为垂直于平面o₁y₁P的法向量，因此，垂直于o₁P，垂直于o₁P，于是为o₁P的方向向量，同理可得为o₂P的方向向量；

步骤6、根据两方向向量，确定目标所在位置，根据两方向向量可确定两条直线：

则目标点P为两条直线的交点：

R_1x*k₁-R_2xk*k₂＝-p_1x+p_2x

R_1y*k₁-R_2yk*k₂＝-p_1y+p_2y

然后分别得到k₁、k₂，则目标位置

P＝(k₁*R_1x+p_1x,k₁*R_1y+p_1y,k₁*R_1z+p_1z)＝(P_x,P_y,P_z)

其中磁强计所测量的数据均为通过姿态矩阵将目标本地坐标系下的磁场测量数据转换到所建立的模型坐标系后的数据。

本发明的有益效果：1、相对WiFi等无线信号，旋转磁场的频率更低(1K～10KHz)，信号穿透力强，具有更大的作用域。2、利用旋转磁场矢量方向不变的特性进行定位，而不是直接使用接收信号的强度进行定位，避免了因环境影响导致信号强度大幅衰减的问题。3、提高了定位的速度和精度，降低了导航定位的误差。

附图说明

图1为本发明基于双磁信标的定位定向方法示意图。

具体实施方式

下面将结合附图对本发明做进一步的详细说明：本实施例在以本发明技术方案为前提下进行实施，给出了详细的实施方式，但本发明的保护范围不限于下述实施例。

如图1所示，本实施例所涉及的一种基于双磁信标的定位定向方法，步骤如下：

步骤1、以两个相互垂直且线圈直径、匝数与通电电流已知的两组螺线管制作两个磁信标，然后将两个磁信标安装在已知位置作为信号源，定位目标安装磁强计，通过磁强计的实时测量数据，分别解算出两个磁信标在目标位置所产生的方向矢量，通过两个方向矢量的交点最后可以解算出目标的位置方向信息；

步骤2、设定两个磁信标的输出频率，磁信标1中x轴频率为f₁、y轴频率为f₂，磁信标2中的x轴频率为f₃、y轴频率为f₄，两个磁信标在整个坐标系中的初始位置(p_1x,p_1y,p_1z)_，(p_2x,p_2y,p_2z)_；

步骤3、从待定位目标所安装的磁力计上以大于磁信标最大频率的二倍以上的采样频率提取n个数据，n越大定位精度越高，记为H_i，i＝1…n；

步骤4、对采集到的数据进行傅立叶分解，分别得到两个磁信标对应频率的两组信号，其中H₁＝(h_1x,h_1y,h_1z)为磁信标1中x轴产生的磁场强度、H₂＝(h_2x,h_2y,h_2z)为磁信标1中y轴产生的磁场强度、H₃＝(h_3x,h_3y,h_3z)为磁信标2中x轴产生的磁场强度，以及H₄＝(h_4x,h_4y,h_4z)为磁信标2中y轴产生的磁场强度；

步骤5、根据H₁、H₂、H₃、H₄确定目标，确定目标所在位置的方向向量：

其中(x₁,y₁,z₁)为在磁信标1中，x轴正方向的实际方向向量，(x₁,y₁,z₁)＝(1,0,0)，(x₂,y₂,z₂)为在磁信标1中，y轴正方向的实际方向向量，(x₂,y₂,z₂)＝(0,1,0)，(x₃,y₃,z₃)为在磁信标2中，x轴正方向的实际方向向量，(x₃,y₃,z₃)＝(1,0,0)，(x₄,y₄,z₄)为在磁信标2中，y轴正方向的实际方向向量，(x₄,y₄,z₄)＝(0,1,0)；为垂直于平面o₁x₁P的法向量，为垂直于平面o₁y₁P的法向量，因此，垂直于o₁P，垂直于o₁P，于是为o₁P的方向向量，同理可得为o₂P的方向向量；

步骤6、根据两方向向量，确定目标所在位置，根据两方向向量可确定两条直线：

则目标点P为两条直线的交点：

R_1x*k₁-R_2xk*k₂＝-p_1x+p_2x

R_1y*k₁-R_2yk*k₂＝-p_1y+p_2y

分别得到k₁、k₂，则目标位置

P＝(k₁*R_1x+p_1x,k₁*R_1y+p_1y,k₁*R_1z+p_1z)＝(P_x,P_y,P_z)

其中磁强计所测量的数据均为通过姿态矩阵将目标本地坐标系下的磁场测量数据转换到所建立的模型坐标系后的数据。

实施例1：对双信标定位系统定位精度进行验证，其中信标1的磁场与目标之间存在衰减系数为0.91的障碍物，将本实施例与根据磁场强度确定位置的方法进行比较：

首先设定两个磁信标的输出频率，磁信标1中x轴频率为f₁＝2Hz、y轴频率为f₂＝5Hz，磁信标2中的x轴频率为f₃＝7Hz、y轴频率为f₄＝9Hz，两个磁信标在整个坐标系中的初始位置(p_1x,p_1y,p_1z)＝(100,0,0)，(p_2x,p_2y,p_2z)＝(-100,0,0)，目标所在位置为(15,60,10)。

再在从待定位目标所安装的磁力计上以f＝100Hz为采样频率提取n＝100次采样数据，记为H_i，i＝1,2…100；按照上述实施方式中步骤3至步骤5进行计算，则可得到定位结果如表1所示

表1

以上所述，仅为本发明较佳的具体实施方式，这些具体实施方式都是基于本发明整体构思下的不同实现方式，而且本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求书的保护范围为准。

Claims (1)

1.一种基于双磁信标的定位定向方法，其特征在于，

步骤1、以两个相互垂直且线圈直径、匝数与通电电流已知的两组螺线管制作两个磁信标，然后将两个磁信标安装在已知位置作为信号源，定位目标安装磁强计，通过磁强计的实时测量数据，分别解算出两个磁信标在目标位置所产生的方向矢量，通过两个方向矢量的交点最后可以解算出目标的位置方向信息；

步骤2、设定两个磁信标的输出频率，磁信标1中x轴频率为f₁、y轴频率为f₂，磁信标2中的x轴频率为f₃、y轴频率为f₄，两个磁信标在整个坐标系中的初始位置(p_1x,p_1y,p_1z)，(p_2x,p_2y,p_2z)；

步骤3、从待定位目标所安装的磁力计上以大于磁信标最大频率的二倍以上的采样频率提取n个数据，n越大定位精度越高，记为H_i，i＝1…n；

步骤4、对采集到的数据进行傅立叶分解，分别得到两个磁信标对应频率的两组信号，其中H₁＝(h_1x,h_1y,h_1z)为磁信标1中x轴产生的磁场强度、H₂＝(h_2x,h_2y,h_2z)为磁信标1中y轴产生的磁场强度、H₃＝(h_3x,h_3y,h_3z)为磁信标2中x轴产生的磁场强度，以及H₄＝(h_4x,h_4y,h_4z)为磁信标2中y轴产生的磁场强度；

步骤5、根据H₁、H₂、H₃、H₄确定目标，确定目标所在位置的方向向量：

其中(x₁,y₁,z₁)为在磁信标1中，x轴正方向的实际方向向量，(x₁,y₁,z₁)＝(1,0,0)，(x₂,y₂,z₂)为在磁信标1中，y轴正方向的实际方向向量，(x₂,y₂,z₂)＝(0,1,0)，(x₃,y₃,z₃)为在磁信标2中，x轴正方向的实际方向向量，(x₃,y₃,z₃)＝(1,0,0)，(x₄,y₄,z₄)为在磁信标2中，y轴正方向的实际方向向量，(x₄,y₄,z₄)＝(0,1,0)；为垂直于平面o₁x₁P的法向量，为垂直于平面o₁y₁P的法向量，因此，垂直于o₁P，垂直于o₁P，于是为o₁P的方向向量，同理可得为o₂P的方向向量；

步骤6、根据两方向向量，确定目标所在位置，根据两方向向量可确定两条直线：

则目标点P为两条直线的交点：

R_1x*k₁-R_2xk*k₂＝-p_1x+p_2x

R_1y*k₁-R_2yk*k₂＝-p_1y+p_2y

然后分别得到k₁、k₂，则目标位置

P＝(k₁*R_1x+p_1x,k₁*R_1y+p_1y,k₁*R_1z+p_1z)＝(P_x,P_y,P_z)

其中磁强计所测量的数据均为通过姿态矩阵将目标本地坐标系下的磁场测量数据转换到所建立的模型坐标系后的数据。