一種高速旋轉彈彈體磁場干擾的在線修正方法

王凡 張曉明 曹院 周杰 劉俊 李杰

引用格式：王凡，張曉明，曹院，等.一種高速旋轉彈彈體磁場干擾的在線修正方法［J］.航空兵器，2023，30（1）：114-119.

WangFan，ZhangXiaoming，CaoYuan，etal.AReal-TimeOnlineCorrectionMethodforMagneticFieldInterferenceonHigh-SpeedRotatingProjectile［J］.AeroWeaponry，2023，30（1）：114-119.（inChinese）

摘要：滾轉角的準確測量是受控高速旋轉彈進行精確制導與控制的前提。然而，基于磁傳感器的彈載地磁測姿方法因受到彈體磁場的干擾，會影響磁傳感器測量的準確性。針對該問題，提出一種彈體磁場干擾在線修正方法，根據高速旋轉彈飛行過程中可能受到的磁場干擾，建立磁場誤差模型，通過旋轉彈飛行規律約束，對磁傳感器測量得到的磁場值進行實時修正補償。通過半物理仿真試驗驗證，該方法可以有效降低測量誤差，提高彈體滾轉角估計精度。通過三軸飛行轉臺測量對該方法進行了驗證，地磁測姿滾轉角精度可以提高6倍。該方法僅需三軸磁傳感器即可完成修正，步驟簡單，修正時間極短，實時性好，精度高。

關鍵詞：地磁測姿；高速旋轉彈；在線修正；實時濾波；滾轉角解算;精確制導

中圖分類號：TJ765

文獻標識碼：A

文章編號：1673-5048（2023）01-0114-06

DOI：10.12132/ISSN.1673-5048.2022.0151

0引言

考慮到成本以及高速旋轉彈發射時高過載、高自旋的極端環境，高速旋轉彈上一些傳統的飛行姿態測量方法受到限制［1］。磁阻式傳感器具有全固態的結構特性，抗高過載和沖擊的能力更強，且測量誤差不隨時間積累、體積小、功耗低［2］，地磁測姿方法能夠在高過載的發射環境及高動態的飛行狀態下實現高采樣率、高分辨率的實時姿態測量。但彈藥在存儲以及發射過程中，彈體剩磁、高過載的發射環境對彈體材料磁場有影響，舵機工作以及一些材料在飛行過程中所產生的不同原因的磁場干擾，會影響磁傳感器采集的準確性。隨著地磁傳感器在有控火炮等領域的應用越來越廣泛，關于彈載地磁測姿系統的標定和實時補償技術的研究也變得越來越多。

目前，在地面靜態條件下的補償方法包括借助外部基準的直接校正方法［3-6］和以橢球擬合法為代表的間接校正方法［7-10］。然而這些方法都只能標定補償磁傳感器的制造及安裝誤差，包括三軸間零偏、靜態靈敏度、軸間不正交角、軸向對準誤差等參數以及結構的固定磁場干擾，并沒有考慮到彈體飛行過程中多種干擾因素導致磁傳感器所在位置的磁場值與彈體環境磁場的差異，無法抑制旋轉彈飛行過程中彈體磁場干擾。

針對彈體磁場干擾的校準，楊宇彬等［11］提出異常磁信號濾除算法。該算法針對導彈地磁測姿模塊實際工作環境的工程應用問題，通過最優線性移動平滑算法對飛行過程中的采樣數據進行估計，實現對出現的異常磁信號即野值進行濾除。但該方法僅適用于干擾信號中類脈沖信號的消除，對彈體飛行過程中長時間存在的干擾磁場量無法濾除［12］。在彈丸發射及飛行過程中，已經完成標定的磁傳感器會因彈上多種干擾導致滾轉角解算精度下降。因此，發射前標定的固定磁補償參數無法保證彈體在飛行過程中磁測系統依然保持很高的滾轉角解算精度。

本文結合高速旋轉彈的飛行特點以及地磁場在彈丸載體坐標系下的投影進行理論分析并建模仿真，提出在對彈體快速標定的基礎上，通過原始解算滾轉角及地磁場模值共同約束的滾轉角解算修正方法，解決彈體發射及飛行過程中，彈體磁場對磁測系統滾轉角解算帶來的影響。

1地磁解算滾轉角原理

當炮彈發射點坐標確定后，根據IGRF模型及發射航向角，即可根據該點的地磁要素得到地磁場強度在發射坐標系中的三軸磁場投影分量Hf。將三軸磁阻傳感器安裝在彈體的質心處，傳感器的三個敏感軸軸向分別與彈體X，Y，Z軸相重合，該傳感器可以測得彈體坐標系中三軸磁場投影分量Hb。旋轉彈藥在發射出炮膛后，航向角基本不變，即速度矢量始終在射擊面內。根據該零偏航假設，彈丸飛行過程中地磁場保持不變。按照發射坐標系到彈體坐標系的旋轉關系，可以得到Hf與Hb的轉換關系：

Hb=CbfHf（1）

式中：

Cbf=Rx（γ）Rz（θ）Ry（ψ）。

由于Cbf在數學形式上是一個相關矩陣，三軸分量值并不相互獨立，因此無法獨立解出三個姿態角。按照假設，在誤差允許的范圍內，可近似設偏航角為0，即ψ=0，式（1）可簡化為

Hb=CbfHf=Rx（γ）Rz（θ）Ry（0）Hf（2）

將式（2）由矩陣形式拆解，得到三軸磁傳感器測得的理論磁場投影分量：

Hbx=Hfxcosθ+Hfysinθ

Hby=－Hfxcosγsinθ+Hfycosγcosθ+Hfzsinγ

Hbz=Hfxsinγsinθ－Hfysinγcosθ+Hfzcosγ（3）

再由式（3）可以解得俯仰角θ及滾轉角γ。

2誤差模型建立

2.1誤差源分析

彈體在靜態環境下，測量誤差主要來源于磁傳感器的制造誤差、裝配誤差以及彈體鐵磁材料所產生的干擾磁場等疊加帶來的誤差。

彈丸的許多結構件會使用鐵磁材料來保證其彈體強度，其中，矯頑力較大的硬磁材料在存儲的過程中，因處在地磁場環境下受到磁化，而產生緩慢變化著的磁場；矯頑力較小的軟磁材料在飛行過程中受地磁場磁化后也會產生感應磁場，且產生的感應磁場大小及方向會隨彈體姿態及其在地磁場中的位置變化而變化。發射時的高過載也會使彈體上部分材料結構發生改變，進而引起磁場變化；同時，熱電池上電、電機線圈工作，以及彈載電氣設備的電源線、信號線等導電線路及動力系統、舵機周圍空間也會產生相應的彈載電流磁場，這些非穩態干擾磁場會對姿態測量精度帶來很大影響；此外，彈體中電路的鐵磁材料以及飛行時彈丸高速旋轉，使得尾翼等切割磁力線會產生不同程度的渦流磁場。

由于彈上磁傳感器一般采用捷聯安裝方式，這也導致在有限的彈體空間內，無法保證磁傳感器距離所有干擾源足夠遠，磁傳感器會測得地磁場和干擾磁場的合成磁場來解算姿態角，因此不可避免會引入載體磁場干擾。發射前的快速標定，可以修正大部分因材料及結構帶來的磁場干擾，而受到高過載的發射環境及飛行過程中各種因素帶來的磁場干擾，需要對其進行實時修正。

2.2誤差模型

按磁場源的特性不同，飛行過程中彈體干擾磁場可以分解為固定磁場、感應磁場、渦流磁場及隨機磁場四種磁場。磁傳感器在彈體上捷聯安裝后，其與彈體固定磁場干擾源之間的相對位置和相對姿態是固定不變的。捷聯磁傳感器在彈體轉動中，固定磁場矢量在磁傳感器位置處的投影可以等效為在磁傳感器處附加了一個偏置磁場，描述為

Hbp=Hbp，xHbp，yHbp，zT（4）

感應磁場與隨機磁場對磁傳感器安裝位置處的影響比較復雜，其與彈體結構、飛行姿態、運動狀態等均有關，隨彈體姿態和彈體在地磁場中的位置變化而變化。可以將其描述為

Hbi=CiHbG（5）

Ci=c11c12c13c21c22c23c31c32c33（6）

式中：HbG為地磁場矢量在彈體坐標系的投影；Hbi為地磁場矢量和干擾磁場合矢量在彈體坐標系下的投影。

考慮到彈體結構大多為細長型圓柱狀，彈體外殼截面積較小，因此彈體軸向方向上彈體磁場干擾比較小，即彈體干擾磁場對X軸影響近似視為0，可以表示為Hbp，x≈0，c11≈0；同時，該彈體飛行運動中干擾磁場對磁場的旋轉作用比較小。因此，Ci可以近似等效表示為

Ci=0000c22000c33（7）

理想情況下，其徑向兩分量（Y，Z軸）的空間分布為一圓心為O、半徑為地磁場強度值在彈體橫截面的投影的圓。在受到固定磁場干擾時，徑向兩分量構成的圓形投影發生偏移；受到其他磁場的影響，在該截面投影近似畸變為一個橢圓。不同磁場干擾下，載體系下Y，Z軸磁場測量示意如圖1所示。

綜合彈體上述幾種干擾磁場，可將彈載干擾磁場的數學模型簡化表示為

Hbdisturb，xHbdisturb，yHbdisturb，z=0Hbp，yHbp，z+0000c22000c33HbG，xHbG，yHbG，z（8）

3修正算法

結合高速旋轉彈的運動規律，在飛行過程中，彈丸滾轉角轉速遠高于俯仰角的變化速率，因此在一個旋轉周期內，可以將俯仰角近似視為常量，在此條件下整理式（3）并結合式（8）可以得到磁傳感器實際測量磁場值：

Hbx=（Hfx）2+（Hfy）2sinθ+arctanHfxHfy

Hby=Hfyzsin（γ+1）+Hbp，y+c22HbG，y

Hbz=Hfyzcos（γ+2）+Hbp，z+c33HbG，z（9）

式中：

Hfyz=（Hfxsinθ－Hfycosθ）2+（Hfz）2；

1=2=－arctanHfxsinθ－HfycosθHfz。

式中：Hf為地磁場強度在發射坐標系中的三軸磁場投影分量，視為常量。由式（9）可得，理論上載體系下X軸磁場投影Hbx與轉速無關，因此對于磁傳感器X軸測得的磁場值，可以采用低通濾波的方式去除高頻震動及磁畸變等帶來的測量值和彈丸滾轉同頻的干擾。

為保證數據處理的實時性，濾波器設計選用IIR數字低通濾波器。根據旋轉彈飛行規律，設置濾波器截止頻率為2Hz。地磁傳感器X軸測量磁場初值可能較大，結合旋轉彈飛行規律可得該磁場值變化緩慢。若要盡可能提高濾波器響應速度，必然導致系統運算量大幅增加。通過設置初始三分量中X軸磁場值作為濾波器初始值，減小系統響應時間。濾波器參數如表1所示。

彈體外彈道飛行中需要通過姿態機動實現彈道修正。軸向轉速變化范圍大，Y，Z軸頻率隨著彈丸轉速變化而變化，濾波器在不同頻率下幅頻特性不同，這使得系統在彈體的不同轉速下解算得到的靈敏度不同，無法對這兩軸向的靈敏度做出準確估計與補償，且設計對應的濾波算法會大幅增加計算量。由式（9）可以分析得到，Y，Z兩軸測得的磁場值理論上應為同頻、相位相差π2的正弦曲線。針對第2小節分析得到的誤差模型，設計算法找到Y，Z軸所采集磁場信息中每個滾轉周期的最大、最小值，計算得到偏移零點Yoffset和Zoffset以修正固定磁場帶來的磁場干擾Hbp，y和Hbp，z：

Yoffset=12×（Ymax+Ymin）

Zoffset=12×（Zmax+Zmin）（10）

對于磁畸變問題，通過分別找到Y，Z兩軸所測磁場值穿越0值時刻對應的另一個軸的測量值，以地磁場向量的模值作為約束，求解比例因子k，修正感應磁場等原因帶來的磁場干擾c22HbG，y和c33HbG，z：

k1=F－（Hbx0）2Hby0k2=F－（Hbx1）2Hbz0（11）

式中：F為地磁場模值；Hbx0和Hby0為上一滾轉周期內，磁傳感器Z軸測量值為0時，X軸、Y軸的測量磁場值；Hbx1和Hbz0為上一滾轉周期內，磁傳感器Y軸測量值為0時，X軸、Z軸的測量磁場值。

針對Y，Z兩軸測得的一個滾轉周期內磁場的最值選取問題，為避免由于噪聲等原因選到局部最值，通過含誤差的粗略滾轉角約束，將一個滾轉周期分為兩段，分別取這兩部分中的最大值和最小值，再將一個周期內的4個值進行比較，取得最大值和最小值作為0點修正的依據。

對于滾轉周期的選取，既要保證一個滾轉周期內同時可以取到最大、最小值點，又要保證取到的兩個最值點為相鄰最值點，以保證修正值的準確。若將滾轉周期設置太大，會導致丟數問題，無法保證彈體每個滾轉周期內的最值都被測得；若滾轉周期設置太小，會導致最值點選取錯誤，影響修正參數。由于采樣點為離散點，滾轉角解算值也為離散值，因此滾轉周期應設置為一個范圍，無法精確到某固定值。基于工程應用考慮，設計滾轉周期閾值范圍為330°～360°。修正過程如圖2所示。

4試驗驗證

4.1計算機仿真試驗

為驗證上述修正方法，結合高速旋轉彈飛行時各姿態角變化規律，設計彈道模型仿真時間約50s，采樣率設置為1kHz，初始射速780m/s，初始俯仰角35°，彈道模型仿真得到的姿態角變化如圖3所示。

X軸磁場值濾波如圖4所示。若未設置濾波器初值，濾波器的響應時間可能達到1s左右，嚴重影響地磁測姿系統的滾轉角解算。將初始三分量中的參數設置為濾波器初值后，可以大幅度減小響應時間。

仿真Y，Z軸磁場測量最值選取如圖5所示。由于滾轉角解算存在誤差，閾值設置略小于360°，這可能使分界點選取在最值處，如圖5中Z軸采樣值所示，最值點會選取在分界點兩端，對其取值幾乎沒有影響。

針對其中某一個滾轉周期進行修正，修正前后磁場如圖6所示。

仿真修正前后滾轉角及誤差如圖7所示。

4.2半物理仿真

為了測試所提出的在線修正方法在實際工程應用中的性能，選用三軸磁阻傳感器HMC1053作為磁敏感單元，STM32F405RGT6作為MCU，組成地磁測姿單元進行半物理仿真試驗。將磁測系統固定在三軸高精度飛行模擬轉臺上，如圖6所示，設置滾轉角速率由0（°）/s在5s內加速至1800（°）/s后勻速轉動20s再減速至0（°）/s，來模擬高速旋轉彈實際飛行狀態。用鐵質螺釘固定磁測單元模擬固定磁場干擾，去除包裹飛行轉臺電機的磁屏蔽材料來模擬其他干擾磁場，試驗過程中將俯仰角與偏航角設置為0°保持靜止。

通過讀取磁測系統內所保存的原始數據可得對磁傳感器X軸測量值濾波結果，如圖8所示。由于三軸飛行轉臺產生的磁場干擾及磁傳感器存在安裝誤差角，導致磁傳感器X軸測量磁場值具有和轉速頻率一致的磁場干擾。

單滾轉周期內對Y，Z軸的修正結果如圖9所示。系統上電后，Y，Z軸磁場在線修正數據如圖10所示。

試驗得到滾轉角解算結果如圖11所示，統計結果如表2所示。

綜合圖11和表2可以看出，當彈體的俯仰角與偏航

角均為0°，僅處于繞軸向的高速旋轉狀態時，由于加入了干擾磁場，直接使用地面標定參數進行滾轉角解算得到的滾轉角誤差峰值達到19.92°，誤差均值為4.0457°。而使用文中所述的在線修正方法對三軸磁場測量值進行修正補償后，得到的滾轉角誤差值明顯減小，誤差峰值減小至3°以內，誤差均值為-0.0750°。在該仿真條件下，滾轉角精度提高6倍，可以滿足制導彈藥對滾轉角精度的要求。同時，該算法計算量小，磁測系統在1kHz采樣率下可以完成實時解算，實時性好。

5結論

本文針對高速旋轉彈在飛行過程中可能受到的彈體磁場干擾導致滾轉角解算不準確的問題，提出了一種基于高速旋轉彈飛行特點的磁傳感器多元信息約束在線修正方法。該方法結合彈丸高自旋、低俯仰的運動規律，對緩慢變化的X軸及地磁場模值低通濾波，考慮到旋轉彈起控前要經歷減旋甚至可能反轉，轉速變化范圍較大，直接對Y，Z軸濾波會受到彈丸轉速變化的影響，因此采用模值約束的修正方法。通過仿真驗證算法有效性后，采用三軸飛行轉臺進行半物理仿真試驗。試驗結果表明，該方法可以有效提升高速旋轉彈滾轉角解算精度。同時，該方法計算量小，實時性好，可以在stm32單片機上實現磁傳感器測量值的實時補償，在高速旋轉彈上實現低成本且較高精度的滾轉角測量。

參考文獻：

［1］段偲麗，管雪元，李文勝.基于磁傳感器的炮彈姿態測量解算［J］.電子測量技術，2018，41（2）：31-36.

DuanSili，GuanXueyuan，LiWensheng.AttitudeMeasurementofProjectileBasedonMagneticSensor［J］.ElectronicMeasurementTechnology，2018，41（2）：31-36.（inChinese）

［2］馬國梁，李巖，葛敬飛.磁阻傳感器測量旋轉彈滾轉姿態的原理分析［J］.彈道學報，2012，24（1）：32-36.

MaGuoliang，LiYan，GeJingfei.PrincipleAnalysisforRollAttitudeMeasurementofSpinningProjectileUsingMagneticResistanceSensor［J］.JournalofBallistics，2012，24（1）：32-36.（inChinese）

［3］MohamadabadiK，HillionM.AnAutomatedIndoorScalarCalibrationMethodforThree-AxisVectorMagnetometers［J］.IEEESensorsJournal，2014，14（9）：3076-3083.

［4］YangD，YouZ，LiB，etal.CompleteTri-AxisMagnetometerCali-brationwithaGyroAuxiliary［J］.Sensors，2017，17（6）：1223.

［5］呂辰，張曉明，檀杰，等.基于遺忘因子遞推最小二乘的無人機在線磁補償技術研究［J］.傳感技術學報，2018，31（2）：218-222.

LüChen，ZhangXiaoming，TanJie，etal.ResearchofOn-LineMagneticCompensationTechnologyforUAVBasedonForgettingFactorandRLS［J］.ChineseJournalofSensorsandActuators，2018，31（2）：218-222.（inChinese）

［6］狄素素，曾成，張夢影.航姿參考系統三軸磁強計的兩步校正算法［J］.火力與指揮控制，2018，43（9）：40-43.

DiSusu，ZengCheng，ZhangMengying.Two-StepCalibrationAlgorithmofThree-AxisMagnetometerinAttitudeanHeadingReferenceSystem［J］.FireControl＆CommandControl，2018，43（9）：40-43.（inChinese）

［7］李勇，劉文怡，李杰，等.基于橢球擬合的三軸磁傳感器誤差補償方法［J］.傳感技術學報，2012，25（7）：917-920.

LiYong，LiuWenyi，LiJie，etal.ErrorCompensationMethodforThree-AxisMagneticSensorBasedonEllipsoidFitting［J］.ChineseJournalofSensorsandActuators，2012，25（7）：917-920.（inChinese）

［8］VasconcelosJF，ElkaimG，SilvestreC，etal.GeometricApproachtoStrapdownMagnetometerCalibrationinSensorFrame［J］.IEEETransactionsonAerospaceandElectronicSystems，2011，47（2）：1293-1306.

［9］FangJC，SunHW，CaoJJ，etal.ANovelCalibrationMethodofMagneticCompassBasedonEllipsoidFitting［J］.IEEETransactionsonInstrumentationandMeasurement，2011，60（6）：2053-2061.

［10］李翔，劉曉琴，宋百麒.航姿系統三軸磁強計動態校正研究［J］.電子器件，2020，43（4）：913-917.

LiXiang，LiuXiaoqin，SongBaiqi.ResearchonDynamicCalibrationofTri-AxialMagnetometerinAttitudeandHeadingReferenceSystem［J］.ChineseJournalofElectronDevices，2020，43（4）：913-917.（inChinese）

［11］楊宇彬，湯國建，包為民.地磁姿態探測器的實時標定方法研究［J］.飛行力學，2014，32（1）：93-96.

YangYubin，TangGuojian，BaoWeimin.Real-TimeCalibrationMethodofMagnetometer［J］.FlightDynamics，2014，32（1）：93-96.（inChinese）

［12］薛羽陽，張曉明，張鶯鶯，等.旋轉彈彈體磁場干擾的實時在線補償［J］.兵器裝備工程學報，2022，43（5）：84-89.

XueYuyang，ZhangXiaoming，ZhangYingying，etal.Real-TimeOnlineCompensationofMagneticFieldInterferenceonRotatingProjectile［J］.JournalofOrdnanceEquipmentEngineering，2022，43（5）：84-89.（inChinese）

AReal-TimeOnlineCorrectionMethodforMagneticField

InterferenceonHigh-SpeedRotatingProjectile

WangFan1，ZhangXiaoming1，2*，CaoYuan3，ZhouJie1，LiuJun1，2，LiJie1，2

（1.NationalKeyLaboratoryforElectronicMeasurementTechnology，NorthUniversityofChina，Taiyuan030051，China；

2.KeyLaboratoryofInstrumentationScience&DynamicMeasure，MinistryofEducation，NorthUniversityofChina，

Taiyuan030051，China;3.ChinaAirborneMissileAcademy，Luoyang471009，China）

Abstract：Theaccuratemeasurementofrollangleisthepremiseofpreciseguidanceandcontrolofcontrolledhigh-speedrotatingprojectile.However，thegeomagneticattitudemeasurementmethodbasedonmagneticsensorwillaffecttheaccuracyofmagneticsensormeasurementduetothemagneticfieldinterferenceoftheprojectile.Aimingatthisproblem，anonlinecorrectionmethodforthemagneticfieldinterferenceoftheprojectileisproposed.Accordingtothemagneticfieldinterferencethatmaybeencounteredduringtheflightofthehigh-speedrotatingprojectile，amagneticfielderrormodelisestablished，andthemagneticfieldvaluemeasuredbythemagneticsensoriscorrectedandcompensatedinrealtimebytheflightlawconstraintoftherotatingprojectile.Thesemi-physicalsimulationexperimentsshowthatthemethodcaneffectivelyreducethemeasurementerrorandimprovetheestimationaccuracyoftheprojectilerollangle.Themethodisverifiedbythree-axisflightturntablemeasurement，andtheaccuracyofgeomagneticattituderollanglecanbeimprovedby6times.Themethodonlyneedsthree-axismagneticsensortocompletethecorrection，withsimplesteps，veryshortcorrectiontime，goodreal-timeperformanceandhighaccuracy.

Keywords：geomagneticattitudemeasurement;high-speedrotatingprojectile;onlinecorrection;real-timefiltering;rollanglesolution;preciseguidance

收稿日期：2022-07-20

基金項目：國家自然科學基金項目（61873247）；航空科學基金項目（202000010U0004）

作者簡介：王凡（1997-），男，山西大同人，碩士研究生。

*通信作者：張曉明（1976-），男，山西新絳人，教授，博士生導師。