微小磁鋼自動配對的混合運動控制研究

全先帥，王曉東，徐 征，元國釗，任同群

(大連理工大學 機械工程學院，大連 116024)

0 引言

由兩個毫米級磁鋼組成的微小磁鋼對是高精度擺式加速度計力矩器等的關鍵元件。以力矩器磁鋼對為例，它為力矩器提供氣隙磁場，使其產生的電磁力與加速度慣性力相平衡[1,2]。微小磁鋼對的氣隙磁場對擺式加速度計影響顯著，為獲得能產生理想氣隙磁場的兩個磁鋼，在裝配前需準確配對。配對錯誤則導致氣隙磁場強度畸變，影響加速度計性能[3,4]。配對需要保證表磁強度、氣隙磁場強度及氣隙幾何尺寸均達到工藝要求。目前，生產中主要由手工配合精密夾具和磁強計進行配對，夾具磨損和人為誤差均影響配對準確性。此外，配對過程中強磁性磁鋼意外接觸還會引起消磁和崩邊等問題，亟待發展微小磁鋼自動化精密配對方法。

通過工序分析可知，磁鋼配對過程分為磁鋼的表磁測量、磁鋼配對、配對校核環節，微小磁鋼的精確定位對三個環節的工藝效果均有重要影響。目前，顯微視覺引導、光柵測量、微力測量是微小零件定位的主要手段，例如：徐征等[5]提出先看后動的微定位方法，已用于擺組件、微小環片等零件的定位操縱，絕對定位精度優于10μm。鄒宇等[6]提出顯微視覺和力反饋混合控制策略實現微小零件的定位。鄧德榮等[7]設計了磁場測量運動控制系統，通過光柵尺或旋轉編碼器提供位置信息，實現閉環控制，重復定位精度達到2μm。然而，由靜磁學理論可知，磁鋼的表磁強度Bp與磁強測頭到磁鋼表面距離d的關系為：這意味著表磁測量準確性非常依賴于磁強測頭與磁鋼表面的接觸狀態，僅依靠顯微視覺或編碼器等不能精準反映兩者接觸狀態。

針對上述問題，本文研制了微小磁鋼自動配對系統，提出了基于顯微視覺/磁強/微力信息的混合運動控制方法，將定位任務分解為粗、精定位階段，通過顯微視覺引導粗定位，而采用磁反饋和微力反饋實現測頭-磁鋼的精定位。兼顧配對精度與效率，進行了系統動力學建模和控制參數整定優化。最后實驗驗證了配對的準確性和一致性。

1 配對任務分析與系統構建

1.1 配對任務分析

本文以一種加速度計的力矩器磁鋼對為研究對象，如圖1所示，處于氣隙磁場S極側的磁鋼稱為S磁鋼，N極側的磁鋼與磁座用膠粘接，合稱為N磁鋼底座。S磁鋼與N磁鋼底座配對后形成氣隙磁場。微小磁鋼的長寬高分別為6mm、3mm、2.5mm，配對后氣隙尺寸為1±0.05mm。

圖1 力矩器微小磁鋼對結構圖

磁鋼配對過程為磁鋼表磁測量、氣隙磁場測量與磁鋼配對。在表磁測量環節，根據測量位置由遠及近表磁強度先弱后強的變化特點，控制磁強測頭的逼近步距由長到短變化，同時設置逼近閾值，當相鄰兩次逼近的測量值之差小于給定閾值時，認為測頭達到目標位置，停止運動。

在氣隙磁場測量與磁鋼配對環節，測量位置固定為氣隙中間，且氣隙尺寸狹窄。為此，在微小夾鉗上集成一個磁強測頭，當夾持S磁鋼到達配對位置時，測頭恰處于氣隙磁強測量點，同時通過精密夾具定位保證氣隙幾何尺寸，使氣隙磁場測量與磁鋼配對同步完成，如圖2所示。

圖2 氣隙磁場測量與磁鋼配對示意圖

1.2 系統構建

如圖3所示，建立的自動配對系統結構由顯微視覺模塊、磁場測量模塊、運動控制模塊及安裝磁鋼的工作臺組成。顯微視覺模塊通過顯微圖像采集和特征提取為磁強測頭和磁鋼粗定位提供位置信息。磁場測量模塊由特斯拉計、三個磁強測頭、微力傳感器組成。運動控制模塊由微小夾鉗和三軸精密位移滑臺組成，實現測頭定位和磁鋼配對操縱。

圖3 自動配對系統結構組成

2 PID控制建模與仿真

2.1 系統控制原理

微小磁鋼配對的運動過程可分為磁場測量與磁鋼配對之前X軸的運動、磁鋼表磁測量過程Y軸的運動與磁鋼配對過程Z軸的運動。運動控制原理如圖4所示：首先，磁強測頭與微小夾鉗通過顯微視覺的引導到達測量與配對的起始位置，完成X軸的粗定位運動控制。然后在磁鋼表磁測量時通過磁強反饋閉環控制實現Y軸的精確定位。最后在磁鋼配對時通過微力反饋閉環控制實現Z軸的精確定位。

圖4 系統控制原理

2.2 系統動力學建模

控制系統傳遞函數框架見圖5，包括X方向開環控制、Y方向磁反饋閉環控制與Z方向力反饋閉環控制。圖5(a)中，Kp為開環增益，用于調節開環輸出的穩態誤差；G1(s)為步進電機傳遞函數；G2(s)為機械傳動傳遞函數。圖5(b)中，Gc(s)為磁反饋環節傳遞函數，用于表磁測量時Y向精確定位控制。圖5(c)中，Gr(s)為力反饋環節傳遞函數，用于氣隙磁場測量與配對中Z向的精確定位控制。

圖5 控制系統傳遞函數框架

1）運動滑臺的傳遞函數

運動滑臺將電機轉子的旋轉運動通過滾珠絲杠轉化為直線運動，其傳遞函數由步進電機函數G1(s)與傳動函數G2(s)組成[9]。電機動力學方程為：

式(1)中，θ—電機轉子轉角；J1—轉子轉動慣量；D—粘性摩擦系數；Kb—轉矩常數；ik—第k相電流；zr—轉子齒數。經近似處理和拉氏變換后整理可得步進電機的傳遞函數為：

步進電機帶動滾珠絲杠旋轉,由絲杠螺母將旋轉轉化為直線運動。傳動動力學方程為：

式中，θ0—步進電機輸出轉角；x(t)—負載導軌位移；Jd—傳動裝置的轉動慣量；B—傳動阻尼系數；KT—傳動裝置綜合扭轉剛度；L—絲杠導程。整理可得機械傳動系統的傳遞函數為：

2）磁反饋環節傳遞函數

磁強測頭利用集成的霍爾傳感器測量表磁。測量涉及到磁鋼、霍爾傳感器、穩壓器、差分放大器[10]，在穩定激勵電流的輸入下，霍爾電壓與磁強關系為：

式(5)中，UH—霍爾元件的輸出電壓；KH—霍爾元件靈敏度；iE—霍爾元件控制電流；B—穿過霍爾元件的磁感應強度。UH經過放大后其輸出電壓為：

式(5)與式(6)整理后可得磁反饋傳遞函數為：

3）微力反饋環節傳遞函數

將微力傳感器等效為彈簧，S磁鋼等效為質量塊，S磁鋼與磁座由于磁力形成阻尼，系統組成質量-彈簧-阻尼模型，其系統動力學方程為：

式(8)中，x(t)—微小夾鉗位移；y(t)—S磁鋼位移；M—S磁鋼質量；D—阻尼系數；K—彈簧剛度。對式(8)拉氏變換得傳遞函數為：

控制系統傳遞函數相關參數匯總如表1所示。

表1 控制系統數學模型參數

2.3 MATLAB仿真

根據上述參數進行仿真建模，如圖6所示，分別建立了X、Y、Z三個方向的仿真模型，并分別調節各方向的動態響應。

圖6 控制系統仿真模型

對于X方向粗定位，在滿足響應速度的前提下，允許系統有一定的超調量。而對于Y方向表磁測量精確定位與Z方向磁鋼配對精確定位，不僅要求穩態誤差為零，同時對響應速度與穩定性有較高要求。為達到上述要求，采用控制變量法與試湊法調節各方向控制參數：對X方向開環控制，通過調節開環增益提高系統響應速度同時消除穩態誤差；對于Y、Z方向閉環控制，通過調節比例與積分控制參數提高響應速度，減小穩態誤差，通過調節微分控制參數，減小超調量。

基于上述模型的仿真與優化結果見圖7，對于X方向開環控制，當開環增益時K=3.13×103，穩態誤差被消除，此時超調量為28.84%、上升時間為0.90、調整時間5.03ms。類似地，在Y方向，當PID控制參數Kp=4.90×103、Ki=1.00×103、Kd=6.50時，系統的響應曲線較理想，此時系統的超調量為6.80%、上升時間為0.78、調整時間為5.69ms，沒有穩態誤差；對于Z方向氣隙磁場測量與配對控制，當PID控制參數Kp=1.00×102、Ki=1.00×106、0時，系統的響應曲線較理想，此時超調量為3.13%、Kd=0.50上升時間為2.65、調整時間為9.76ms，穩態誤差近似為零。

圖7 控制系統仿真與優化結果

3 系統軟件實現與配對實驗

3.1 系統軟件實現

將.NET平臺的三層架構與MVC設計模式相結合，形成軟件架構：表現層將用戶界面的展示邏輯和交互邏輯代碼分離，通過封裝數據的實體對象傳遞數據。如圖8所示：表現層實現人機交互，業務邏輯層負責處理請求，數據訪問層將數據存儲與數據操作業務相分離。

圖8 系統軟件架構圖

3.2 配對實驗

選取了10組磁鋼樣品，對比自動配對與手工配對中的磁場測量值分析配對準確性，磁強數據如表2所示。結果表明：自動配對的S、N磁鋼表磁強度與氣隙磁強均略高于手工配對平均值（4.6mT～5.2mT）。由于磁場測量的準確性依賴于磁強測頭與磁鋼表面的接觸狀態。在不損傷測頭的前提下，接觸越緊密，則其磁強測量值越高、越接近理想表磁?？梢?，與手工配對相比，自動配對更能準確測量表磁，有助于提高配對準確性。

表2 自動配對與手工配對的磁強測量結果

為驗證磁鋼表磁測量的重復精度，分別選取5組S磁鋼與N磁鋼，各重復測量10次，結果如圖9所示，均方差分別為0.27mT和0.17mT。

圖9 磁鋼配對的表磁測量重復性

4 結語

研制了微小磁鋼自動配對系統，提出了顯微視覺/磁強/微力反饋的混合運動控制策略，通過先粗后精的定位方案實現磁強測頭與微小夾鉗的精確定位。建立各運動模塊的數學模型，通過優化控制參數，提高了配對精度與效率。實驗結果表明：與手工配對相比，自動配對的準確性更高；S和N磁鋼的表磁測量均方差分別為0.27mT和0.17mT，測量一致性滿足配對要求。