[发明专利]一种测距线性定位算法

摘要

本发明提供一种测距线性定位算法，根据阵列的八个三轴磁强计对磁性体磁场的测量值，计算待测点处磁性体磁梯度张量的5个独立分量的测量值；计算待测点处磁梯度张量的测量值；将磁梯度张量测量值分为三个组，分别计算不同与磁性体之间的距离；由待测点与磁性体之间的距离组成线性方程组，由线性方程组计算磁性体的位置坐标值。本发明可以由阵列的单次测量结果同时计算出任意磁性体在阵列体心和面心处的磁梯度张量；本发明是一种快速定位算法，能唯一地反演出单个非磁偶极子磁性体的位置，定位算法速度快且没有限定这个磁性体的磁场模型，增强了这种单个磁性体线性定位算法的抗干扰能力和稳定性。

主权项

1.一种测距线性定位算法，其特征在于，具体的实现步骤为：步骤1.根据阵列的八个三轴磁强计对磁性体磁场的测量值，计算点P_n处磁性体磁梯度张量的5个独立分量的测量值其中B_xx(P_n)、B_yy(P_n)、B_xy(P_n)、B_yz(P_n)、B_xz(P_n)分别为磁性体在点P_n(n＝0,1,…,6)处的磁梯度张量的5个独立分量，为角度矩阵，为相对测量值矩阵；步骤2.由点P_n处磁性体磁梯度张量的5个独立分量的测量值计算点P_n处磁梯度张量的测量值步骤3.将磁梯度张量测量值和分为三个组，即和由三组磁梯度张量测量值分别计算点P₁和P₂、P₃和P₄、P₅和P₆与磁性体之间的距离；步骤4.由点P_n(n≠0)与磁性体之间的距离组成线性方程组，式中，和为磁性体的位置坐标，x、y和z方向上的正六面体边长分别为L_x、L_y和L_z，点P_n(n≠0)与磁性体之间的距离分别为步骤5.由线性方程组计算磁性体的位置坐标值