[发明专利]一种基于磁偶极子模型的磁性标记物定位方法及装置

说明书

本发明提供一种基于磁偶极子模型的定位方法及装置，方法包括如下步骤：A、固定布置磁性标记物和由M个磁传感器组成的磁传感器模块；B、读取第i个磁传感器所测得的磁感应强度数据，建立磁偶极子模型，得到磁偶极子模型的第一简化模型并转换为一个一元四次方程，并解得该方程的正实根；C、对所述第一简化模型进行变换得到第二简化模型，并计算得到磁性标记物对应于第i个磁传感器时的空间二维位置；D、将磁性标记物分别对应于M个磁传感器时的各空间二维位置进行融合，得到磁性标记物的最终位置。本发明在保证定位高精度的前提下，减少了计算所需的时间以及计算的空间复杂度，且不依赖于初始位置的猜测与估计，提升了整体的鲁棒性。

技术领域

本发明涉及一种基于磁偶极子模型的磁性标记物定位方法及装置。

背景技术

由于拥有在无人为干预情况下自动工作的能力，自动导引车(Automated GuidedVehicle，AGV)已被广泛采用。定位和导航方法是AGV解决方案的基本要素，而一些基于标记的定位方法，如磁条、磁钉、射频识别和二维码定位技术，由于其低成本和高稳定性被广泛用于工业物流场景。

基于磁钉的定位方法，是将磁钉沿着所需的AGV行走路线埋入地面，其中最靠近AGV的磁钉的磁场强度分布通过磁强计传感器阵列测量，因此可以基于感应的磁场强度估计磁钉与磁强计传感器阵列之间的距离。与其他基于标记的定位方法相比，基于磁钉的定位方法不易损坏、不容易受到光、雪、雨的影响，因此，基于磁钉的定位方法是室内和室外环境中的使用且可靠的解决方案。

但是，传统的磁钉定位方法的精度大多不能满足AGV高精度组装应用的精度需求。在中国专利文献CN107957725B中公开采用了一种基于超强铁钕硼永磁体、磁偶极子模型和优化算法的新型磁定位算法，其优势是定位精度优异。但该方法是基于数值迭代计算的优化算法，数值迭代计算必须有一个初始位置的猜测值，算法计算复杂，在单片机上实时执行难度大。因此，该方法虽然定位精度优异，但计算复杂度较高、计算时间较长且鲁棒性不好。

发明内容

本发明提出一种基于磁偶极子模型的磁性标记物定位方法及装置，在保证定位高精度的前提下，减少了计算所需的时间以及计算的空间复杂度，且不依赖于初始位置的猜测与估计，提升了整体的鲁棒性。

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

一种基于磁偶极子模型的磁性标记物定位方法，其特征在于：包括如下步骤：

A、固定布置磁性标记物和由M个磁传感器组成的磁传感器模块，磁性标记物的两极连线竖直延伸，且位于各磁传感器的感应范围内；

B、读取第i个磁传感器所测得的磁感应强度数据，根据该磁感应强度数据建立磁偶极子模型，基于磁性标记物的竖直布置方式，得到磁偶极子模型的第一简化模型，并将该第一简化模型转换为一个一元四次方程，利用解析方法对该一元四次方程进行求解以得到正实根，并进入步骤C；

C、对所述第一简化模型进行变换得到第二简化模型，根据磁传感器模块所在位置与磁性标记物中心位置之间的高度相关参数、正实根和第二简化模型，计算得到磁性标记物对应于第i个磁传感器时的空间二维位置；

D、将磁性标记物分别对应于M个磁传感器时的各空间二维位置进行融合，得到磁性标记物的最终位置。

进一步的，所述步骤B包括如下步骤：

B1、建立以磁传感器模块中心为原点的全局坐标系和以第i个磁传感器为中心的局部坐标系，第i个磁传感器在全局坐标系下的坐标为(u^g,v^g)；

B2、根据第i个磁传感器测得的磁感应强度数据建立磁偶极子模型为：