[發(fā)明專利]磁場方向傳感器校正和計算方法、裝置、存儲介質(zhì)及設(shè)備

有效

• 申請?zhí)枺?/td>: 202010185343.5
• 申請日: 2020-03-17
• 公開（公告）號: CN111505538B
• 公開（公告）日: 2022-12-09
• 發(fā)明（設(shè)計）人: 孫建東;薛山;馮超;刁懷慶;李林旗;周贊
• 申請（專利權(quán)）人: 天津中科華譽科技有限公司
• 主分類號: G01R33/00
• 分類號: G01R33/00;G01R33/02
• 代理公司: 北京頭頭知識產(chǎn)權(quán)代理有限公司 11729
• 代理人: 劉鋒;宋國云

1.一種磁場方向傳感器校正和計算方法，其特征在于，所述方法包括：

產(chǎn)品下線后在工廠中第一次上電時，執(zhí)行如下步驟：

S1：檢測磁場X軸方向的磁場分量X值和Y軸方向的磁場分量Y值，使磁體旋轉(zhuǎn)至少一圈，并在旋轉(zhuǎn)過程中獲取n組X值X₁、X₂...X_n和n組Y值Y₁、Y₂...Y_n；

S2：通過式(1)和式(2)計算X值的偏移量O_X和Y值的偏移量O_Y；

O_X＝(X₁+X₂+…+X_n)/n (1)

O_Y＝(Y₁+Y₂+…+Y_n)/n (2)

S3：通過式(3)和式(4)計算相鄰兩組之間的角度變化量Δβ和第m組的角度β_m；

Δβ＝360/n (3)

β_m＝mΔβ(m＝1、2、3…n) (4)

S4：通過式(5)～式(8)計算X值的實部X_r、X值的虛部X_i、Y值的實部Y_r和Y值的虛部Y_i；

X_r＝2*(X₁*cosβ₁+X₂*cosβ₂+…+X_n*cosβ_n)/n (5)

X_i＝2*(X₁*sinβ₁+X₂*sinβ₂+…+X_n*sinβ_n)/n (6)

Y_r＝2*(Y₁*cosβ₁+Y₂*cosβ₂+…+Y_n*cosβ_n)/n (7)

Y_i＝2*(X₁*sinβ₁+X₂*sinβ₂+…+X_n*sinβ_n)/n (8)

S5：通過式(9)和式(10)計算X值的振幅A_X和Y值的振幅A_Y；

S6：通過式(11)～式(13)計算X值的相位Y值的相位和相位差

S7：將X值的偏移量O_X、Y值的偏移量O_Y、X值的振幅A_X、Y值的振幅A_Y、X值的相位Y值的相位和相位差存儲；

每次需要計算磁場角度時，執(zhí)行如下步驟：

S1’：獲取X值X和Y值Y；

S2’：通過式(14)和式(15)消除X和Y的偏移量，得到X_a和Y_a；

X_a＝X-O_X (14)

Y_a＝Y(jié)-O_Y (15)

S3’：通過式(16)和式(17)消除X和Y的振幅影響，得到X_b和Y_b；

X_b＝X_a/A_X (16)

Y_b＝Y(jié)_a/A_Y (17)

S4’：通過式(18)和式(19)對X和Y進行校準，得到X_M和Y_M；

X_M＝X_b (18)

S5’：通過式(20)計算得到磁場角度α；