基于PID算法板球控制系統(tǒng)的設計

董堯堯+王大慶+陳瑤+蔡文瑤+潘文惠

摘要

本控制系統(tǒng)由STM32單片機控制模塊、舵機執(zhí)行模塊、圖像采集模塊、圖像處理模塊、平板和球以及板球機械結構組成的閉環(huán)控制系統(tǒng)。0V7725負責采集小球的位置信息，單片機處理圖像位置數(shù)據后通過PID精確算法調節(jié)舵機以控制平板運動，從而達到控制小球運動軌跡的目的。本系統(tǒng)實現(xiàn)了小球僅在平板自身角度調整控制下快速尋位、恢復靜止的功能，并能準確按照規(guī)定路線到達目標位置，且受外力影響后能夠在5秒內恢復板球平衡狀態(tài)，具有很好的適應性。另外，本系統(tǒng)小球及平板位置圖像可通過液晶顯示，智能性好，反應速度快。

【關鍵詞】STM32 0V7725 PID 算法 板球系統(tǒng)

1機械結構方案

本控制系統(tǒng)主要包括單片機控制模塊、舵機執(zhí)行模塊、圖像采集模塊、圖像處理模塊、平板和球以及板球機械結構組成。平板采用鋁鎂合金材質，具有強度高，質量輕等優(yōu)點。平板由萬向節(jié)連接碳桿再連接舵機組成。系統(tǒng)采用MG995舵機，其金屬外殼能提供較好的散熱，更牢固的固定位置，讓舵機內的電機運行在更高功率下，以提供更高的扭矩輸出。金屬齒輪強度高，能提供13KG的扭矩。位于平板最上方的圖像采集模塊不斷采集小球和平板的圖像，運用圖像處理算法對提取的圖像進行處理，獲取小球的坐標位置信息，通過坐標變換轉換成小球在平板上的位置信息，將該位置信息返回單片機控制模塊。圖像采集模塊采用OV7725，一個高集成度的CMOSCamera Chip傳感器，在單芯片上提供了VGA圖像處理器的全部功能。OV7725內部集成了對圖像傳感器的完善控制，包括曝光控制、伽馬校正、白平衡、色彩飽和以及色調控制，可硬件二值化。單片機控制系統(tǒng)通過處理數(shù)據后控制PWM波占空比控制舵機轉速及轉動角度，不斷調整圓盤的傾角，從而實現(xiàn)對小球的控制。單片機控制系統(tǒng)采用STM32F407ZET6，其內核為ARM32位Cortex-M3CPU，最高工作頻率為72MHz，有112個快速I/O端口，11個定時器：4個16位定時器，每個定時器有多達4個用于輸入捕獲、輸出比較、PWM、脈沖計數(shù)的通道和增量編碼。該芯片運行速度快，可操控性強。本系統(tǒng)結構框圖如圖1所示，板球控制模型如圖2所示。

2小球運動檢測及處理方案

OV7725傳感器的輸出采用VGA。一個像素用16位的數(shù)據（RGB565）表示，而OV7725的數(shù)據總線寬度最多可設置為10位，故采用了8位的數(shù)據寬度（D2-D9）輸出圖像信息。對OV7725內寄存器的配置接口采用SCCB總線。利用傳感器讀入數(shù)據，即讀取底板上像素點的顏色并進行識別。由于RGB格式的顏色數(shù)據的效果不明顯，所以將其轉換為HSL格式數(shù)據。首先遍歷尋找腐蝕中心，然后在之前腐蝕中心點處進行迭代并向外尋找新的腐蝕中心。腐蝕算法從該點開始分別向上下左右四個方向進行讀點，若點的顏色符合條件則往外讀，四個方向都結束后得到四個邊緣點的坐標，記左邊緣點的x軸坐標為left，右邊緣點的x軸坐標為right，上邊緣點的y軸坐標為up，下邊緣點的y軸坐標為bottom，那么坐標（（right-left）/2，（up-bottom）/2）即為新的腐蝕中心，從而確定小球的位置。

3執(zhí)行機構控制算法與驅動

本系統(tǒng)采用PID算法來控制舵機轉動的速度及角度。舵機開始工作后，圖像采集模塊不斷采集當前小球位置坐標狀態(tài)，并與之前的狀態(tài)比較，使得小球的運動狀態(tài)逐漸趨向于平穩(wěn)。PID算法控制器由平板轉動角度比例P、角度誤差積分I和角度微分D組成。

平板轉動角度比例P：對舵機角速度進行比例調整，即對平板轉動角度調整。比例越大，調節(jié)速度越快。但不能過大，過大可能造成舵機因工作狀態(tài)突變而使平板不穩(wěn)定。

角度誤差積分I：使系統(tǒng)消除穩(wěn)態(tài)誤差，提高無差度。加入積分調節(jié)可使系統(tǒng)穩(wěn)定性下降，動態(tài)響應變慢。本系統(tǒng)追求更快更穩(wěn)完成對小球的控制，對積分調節(jié)的需要就非常弱。即保證在不需要時系統(tǒng)不會受到影響。

角度微分D：微分作用反映平板角度的變化率，即角速度。具有預見性，能預見偏差變化的趨勢因此能產生超前的控制作用，在偏差還沒有形成之前，己被微分調節(jié)作用消除。因此，可以改善系統(tǒng)的動態(tài)性能。在微分時間選擇合適情況下，減少調節(jié)時間。

4小結

使用了基于PID算法的板球系統(tǒng)控制，可以迅速提高單片機運行速度，使得板球系統(tǒng)可以快速尋跡、穩(wěn)定。

參考文獻

[1]曾乘，柳強.板球系統(tǒng)PID控制響應的多項式響應面建模研究[J].電子設計工程，2016（16）：28-30.

[2]李愛蓮.基于視覺檢測的板球系統(tǒng)控制研究[J].科技視界，2014：26-27.

[3]史智慧.基于視覺檢測板球系統(tǒng)的變論域模糊控制研究[J]西南師范大學學報，2017（02）：148-152.

[4]翟晨汐.板球系統(tǒng)的直接自適應模糊滑模控制[J]計算機仿真，2016（02）：383-388.

[5]徐云云.基于視覺的板球控制系統(tǒng)算法研究[D].成都：西華大學，2012.

[6]李劍敏.板球系統(tǒng)的控制算法研究[D].江門：五邑大學，2013.

[7]張新楠.板球系統(tǒng)的控制算法研究[D].大連：大連理工大學，2011.endprint