帆板角度控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)
加入技術(shù)交流群
4 軟件部分
總程序流程圖如圖8所示，程序采用模塊化設(shè)計(jì)，分成幾部分的獨(dú)立子程序。首先是按鍵判斷子程序，采用矩陣式按鍵的掃描方式來編寫程序，當(dāng)有鍵按下時把相應(yīng)的鍵值存儲在RAM中，主程序根據(jù)鍵值來判斷執(zhí)行哪一段程序。設(shè)定數(shù)據(jù)有兩種，一種是設(shè)定P值0～100％，對應(yīng)帆板的角度，另外一種是設(shè)定A在0°～60°，同樣，帆板的轉(zhuǎn)角也會到達(dá)相應(yīng)的設(shè)定值，然后進(jìn)行數(shù)據(jù)顯示處理，然后調(diào)整PI值進(jìn)行風(fēng)扇轉(zhuǎn)速控制輸出，如果帆板進(jìn)入設(shè)定值的絕對值5°內(nèi)，則紅色發(fā)光二極管閃亮3次，同時蜂鳴器響3下；如果沒有進(jìn)入，則發(fā)光二極管不亮、蜂鳴器不響。本文引用地址：http://2s4d.com/article/159399.htm
T0中斷是數(shù)據(jù)顯示和按鍵檢測、PWM數(shù)據(jù)處理、蜂鳴器輸出程序。如圖9所示。
T1中斷是正交編碼器信號檢測和處理程序，如圖10所示。
T2中斷產(chǎn)生PWM，脈寬調(diào)整。如圖11所示。
5 系統(tǒng)調(diào)試與測試結(jié)果
(1)用手轉(zhuǎn)動帆板，能顯示帆板的轉(zhuǎn)角度數(shù)。角度范圍為0°～60°，分辨力為1°，經(jīng)測試系統(tǒng)誤差值為0°。(2)當(dāng)間距d=7～15 cm時，通過操作鍵盤控制風(fēng)力大小，控制帆板轉(zhuǎn)角θ，θ在0°～60°，要求控制過程在5 s內(nèi)完成，并實(shí)時顯示，且有聲光提示。
6 結(jié)束語
經(jīng)測試，系統(tǒng)性能達(dá)到了設(shè)計(jì)要求，帆板角度控制屬于自動化控制類，設(shè)計(jì)采用槽型光耦加360線光柵片組成的傳感器能精確定位角度，是一種良好的角度控制傳感器，再利用PID算法控制PWM參量，從而控制風(fēng)扇的轉(zhuǎn)速。
陀螺儀相關(guān)文章:陀螺儀原理
評論