王正剛， 代廣珍

(安徽工程大學電氣工程學院，安徽 蕪湖 241000)

0 引 言

板球控制系統(tǒng)是一種多變量的非線性控制系統(tǒng)，是桿球控制系統(tǒng)的擴展和延伸[1]。板球控制系統(tǒng)可以很直觀地驗證控制算法的有效性，為實際工程上的控制問題提供解決方案。同時，研究板球控制算法可以提高實際系統(tǒng)的穩(wěn)定性。因此，設計一種合理有效的板球系統(tǒng)控制方法是非常有意義的[2]。

系統(tǒng)以2017年全國電子設計大賽B題為背景，設計并搭建了一個六自由度運動控制平臺，采用STM32F407單片機作為主控模塊，包含角度檢測模塊、直線電機模塊、紅外線定位裝置、電機驅(qū)動和直流穩(wěn)壓電源模塊，通過采集獲取平臺的姿態(tài)參數(shù)并進行計算調(diào)節(jié)，實現(xiàn)對小球軌跡的控制，通過控制平臺的傾斜，使直徑不大于25mm的小球能夠按要求在限定時間內(nèi)完成各種指定的運動軌跡。

1 方案的選擇

1.1 滾球控制方案

小球運動平臺的姿態(tài)調(diào)整可采用多自由度并聯(lián)控制，利用PID控制算法進行運算，并將運算結(jié)果用于平臺控制。最簡單的控制方式是在x和y軸上對平臺進行上下調(diào)整的二自由度控制。六自由度控制設計雖然復雜，但位置控制精度高，圖1為六自由度并聯(lián)運動平臺設計效果圖。六個動力系統(tǒng)平均分布在平臺下方，與其他方案相比，六自由度并聯(lián)運動平臺具有剛度大、位置精度高和承載能力強等優(yōu)點，可實現(xiàn)對平臺的精確控制。

圖1 六自由度并聯(lián)控制運動平臺設計效果圖

圖2 鉸接點矢量圖

1.2 硬件設計方案

使用直線電機，結(jié)構(gòu)設計緊密，重量輕，用直流電機齒輪減速，內(nèi)置微動開關，可實現(xiàn)行程走完自動停止，安裝簡易，同時易于調(diào)節(jié)和控制。采用MPU6050傳感器。MPU6050模塊內(nèi)部自帶電壓穩(wěn)定電路，直接連接STM32F407總控制器系統(tǒng)。通過讀取MPU6050內(nèi)部運動處理器所計算出的結(jié)果，可解算得到姿態(tài)角，讀取簡單、響應迅速，可有效減輕CPU負擔。通過設置紅外定位裝置，檢測小球的位置，反饋到控制器，計算控制量，通過控制直線電機以控制平臺的傾斜角度，進而控制小球的運動軌跡。

圖3 系統(tǒng)總體框圖

圖4 MPU6050原理圖

2 運動平臺位置計算分析

已知運動平臺的姿態(tài)參數(shù)為q=(x,y,z,α,β,γ)，利用位置反解方法求解伸縮桿的桿長li。圖2為六自由度并聯(lián)運動平臺的鉸接點的矢量圖，如圖2所示A為固定平臺，B為運動平臺，A上對應鉸接點Ai與B上對應鉸接點Bi與之間的距離|AiBi|即為各個伸縮桿的桿長li。

T為旋轉(zhuǎn)變換矩陣，反映了固定坐標系OXYZ和運動坐標系ouvw之間的關系。p=(xpypzp)T是運動坐標系原點o在固定坐標系中的位置矢量ai=(xAi,yAizAi)T是Ai在固定坐標系中的位置矢量；bi=(xBiyBizBi)T是Bi在運動坐標系中的位置矢量。由圖2可知，伸縮桿的桿長矢量Li為：

ai-(T×bi+p)

(1)

因此，計算伸縮桿長度的公式為：

li=|Li|=ai-(p+T×bi)=

(2)

已知ai與bi，給定運動平臺B的位姿參數(shù)q=(x,y,z,α,β,γ)，通過位置反解，就可以確定向量p與矩陣T，再利用公式(2)就能算出伸縮桿長度li[3]。

3 系統(tǒng)設計

3.1 電路設計

3.1.1 系統(tǒng)總體框圖

圖3所示為系統(tǒng)總體框圖，主要由STM32F407單片機、MPU6050六軸傳感器模塊、直線電機控制模塊、紅外定位裝置和直流穩(wěn)壓電源模塊等部分組成[4]。

圖5 直線電機驅(qū)動原理圖

圖6 紅外定位裝置示意圖

3.1.2 角度檢測模塊設計

角度檢測模塊采用MPU6050六軸傳感器設計，圖4所示為MPU6050設計原理圖。MPU6050內(nèi)部自帶三軸陀螺儀和三軸加速度傳感器，含有兩個I2C接口，主I2C接口結(jié)合自帶的數(shù)字運動處理器硬件加速引擎，可以向應用端輸出完整的九軸姿態(tài)融合演算數(shù)據(jù)；從I2C接口可以和外部磁力傳感器連接。使用運動處理資料庫，可非常方便地實現(xiàn)姿態(tài)解算，降低主控模塊的運算負荷，同時大大降低了開發(fā)難度。

3.1.3 直線電機驅(qū)動設計

IR2104型半橋驅(qū)動芯片可以驅(qū)動高端和低端兩個N溝道MOSFET，能產(chǎn)生較大的柵極驅(qū)動電流，并具有硬件死區(qū)、硬件防同臂導通等功能。使用兩片IR2104可以組成完整的直流電機H橋式驅(qū)動電路。電機驅(qū)動原理圖如圖5所示[5]。

圖7 程序流程圖

3.1.4 紅外定位裝置設計

圖6所示為紅外定位裝置示意圖。在平臺四周放置紅外線發(fā)射和接收陣列，系統(tǒng)逐個掃描光電管接收的信號。因為小球的阻斷，通過檢測未接收到信號的光電管便可以快速獲取橫向和縱向坐標，從而確定小球在平臺上的精確位置，定位精度達到5.4mm[6]。

3.2 程序設計

3.2.1 程序流程圖

圖7所示為系統(tǒng)控制程序流程圖，包含主程序流程和中斷程序流程。主程序主要完成功能是對系統(tǒng)進行初始化和延時UI(用戶界面)處理，包括OLED實時顯示小球位置區(qū)域及停留時間、按鍵控制等；中斷處理程序主要是對平臺姿態(tài)(加速度、角速度)、小球位置和速度、直線電機長度和速度等數(shù)據(jù)進行獲取和處理，控制輸出PWM信號，以及對小球進行定位時間檢測等。

3.2.2 程序功能分析

系統(tǒng)通過STM32F407單片機來控制驅(qū)動電路，根據(jù)PID的調(diào)節(jié)來得到需要設定的角度，同時得到對應控制脈沖，輸出PWM控制直線電機的推桿伸縮，使平臺按照指定角度傾斜，從而使小球按照指定動作運動。其中按鍵開關進行模式和區(qū)域設置。

4 測試方案及結(jié)果

4.1 測試設備及方式

所用測試設備有：小球、量角器、直尺、秒表等。

測試方法描述如下：

(1)定位測試。將小球放置在平臺上指定區(qū)域內(nèi)，保持一定時間靜止。

(2)定點測試。將小球放置在平臺上某區(qū)域內(nèi)，調(diào)節(jié)滾球控制系統(tǒng)使小球移動到另一指定區(qū)域內(nèi)，并停留一段時間。

(3)定時測試。使小球在某一規(guī)定時間內(nèi)完成指定動作。

4.2 測試數(shù)據(jù)

(1)驅(qū)動滾球控制系統(tǒng)工作，使小球在規(guī)定區(qū)域內(nèi)停留，并記錄停留時間和偏差位置。測試結(jié)果如表1所示：

表1 區(qū)域定點停留測試數(shù)據(jù)

測試結(jié)果分析：定點停留測試能夠準確完成，誤差極小。

(2)驅(qū)動滾球裝置系統(tǒng)工作，使小球從一個區(qū)域滾動到另一個指定區(qū)域，并停留一段時間。記錄運動時間和停留時間。測試數(shù)據(jù)如表2所示：

表2 運動和停留測試數(shù)據(jù)

測試結(jié)果分析：運動停留測試基本能夠準確完成，但是在路線復雜情況下，運動時間較長。

(3) 規(guī)定時間內(nèi)，讓小球先后進入?yún)^(qū)域 2、區(qū)域 6，停止于區(qū)域9，在區(qū)域9中停留時間不少于2s。記錄運動時間和停留時間，測試數(shù)據(jù)如表3：

表3 規(guī)定路線測試數(shù)據(jù)

測試結(jié)果分析：要通過的區(qū)域多，還要在指定區(qū)域停留，因此實現(xiàn)起來有一定難度，但是基本可以在指定時間內(nèi)完成要求。時間上還有待縮短。

(4)用按鍵設置A、B、C、D區(qū)域，并控制小球完成動作。

表4 按鍵指定區(qū)域測試數(shù)據(jù)

測試結(jié)果分析：設置區(qū)域路線簡單，能夠較好完成，但是若為折線路線，則實現(xiàn)起來比較困難，在運動過程中，難以控制，耗時較長。

5 結(jié) 論

系統(tǒng)搭建了基于紅外定位的六自由度板球控制平臺，使用STM32F407單片機作為主控模塊。經(jīng)測試，控制精準，操作簡單，性能可靠，技術指標達到了設計要求。

在系統(tǒng)設計和搭建過程中，分工明確，充分發(fā)揮各自所長，放棄使用傳統(tǒng)的舵機作為執(zhí)行機構(gòu)，采用六自由度并聯(lián)控制運動平臺，雖然設計難度有所增加，但提高了控制精度，可實現(xiàn)對平臺的精確控制。

[1] 蘇信, 孫政順, 趙世敏.板球系統(tǒng)的模糊控制方法研究[J].計算機仿真. 2006(09).165-167.

[2] 翟晨汐,李洪興. 板球系統(tǒng)的直接自適應模糊滑?？刂芠J].計算機仿真. 2016(02).383-388.

[3] 李沛,楊小強,李煥良,等.基于Matlab/SimMechanics的六自由度并聯(lián)運動平臺建模與分析[J].機械與電子.2016(03).75-80.

[4] 王紅睿,田彥濤,隋振,等.板球系統(tǒng)的非線性自適應控制[J].系統(tǒng)仿真學報.2010(05).1251-1256.

[5] 王金晨,紀成,何印洲.基于PWM的可調(diào)速電動汽車模型控制系統(tǒng)的設計[J].伺服控制.2011(08).42-45.

[6] 何成林,鐘鳴,姚玉峰. 基于紅外定位的微小型自重構(gòu)移動機器人[J]. 機械與電子.2016(09).69-72.