劉佩霞，范藝凡，向春妮，郭天汭，閆明珠

(河南科技大學信息工程學院，河南 洛陽 471009)

0 引言

近年來，隨著世界各國貿(mào)易互通往來頻繁，貨箱的運輸成為了重要的一環(huán)。在貨物的裝箱、搬運過程中，起重機起著重要作用。橋式、門式起重機廣泛用于機場、碼頭、工廠等大型運輸場所[1]。由于起重機的位移裝置和貨物之間的連接多以鋼絲繩為媒介，操作熟練度、鋼絲繩的柔性、風力等多方面因素會導(dǎo)致貨物在運送過程中產(chǎn)生搖擺[2]。起重機防搖就是使吊起貨物快速消除擺動，盡快達到豎直狀態(tài)，以加快貨物運輸?shù)臏蚀_性、快速性，從而提高貨物的裝卸效率，減輕工作人員的勞動[3]。國內(nèi)當前采用的電子防搖技術(shù)可以實現(xiàn)對吊具擺動的控制，但某些裝備了電子防搖系統(tǒng)的集裝箱起重機后來又被拆除[4]。原因在于起重機系統(tǒng)的數(shù)學模型具有非線性特性和不確定性，常規(guī)的控制方法往往難以奏效，因此只有不依賴數(shù)學模型且能適應(yīng)不確定性的智能控制方法才適合應(yīng)用到這類控制中來。一個好的防搖裝置，可以避免碰撞等一系列事故的發(fā)生，大大提高起重機的操作效率和起重機操作過程的安全性。所以起重機防搖問題的解決意義極大[5]。

1 二維機械結(jié)構(gòu)設(shè)計

二維結(jié)構(gòu)設(shè)計如圖1所示，采用X、Y軸兩個維度的線性滑桿龍門設(shè)計，滑桿上的滑塊可隨著滑臺皮帶的傳動在兩個軸上任意切換坐標位置，滑塊下方帶有一個萬向擺，擺下面的吸盤可吸重物，支架的底部與四周用鋁型材以及木棒固定來穩(wěn)定整體裝置，兩個步進電機以及驅(qū)動器安裝在步進電機固定架上，滑塊安裝在X軸滑桿上，連接桿連接Y軸方向的滑桿帶動滑塊在Y軸方向上的移動。在滑塊上方安裝控制電路板和氣泵，結(jié)構(gòu)如圖2所示。電路板采用雙層結(jié)構(gòu)，上層是主控芯片以及顯示屏，下層是繼電器模塊、電源模塊以及藍牙模塊，姿態(tài)傳感器安裝在萬向節(jié)桿上檢測各個方向的姿態(tài)角，并帶有獨立電池以隨時進行電腦上位機加計校準與Z軸歸零。氣泵與電磁閥各安裝在3D打印機內(nèi)一同固定在滑塊上的防搖臺上，防搖臺設(shè)計如圖3所示。

圖1 二維結(jié)構(gòu)設(shè)計

圖2 氣泵與電路板結(jié)構(gòu)側(cè)視圖

圖3 防搖臺設(shè)計圖

二維結(jié)構(gòu)的設(shè)計作為本論文的最終設(shè)計，該機械結(jié)構(gòu)的設(shè)計具備起重機平面移動、載重以及卸貨模擬的基本條件。本系統(tǒng)雖然是模擬起重機，但是搭建的起重機結(jié)構(gòu)與真正的起重機沒有太大的差別，以便增強數(shù)據(jù)算法的可靠性。

2 硬件總體設(shè)計

本設(shè)計數(shù)據(jù)采集端選用MPU6050加速度傳感器，計算出貨箱擺角，再由HC-06模塊發(fā)送數(shù)據(jù)。步進電機控制端包含STM32主控芯片、OLED顯示屏、無線藍牙通信模塊、步進電機驅(qū)動器等。HC-05模塊同USB-TTL模塊連接，給電腦提供數(shù)據(jù)接口?？傮w硬件框圖如圖4所示。

圖4 總體硬件框圖

2.1 主控模塊

本系統(tǒng)主控芯片采用意法半導(dǎo)體公司的STM32F429IGT6，相較于STM32F407降低了停止模式的電流消耗，可延長便攜應(yīng)用的電池壽命。此外，還增加了TFT-LCD控制器，加快圖形處理性能的ST Chrom-ART Accelerator 和SDRAM存儲器接口。

2.2 電源模塊

電源模塊為系統(tǒng)其他各個模塊供電。設(shè)計中用7.4 V 2 000 mA鋰離子電池，3.3 V鋰離子充電電池，以及22.8 VBT48電池。由于電路中各模塊所需工作電壓不同，電源模塊中還包含3.3 V 穩(wěn)壓電路，因此本設(shè)計電路中共兩種電壓，如圖5所示。

圖5 電源模塊

2.3 藍牙姿態(tài)傳感器

姿態(tài)傳感器采用維特智能的藍牙姿態(tài)傳感器BWT61P,支持三維加速度，三維陀螺儀，三維歐拉角，具有高精度，高性能，低成本等優(yōu)點。

2.4 步進電機及驅(qū)動模塊

需用電機驅(qū)動滑臺在X，Y方向上移動。對于電機的選擇，有如下幾種方案：

1) 伺服電機：伺服電機具有精度高，適應(yīng)性強，穩(wěn)定性好的特點。但伺服電機完全不防水防油，不能用于油水侵襲的場所,成本價高，因此不適合本設(shè)計。

2) 直流電機：直流電機具有運轉(zhuǎn)距離大，調(diào)速特性優(yōu)秀，抗干擾能力強等優(yōu)點，但是其結(jié)構(gòu)復(fù)雜，故障高，可靠性低。在此設(shè)計中也不適用。

3) 步進電機：步進電機具有最大的轉(zhuǎn)矩，精度在3%～5%，有較好的位置精度和運動的重復(fù)性及優(yōu)秀的啟停和反轉(zhuǎn)響應(yīng)。因此比較適合本設(shè)計。

2.5 藍牙通信模塊

本系統(tǒng)需要連接手機APP通過藍牙快速而準確地發(fā)送命令傳遞給單片機進行處理，并將結(jié)果顯示在OLED上，因此我們使用增強版藍牙HC-05模塊。

2.6 其它輔助模塊

本設(shè)計還使用了OLED模塊，3.3 V穩(wěn)壓模塊，繼電器模塊。作為輔助模塊。

3 軟件總體設(shè)計

軟件部分主要分三部分處理數(shù)據(jù)，首先數(shù)據(jù)采集端獲取6軸加速度原始數(shù)據(jù)，經(jīng)過硬件濾波、卡爾曼濾波，DMP庫計算出姿態(tài)角，傳輸?shù)娇刂贫??？刂贫瞬糠纸邮諗?shù)據(jù)后，先進行數(shù)據(jù)校驗，再對數(shù)據(jù)進行解算算出擺角和搖擺速度，利用雙閉環(huán)PID算法計算出下個周期步進電機該以哪種速度運作，將數(shù)據(jù)通過串口DMA發(fā)送給上位機端。上位機接收到數(shù)據(jù)，先校驗再分類，通過3D圖片控件顯示到主界面，并在副界面顯示貨箱姿態(tài)數(shù)據(jù)。三端的程序流程圖如圖6所示。

圖6 軟件設(shè)計總體流程

3.1 PID控制器

貨箱的擺角調(diào)節(jié)與小車的速度加速度直接相關(guān)。本控制系統(tǒng)以角度偏差為輸入，經(jīng)過PID運算輸出值為步進電機的輸入脈沖頻率，對應(yīng)著小車的速度。PID控制器在各種工業(yè)控制中使用廣泛，特點簡單實用，主要有三部分組成，P(比例控制)、I(積分控制)和D(微分控制)。比例控制使得系統(tǒng)反應(yīng)迅速但容易出現(xiàn)超調(diào)，微分控制可以一直超調(diào)但是響應(yīng)時間會有所延后，積分環(huán)節(jié)可以消除誤差但容易滯后，三種控制相互配合又可以組成PI控制、PD控制等。

PID控制器最重要的輸入?yún)?shù)是偏差，本系統(tǒng)希望貨箱始終處在豎直狀態(tài)記為0度，以采集角度值作為直接偏差輸入控制器中，做PD運算。功能是實現(xiàn)只調(diào)節(jié)豎直狀態(tài)而不考慮調(diào)節(jié)后小車所處的位置，選擇位置式PD控制。

由于數(shù)據(jù)采集周期10 ms左右，在每幀數(shù)據(jù)處理完成之后進行PID運算，輸出值直接作為步進電機的輸入頻率，更改步進電機的速度及轉(zhuǎn)向。

考慮到起重機在貨物運送過程中小車是一直運動的，而且在對位吊貨過程中要求小車調(diào)節(jié)幅度不能過大，所以單閉環(huán)并不能保證起重機在工作過程中的要求。基于這一原因，本系統(tǒng)采用雙閉環(huán)串級PID控制，加入速度環(huán)來控制小車調(diào)整過程中的移動范圍。

3.2 串口DMA數(shù)據(jù)傳輸

上述程序設(shè)計主要是針對步進電機的運動控制，控制端還包括與上位機的通訊問題。在數(shù)據(jù)采集時用到了USART2，波特率為115200，對于主控芯片來說是一個很大的負擔，如果遇上位機通訊選用的USART1發(fā)送數(shù)據(jù)過于頻繁，會對通訊質(zhì)量產(chǎn)生影響，這種情況下采用DMA數(shù)據(jù)傳輸。

4 結(jié)束語

本文設(shè)計了一個起重機防搖系統(tǒng)，其中機械結(jié)構(gòu)能夠模擬起重機平面移動，載重及卸貨模式，增強了數(shù)據(jù)算法的可靠性。硬件設(shè)計方面，選用MPU6050加速度傳感器，STM32主控芯片，OLED顯示屏，藍牙通信模塊以及步進電機驅(qū)動器等實現(xiàn)系統(tǒng)的防搖功能。軟件方面，數(shù)據(jù)采集端獲取原始數(shù)據(jù)經(jīng)過濾波再用DMP庫計算出姿態(tài)角，傳輸?shù)娇刂贫耍秒p閉環(huán)串級PID算法計算起重機合適的運作速度，數(shù)據(jù)通過串口DMA發(fā)送給上位機端顯示在主界面，并在副界面顯示出貨箱姿態(tài)，調(diào)整參數(shù)以實現(xiàn)裝置的精確控制。調(diào)試結(jié)果表明，該起重機防搖系統(tǒng)能夠?qū)崿F(xiàn)橋臂的智能控制，有效地提高了起重機的操作效率和起重機操作過程的安全性。