張祥慶　尹慶慶　張浩然　劉沂青　葛偉楠　山東師范大學(xué)　山東濟南　250358

?

基于stm32低功率風(fēng)力擺控制系統(tǒng)的研究

張祥慶尹慶慶張浩然劉沂青葛偉楠山東師范大學(xué)山東濟南250358

【文章摘要】

系統(tǒng)采用STM32F103V系統(tǒng)板作為控制中心，與萬向節(jié)、擺桿、2W低功率軸流風(fēng)機、激光頭、反饋裝置一起構(gòu)成擺桿運動狀態(tài)與風(fēng)機速度分配的雙閉環(huán)調(diào)速系統(tǒng)。單片機移植入ucos操作系統(tǒng)，可以穩(wěn)定地控制程序，輸出可變的PWM波給軸流風(fēng)機，控制4個方向上風(fēng)機的風(fēng)速，從而產(chǎn)生大小不同的力。利用加速度計模塊MPU6050防止脫離運動軌跡?？刂品绞讲捎肞ID算法加快動態(tài)響應(yīng)。從而使該系統(tǒng)具有很好的穩(wěn)定性。

【關(guān)鍵詞】

STM32F103V；ucos；2W軸流風(fēng)機；MPU6050；PID

0　引言

眾所周知，軸流風(fēng)機功率越大，其機動性越強，受控制能力越好，所需要的算法難度也會降低；而如果軸流風(fēng)機功率很小，那么它的可控性就會降低，所需要的算法難度大大增加。目前，在這種控制領(lǐng)域一般采用40W以上甚至100W以上的無刷電機加上扇頁，供以220V交流電或者大功率直流電來驅(qū)動電機，這種電機提供了足夠的動力，使得風(fēng)機控制算法難度大大降低。因為功率太大使得轉(zhuǎn)速太快以及風(fēng)機結(jié)構(gòu)為裸露扇葉，導(dǎo)致了噪音大、功耗高、危險系數(shù)大等問題，這些問題使得存在很大的缺陷與隱患。

1　控制方案

1.1控制系統(tǒng)

我們采用STM32F103V單片機做為主控芯片，移植ucos操作系統(tǒng)，用加速度計陀螺儀模塊MPU6050來計算角度和風(fēng)機狀態(tài)，用軸流風(fēng)機帶動擺桿運動。當(dāng)MPU6050檢測到擺桿的角度時，可根據(jù)三角函數(shù)公式計算出擺桿現(xiàn)在距離中心的具體位置，單片機會控制PWM波的輸出大小來控制風(fēng)機的風(fēng)速與方向，使擺桿達到在特定位置靜止或按照一定的軌跡運動。在此過程中，單片機做出A/D采樣，防止發(fā)生軌跡偏移。

1.2數(shù)據(jù)處理

通過加速度計陀螺儀模塊MPU6050檢測風(fēng)力擺擺桿的傾角數(shù)據(jù)。MPU6050集成了3 軸MEMS陀螺儀。MPU6050和所有設(shè)備寄存器之間通信采用I2C接口，實現(xiàn)高速通信。內(nèi)置卡爾曼濾波器，精確測量風(fēng)力擺當(dāng)前姿態(tài)角。MPU6050對陀螺儀和加速度計分別采用了16位的ADC，將其測量的模擬量轉(zhuǎn)化為可輸出的數(shù)字量，通過DMP處理器讀取測量數(shù)據(jù)然后通過串口輸出。

2　軟件設(shè)計

2.1PID算法基本原理

系統(tǒng)采用PID算法來控制風(fēng)機轉(zhuǎn)動的速度，風(fēng)機開始工作后，MPU6050不斷采集當(dāng)前擺桿擺腳狀態(tài)，并與之前的狀態(tài)進行比較，使得擺桿運動狀態(tài)趨于穩(wěn)定。PID算法控制器由4個風(fēng)機速度分配比例P角度誤差積分I角度微分D組成。

其輸入e(t)與輸出U（t)關(guān)系為：

傳遞函數(shù)為：

2.2主體算法設(shè)計

算法設(shè)計要考慮風(fēng)機二維的運動和三維的運動并加。采用閉環(huán)控制，設(shè)定一個閾值，單片機檢測到閾值，控制軸流風(fēng)機，維度不同做出不同的反應(yīng)。無論二維還是三維，都需要使用PID算法控制，提高軸流風(fēng)機的穩(wěn)定性。

為了克服軸流風(fēng)機動力不足的問題，需要在接入主體控制算法之前進行強制動力拉升，持續(xù)一段時間，然后接入PID算法，使得風(fēng)機快速穩(wěn)定下來。

由于移植了操作系統(tǒng)ucos，配合ARM單片機，使得程序的穩(wěn)定性大大增強。

2.3法實際效果

穩(wěn)定性：移植了ucos的新系統(tǒng)的穩(wěn)定性大大增強，并且在控制上沒有滯后的問題，靈敏度大大增強。

功耗：功耗為大功率直流無刷電機的0.5%到1%，發(fā)熱降低，可持續(xù)工作時間大大延長，而且節(jié)約了能源。

噪音：無嘯叫聲。

安全性：安全性較無刷電機大為提高。

3　結(jié)語

綜上所述，本系統(tǒng)基本實現(xiàn)了測試要求，并且具有低噪音、低功耗、安全系數(shù)高的特點。高性能的單片機和操作系統(tǒng)、好的算法，起到至關(guān)重要的作用，彌補了低功率風(fēng)機動力的不足，并且大大增加了穩(wěn)定性。

【參考文獻】

[1] 華成英，童詩白.模擬電子技術(shù)基礎(chǔ)[M].第四版，清華大學(xué)出版社，2006.

[2] 求是科技.單片機典型模塊設(shè)計實例導(dǎo)航[M].北京：人民郵電出版社，2004.

[3] 譚浩強.C程序設(shè)計[M].北京：清華大學(xué)出版社，1991.

[4]郭天祥.新概念51 單片機C 語言教程.入門、提高、開發(fā)[M].北京：電子工業(yè)出版社，2009.

[5] 閻石.數(shù)字電子技術(shù)基礎(chǔ)（第五版）[M].北京:高等教育出版社,2009.

[6] 吳大正.信號與線性系統(tǒng)分析（第四版）[M].北京:高等教育出版社,2005.