一种基于空间多点磁场强度信息融合的磁定位方法技术

一种基于空间多点磁场强度信息融合的磁定位方法，通过按照一定距离间隔布置的多个磁传感器测量多个空间点的磁场强度信息，通过每个空间测量点的磁场强度矢量可以计算得到磁性标记物的位置信息，多个空间测量点的定位结果之间可以得到相互间的置信因子组成置信矩阵，进而实现多个空间测量点的定位结果之间的信息融合，可以提高定位精度和稳定性等性能。可以提高定位精度和稳定性等性能。可以提高定位精度和稳定性等性能。

【技术实现步骤摘要】
一种基于空间多点磁场强度信息融合的磁定位方法


[0001]本专利技术涉及一种磁定位方法。

技术介绍

[0002]在空间目标检测、移动设备导航、军事目标定位、消化道医疗机器人、计算机辅助微创外科手术等领域，需要高精度的跟踪定位。磁钉定位具有体积小、信号稳定、精度高、成本低、不易受外界干扰的优点。具体应用举例来说，磁钉定位可以预埋在规划轨迹中，帮助机器人实现自主导航。
[0003]目前实现磁钉定位的方法很多，其中应用较广的是单一磁传感器的磁钉定位方法，如中国专利文献CN107091606A公开了一种基于磁尺的磁钉定位方法，把磁钉打包成一条磁尺的进行检测；如中国专利文献CN108151766A公开了磁钉的定位方法、磁钉定位导航误差修正方法及定位装置，通过检测磁场强度相同的测量点进行拟合，从而找到磁钉的位置。这些方法的不足之处在于，只使用了单一的磁传感器传感器，检测磁钉的定位精度较差。

技术实现思路

[0004]本专利技术的目的是针对现有技术的不足，提供一种可实现高精度定位的基于空间多点磁场强度信息融合的磁定位方法。
[0005]本专利技术的目的通过如下技术方案来实现：
[0006]一种基于空间多点磁场强度信息融合的磁定位方法，其特征在于：采用多个磁传感器实现磁性标记物的准确定位，包括如下步骤：
[0007]步骤S1、设备调试，测试磁传感器读数正常，读取第i个磁传感器所在的磁场强度B
i
，i＝1,2,3,...,m，则进入步骤S2；
[0008]步骤S2、建立磁偶极子模型，测量第i个磁传感器在全局坐标系{g}下的坐标测量磁性标记物在第i个磁传感器所在的局部坐标系{s}下的坐标从而计算磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标则进入步骤S3；
[0009]步骤S3、计算置信矩阵，计算第i个磁传感器和第j个磁传感器的置信因子d
ij
，j＝1,2,3,...,m,且i≠j,从而构造置信矩阵D
ij
，
[0010]则进入步骤S4；
[0011]步骤S4、计算多个磁传感器的融合定位结果，根据置信因子d
ij
、融合权重w
i
和磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标计算多磁传感器的融合定位结果w
i
＝k1d
i1
+k2d
i2
+...+k
m
d
ij
，式中，k为特征向量，k＝1,2,...,m，根据置信矩阵D
ij
计算融合权重矩阵W：W＝D
ij
K，式中，W＝[w
1 w2...w
m
]T
为融合权重矩阵；K＝[k
1 k2…
k
m
]T
为特征向量矩阵；
[0012]根据置信准则可以得到最终的磁力计融合定位结果
[0013][0014]所述步骤S2中的多个磁传感器矩阵排列，即第i个磁传感器和第j个磁传感器之间的相对距离固定不变。
[0015]所述步骤S3中的置信矩阵D
ij
为包含i行j列的置信因子d
ij
的矩阵。
[0016]所述步骤S4中的融合权重w
i
为包含置信因子d
ij
的权重，需要满足其中，m为磁传感器的数量，0≤w
i
≤1。
[0017]所述磁传感器为磁强计、磁力计或特斯拉计。
[0018]所述磁性标记物为磁钉、磁针或磁块。
[0019]本专利技术具有如下有益效果：
[0020]通过按照一定距离间隔布置的多个磁传感器测量多个空间点的磁场强度信息，通过每个空间测量点的磁场强度矢量可以计算得到磁性标记物的位置信息，多个空间测量点的定位结果之间可以得到相互间的置信因子组成置信矩阵，进而实现多个空间测量点的定位结果之间的信息融合，可以提高定位精度和稳定性等性能，具体为：
[0021]1、将多个磁传感器的定位信息进行融合，得到精度更高的磁性标记物定位结果。传统的磁性标记物定位方法使用的是单一的磁传感器，磁性标记物定位结果的精度较差；本方法使用了任意数量的磁传感器的定位信息进行融合，获得了精度更高的磁性标记物定位结果。
[0022]2、将多个磁传感器的定位信息进行融合，得到更稳定的磁性标记物定位结果，由于地磁场的磁场强度干扰、多个磁性标记物的磁场强度影响，单一的磁传感器检测到的信息易发生漂移；本方法使用了任意数量的磁传感器的定位信息进行融合，获得了稳定性更好的磁性标记物定位结果。
附图说明
[0023]下面结合附图对本专利技术作进一步详细说明。
[0024]图1为本专利技术的多个磁传感器融合定位的流程图；
[0025]图2为本专利技术的多个磁传感器阵列检测磁钉定位示意图；
[0026]图3为本专利技术的多个磁传感器阵列的坐标系示意图。
具体实施方式
[0027]参照图1至图3所示，一种基于空间多点磁场强度信息融合的磁定位方法，其特征在于：采用多个磁传感器实现磁性标记物的准确定位，磁性标记物为磁钉、磁针或磁块，磁传感器为磁强计、磁力计或特斯拉计，包括如下步骤：
[0028]步骤S1、设备调试，测试磁传感器读数正常，读取第i个磁传感器所在的磁场强度B
i
，i＝1,2,3,...,m，则进入步骤S2；
[0029]步骤S2、建立磁偶极子模型，测量第i个磁传感器在全局坐标系{g}下的坐标测量磁性标记物在第i个磁传感器所在的局部坐标系{s}下的坐标从而计算磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标则进入步骤S3，步骤S2中的多个磁传感器矩阵排列，即第i个磁传感器和第j个磁传感器之间的相对距离固定不变；
[0030]步骤S3、计算置信矩阵，计算第i个磁传感器和第j个磁传感器的置信因子d
ij
，j＝1,2,3,...,m,且i≠j,从而构造置信矩阵D
ij
，置信矩阵D
ij
为包含i行j列的置信因子d
ij
的矩阵：
[0031]则进入步骤S4；
[0032]步骤S4、计算多个磁传感器的融合定位结果，根据置信因子d
ij
、融合权重w
i
和磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标计算多磁传感器的融合定位结果w
i
＝k1d
i1
+k2d
i2
+...+k
m
d
ij
，式中，k为特征向量，k＝1,2,...,m，根据置信矩阵D
ij
计算融合权重矩阵W：W＝D
ij
K，式中，W＝[w
1 w2...w
m
]T
为融合权重矩阵；K＝[k
1 k2...k本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于空间多点磁场强度信息融合的磁定位方法，其特征在于：采用多个磁传感器实现磁性标记物的准确定位，包括如下步骤：步骤S1、设备调试，测试磁传感器读数正常，读取第i个磁传感器所在的磁场强度B
i
，i＝1,2,3,...,m，则进入步骤S2；步骤S2、建立磁偶极子模型，测量第i个磁传感器在全局坐标系{g}下的坐标测量磁性标记物在第i个磁传感器所在的局部坐标系{s}下的坐标从而计算磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标则进入步骤S3；步骤S3、计算置信矩阵，计算第i个磁传感器和第j个磁传感器的置信因子d
ij
，j＝1,2,3,...,m,且i≠j,从而构造置信矩阵D
ij
，则进入步骤S4；步骤S4、计算多个磁传感器的融合定位结果，根据置信因子d
ij
、融合权重w
i
和磁性标记物在第i个磁传感器所在的全局坐标系{g}下的坐标计算多磁传感器的融合定位结果w
i
＝k1d
i1
+k2d
i2
+...+k
m
d
ij
，式中，k为特征向量，k＝1,2,...,m，根据置信矩阵D
ij
计算融合权重矩阵W：W＝D
ij
K，式中，...

【专利技术属性】
技术研发人员：戴厚德，赵四林，姚瀚晨，朱利琦，赵冉，苏诗荐，董丽菲，刘鹏华，郭鹏飞，
申请(专利权)人：泉州装备制造研究所，
类型：发明
国别省市：