由于吊鉤本身結構的限制及其工作環境的不確定性，國內外都較少開展對于起重機吊鉤運動監控的研究。如使用圖像處理方式跟蹤吊鉤運動狀態，不足之處在于圖像算法復雜，且誤判率比較高。

 

    吊鉤水平方位角過大，將產生旋轉位移，造成所吊重物位置的不確定，而針對特型吊鉤，僅給出了二維傾角測量方法。

 

    本研究從起重機現場應用角度出發，采用MEMS加速度計和微磁強計組合，通過誤差補償，實現對吊鉤傾角和水平方位角的實時監控，開發低成本、高精度的運動狀態監控系統，不僅可滿足起重機現場使用要求，也可以為起重機吊臂閉環控制系統的研究提供物理參量。

 

    1吊鉤運動狀態測量原理吊鉤主要由兩部分構成：外框架和吊鉤鉤體（如所示）。外框架連接纜繩并起到固定支撐鉤體的作用，鉤體只能在外框架的支撐下做沿中心軸的單自由度旋轉，吊鉤運動狀態的測量主要包含對吊鉤沿纜繩垂直地面方向的二維傾角運動和沿鉤體頂端水平方向的平面旋轉角的測量，從吊鉤結構可以看出，鉤體和外框架的二維傾角相等，而對于平面內旋轉，本研究更關心鉤體及其所吊貨物的當前狀態。

 

    吊鉤終端安裝示意圖本研究將姿態測量系統安裝在吊鉤鉤體頂端，與之固連，定義載體坐標系如所示：X沿橫軸向右，Y沿縱軸向前，Z軸沿纜繩垂直方向軸向上。如可實時測量得到該坐標系下相應物理量：X軸傾角、Y軸傾角、水平旋轉角，即可確定吊鉤的運動狀態。

 

    1.1傾角解算方法傾角指X軸和Y軸分別與水平面的夾角，反映當前吊鉤相對纜繩垂直方向的傾斜程度，若傾角超出一定范圍，駕駛員應當采取措施減小擺動。

 

    在吊鉤這種緩慢運動的物體上安裝的加速度計的各軸測量值可近似認為是重力加速度g在各軸的分量，按照空間矢量合成原理，可以得到沿X、Y軸的傾角的計算公式分別為：M+g2y+g2：gx，gy，gz―三軸MEMS加速度計的測量值，根據吊鉤實際應用情況，本研究定義ay的取值范圍為1.2平面旋轉角解算方法平面旋轉角指吊鉤繞Z軸相對初始角度的偏轉角，主要反映吊鉤的扭擺程度，若扭擺過大，則可能導致纜繩斷裂或所吊重物碰撞到周邊物體。三軸微磁強計可以輸出立體空間內兩兩正交的3個軸的當前磁場強度值，磁強計通過測量地磁場強度確定吊鉤的平面旋轉角。本研究的初始角度取地磁北極方向。旋轉角可以通過下面的公式計算：本研究定義屮0，3600），當確定初始位置角度后，即可測量出吊鉤掛載后的相對值的旋轉角度。

 

    2基于T-S模糊邏輯的吊鉤旋轉角誤差補償吊鉤及周邊都為鐵磁材料，不可避免地受到強磁干擾，嚴重影響旋轉角的測量精度。提出的四點補償是一種常用的方法，該方法只適合弱磁環境下應用；采用神經網絡方法對磁強計的系統誤差和溫度進行補償，但存在不易編程實現、計算量較大等不足，其工程化可行性不高。本研究提出一種適合應用于強磁環境下的旋轉角誤差補償方法。

 

    如采用弱磁補償方法，在鐵磁材料的。

 

    表1弱磁補償法補償結果真值誤差真值誤差從表1中可以看出，相對于值，其誤差絕對值*大可達23.73.，均方差為20.36.，已不能作為測量值輸出，需要經過在線補償。本研究選用T-S模糊模型來對平面旋轉角誤差建模，借助T-S方法，建立非線性的模糊規則。

 

    為簡化運算，本研究建立二次局部T-S模型規則：y償前平面旋轉角讀數；ava2，b―敏感系數。

 

    制定模糊規則是建立在。

 

    費模糊隸屬度函數在模糊邏輯算法中，ava2，b可視作線性局部模型系數，如能得到3個敏感系數，則可確定在R，規則下的模糊基函數。本研究通過表1中的重復。在此例中，模糊輸出值為：成是第i條規則加權因子。

 

    本研究將表1數據作為模糊輸入集合，經過模糊規則計算，輸出結果如（b）所示，其誤差絕對值*大不超過0.8°，均方差為0.54°，經過補償后的精度有明顯提高。

 

    3系統頭現由于吊車的保養周期為幾個月或1年，并且傳感器進行在線標定后應避免頻繁卸下，本研究引入安裝誤差，并在系統實現過程中考慮符合長期使用的要求，如在線標定、低功耗等。

 

    3.1系統功能模塊為達到實際應用的目的，本研究采用重心法，將系統總體框圖模糊集合映射為一個確定的點，對于任何輸入平面旋該系統采用ADI公司的三軸MEMS加速度計轉角讀數，其模糊輸出可寫成：ADXL312作為傾角測量傳感器，其量程為g，精度系統總體框架如所示，包含4個模塊，分別是數據采集、信息處理、數傳和控制顯示模塊。

 

    為2.9mg/LSB；微磁強計采用Honeywell公司的HMR2300.信息處理模塊使用TI公司的低功耗16位單片機MSP430F149，實現對傳感器的信號采集和姿態解算，通過數傳模塊將姿態信息發送給地面終端；地面終端通過相同的數傳模塊接收運動狀態信息并控制液晶顯示，同時，地面終端可以發送控制指令給吊鉤終端，例如磁強計校正參數指令、系統休眠指令等。系統實物如所示。

 

    3.2方位角在線標定技術在吊鉤測量模塊安裝好后，應盡量避免頻繁拆下，同時為滿足測量系統在各型吊鉤上的通用性，采用套在線標定技術是十分有必要的，利用該技術，本研究可以在測量系統安裝好后通過地面終端發送指令設定補償參數，這樣即使吊鉤的使用環境變化后，本研究也可以迅速、方便地對方位角進行遙控標定。以鐵磁轉臺為例，在線標定過程步驟如下：①將測量模塊水平安裝在轉臺上，并開機；②地面終端發送標定指令給測量模塊，此時，測量模塊進入標定模式；③按照第2節所述標定方法獲得參數（式）后，通過地面終端發送回測量模塊并存儲；④地面終端發送標定完成指令，測量模塊進入正常工作狀態。

 

    3.3低功耗技術吊鉤測量模塊的電源設計是重點和難點之不僅要滿足各個模塊供電電壓，同時還要兼顧系統總功耗。MEMS器件本身即具有低功耗的優勢，如ADXL312本身帶有多種低功耗模式，如睡眠模式和待機狀態。在正常工作模式下，電流為57pA，而在待機模式下，電流只有0.1A.地面終端為操作員提供了待機按鈕，可以通過數傳模塊發送指令給吊鉤終端，控制MCU切斷傳感器供電?；謴凸╇姷姆椒ㄅc之類似本研究通過讀取分度臺和轉臺的標稱值，并和由接收終端得到的測量值進行比較。

 

    本研究對傾角的測試如Q所示，將系統固定于分度臺上，調整分度頭水平零位，與輸出致，先對X軸方向的傾角進行測量，點從（-60.，60°），以10°遞增并記錄系統的輸出值，其測量結果如表2所示。

 

    系統測試環境表2X軸傾角數據真值/（°）誤差/真值/誤差/由表2可知，相對值，X軸傾角各測量點的*大誤差不超過0.3°，均方差為0.15本研究將系統轉換90.方向安裝并對Y軸進行測量，測量結果如表3所示，計算得滾轉角測量*大誤差不超過0.3°，均方差為0.15表3Y軸傾角數據真值/（°）誤差/真值/誤差/水平旋轉角的測試在轉臺上進行，如b所示。

 

    轉臺由鐵磁材料制作而成，可以反映系統應用現場的強磁環境，本研究將測量系統固定在轉臺上，點從0°起，以20°為增量遞增到360°，測量結果如表4所示。

 

    從表4中可以看出測量點的*大誤差不超過0.8°，均方差為0.39°。相對于表1的在線補償前數據，精度提高了25倍。由此可知，基于T-S模糊邏輯的補償算法在實際應用中能有效提高水平旋轉角精度。

 

    表4平面旋轉角真值/（°）差值/真值/差值/5結束語本研究從工程應用角度出發，不僅考察了起重機吊鉤傳感器的精度、帶寬、量程等測量指標，同時對磁強計誤差補償、系統功耗以及系統組合進行了研究。

 

    從測量數據可以看出，俯仰角和滾轉角精度達到0.3.，補償后的平面旋轉角精度達到0.8.，數據輸出速率80Hz，可以滿足用戶需求。系統功耗實測正常工作電流50mA，待機電流小于5mA.駕駛員在駕駛室即可實時監測吊鉤運功狀態。