xuehu5808：
應該是算法有問題,你可以這樣試下,步進馬達轉動一下,然后檢測發(fā)電機輸出頻率,如果頻率與設定頻率相差比較大時,馬達可以轉快一點,并且調整油門后需要等待一段時間才能檢測頻率,畢竟發(fā)電機的反映要滯后很多的,關于頻率檢測的算法也有問題,有點資料給你參考:常用軟件濾波方法點擊數:2283 發(fā)布日期:2006-2-2715:48:00 【收藏】【評論】【打印】【編程愛好者論壇】【關閉】常用軟件濾波方法及其示例程序作者未知 來源 發(fā)布時間2005-08-24 瀏覽次數26 字體大 中 小 1、限幅濾波法(又稱程序判斷濾波法)A、方法:根據經驗判斷,確定兩次采樣允許的最大偏差值(設為A)每次檢測到新值時判斷:如果本次值與上次值之差A,則本次值無效,放棄本次值,用上次值代替本次值B、優(yōu)點:能有效克服因偶然因素引起的脈沖干擾C、缺點無法抑制那種周期性的干擾平滑度差示例:/*A值可根據實際情況調整value為有效值,new_value為當前采樣值濾波程序返回有效的實際值*/#defineA10charvalue;charfilter(){charnew_value;new_value=get_ad();if((new_value-value>A)||(value-new_value>A))returnvalue;elsereturnnew_value;}2、中位值濾波法A、方法:連續(xù)采樣N次(N取奇數)把N次采樣值按大小排列取中間值為本次有效值B、優(yōu)點:能有效克服因偶然因素引起的波動干擾對溫度、液位的變化緩慢的被測參數有良好的濾波效果C、缺點:對流量、速度等快速變化的參數不宜示例:/*N值可根據實際情況調整排序采用冒泡法*/#defineN11charfilter(){charvalue_buf[N];charcount,i,j,temp;for(count=0;count{value_buf[count]=get_ad();delay();}for(j=0;j{for(i=0;i{if(value_buf[i]>value_buf[i+1]){temp=value_buf[i];value_buf[i]=value_buf[i+1];value_buf[i+1]=temp;}}}returnvalue_buf[(N-1)/2];}3、算術平均濾波法A、方法:連續(xù)取N個采樣值進行算術平均運算N值較大時:信號平滑度較高,但靈敏度較低N值較小時:信號平滑度較低,但靈敏度較高N值的選取:一般流量,N=12;壓力:N=4B、優(yōu)點:適用于對一般具有隨機干擾的信號進行濾波這樣信號的特點是有一個平均值,信號在某一數值范圍附近上下波動C、缺點:對于測量速度較慢或要求數據計算速度較快的實時控制不適用比較浪費RAM示例:#defineN12charfilter(){intsum=0;charcount;for(count=0;count{sum+=get_ad();delay();}return(char)(sum/N);}4、遞推平均濾波法(又稱滑動平均濾波法)A、方法:把連續(xù)取N個采樣值看成一個隊列隊列的長度固定為N每次采樣到一個新數據放入隊尾,并扔掉原來隊首的一次數據.(先進先出原則)把隊列中的N個數據進行算術平均運算,就可獲得新的濾波結果N值的選取:流量,N=12;壓力:N=4;液面,N=4~12;溫度,N=1~4B、優(yōu)點:對周期性干擾有良好的抑制作用,平滑度高適用于高頻振蕩的系統(tǒng)C、缺點:靈敏度低對偶然出現的脈沖性干擾的抑制作用較差不易消除由于脈沖干擾所引起的采樣值偏差不適用于脈沖干擾比較嚴重的場合比較浪費RAM示例:#defineN12charvalue_buf[N];chari=0;charfilter(){charcount;intsum=0;value_buf[i++]=get_ad();if(i==N)i=0;for(count=0;countsum=value_buf[count];return(char)(sum/N);}5、中位值平均濾波法(又稱防脈沖干擾平均濾波法)A、方法:相當于“中位值濾波法”+“算術平均濾波法”連續(xù)采樣N個數據,去掉一個最大值和一個最小值然后計算N-2個數據的算術平均值N值的選取:3~14B、優(yōu)點:融合了兩種濾波法的優(yōu)點對于偶然出現的脈沖性干擾,可消除由于脈沖干擾所引起的采樣值偏差C、缺點:測量速度較慢,和算術平均濾波法一樣比較浪費RAM示例:#defineN12charfilter(){charcount,i,j,temp;charvalue_buf[N];intsum=0;for(count=0;count{value_buf[count]=get_ad();delay();}for(j=0;j{for(i=0;i{if(value_buf[i]>value_buf[i+1]){temp=value_buf[i];value_buf[i]=value_buf[i+1];value_buf[i+1]=temp;}}}for(count=1;countsum+=value_buf[count];return(char)(sum/(N-2));}6、限幅平均濾波法A、方法:相當于“限幅濾波法”+“遞推平均濾波法”每次采樣到的新數據先進行限幅處理,再送入隊列進行遞推平均濾波處理B、優(yōu)點:融合了兩種濾波法的優(yōu)點對于偶然出現的脈沖性干擾,可消除由于脈沖干擾所引起的采樣值偏差C、缺點:比較浪費RAM略參考子程序1、37、一階滯后濾波法A、方法:取a=0~1本次濾波結果=(1-a)*本次采樣值+a*上次濾波結果B、優(yōu)點:對周期性干擾具有良好的抑制作用適用于波動頻率較高的場合C、缺點:相位滯后,靈敏度低滯后程度取決于a值大小不能消除濾波頻率高于采樣頻率的1/2的干擾信號示例:/*為加快程序處理速度假定基數為100,a=0~100*/#definea50charvalue;charfilter(){charnew_value;new_value=get_ad();return(100-a)*value+a*new_value;}8、加權遞推平均濾波法A、方法:是對遞推平均濾波法的改進,即不同時刻的數據加以不同的權通常是,越接近現時刻的數據,權取得越大.給予新采樣值的權系數越大,則靈敏度越高,但信號平滑度越低B、優(yōu)點:適用于有較大純滯后時間常數的對象和采樣周期較短的系統(tǒng)C、缺點:對于純滯后時間常數較小,采樣周期較長,變化緩慢的信號不能迅速反應系統(tǒng)當前所受干擾的嚴重程度,濾波效果差示例:/*coe數組為加權系數表,存在程序存儲區(qū).*/#defineN12charcoe[N]={1,2,3,4,5,6,7,8,9,10,11,12};charsum_coe=1+2+3+4+5+6+7+8+9+10+11+12;charfilter(){charcount;charvalue_buf[N];intsum=0;for(count=0;count{value_buf[count]=get_ad();delay();}for(count=0;countsum+=value_buf[count]*coe[count];return(char)(sum/sum_coe);}9、消抖濾波法A、方法:設置一個濾波計數器將每次采樣值與當前有效值比較:如果采樣值＝當前有效值,則計數器清零如果采樣值當前有效值,則計數器+1,并判斷計數器是否>=上限N(溢出)如果計數器溢出,則將本次值替換當前有效值,并清計數器B、優(yōu)點:對于變化緩慢的被測參數有較好的濾波效果,可避免在臨界值附近控制器的反復開/關跳動或顯示器上數值抖動C、缺點:對于快速變化的參數不宜如果在計數器溢出的那一次采樣到的值恰好是干擾值,則會將干擾值當作有效值導入系統(tǒng)示例:charvalue;#defineN12charfilter(){charcount=0;charnew_value;new_value=get_ad();while(value!=new_value);{count++;if(count>=N)returnnew_value;delay();new_value=get_ad();}returnvalue;}10、限幅消抖濾波法A、方法:相當于“限幅濾波法”+“消抖濾波法”先限幅,后消抖B、優(yōu)點:繼承了“限幅”和“消抖”的優(yōu)點改進了“消抖濾波法”中的某些缺陷,避免將干擾值導入系統(tǒng)C、缺點:對于快速變化的參數不宜參考子程序1、9引用地址:http://blog.programfan.com/trackback.asp?id=10586