标题: 关于单片机软件滤波的方法,求大神 [打印本页]
作者: 哈哈007    时间: 2018-5-23 16:51
标题: 关于单片机软件滤波的方法,求大神
这个程序采用的滤波方法不好，我测量5V的电压是，电压会跳动，会调到10v，6V,7V，8V有时候还会调到0V，有什么方法吗

单片机源码:
  1. #include "12c5a.h"
  2. #include "intrins.h"
  3. #include "stdio.h"
  4. #define uint unsigned int
  5. #define uchar unsigned char
  6. //sfr ADC_LOW2  = 0XBE;
  7. #define ADC_POWER   0X80
  8. #define ADC_FLAG    0X10
  9. #define ADC_START   0X08                        
  10. #define ADC_SPEEDLL 0X00
  11. #define ADC_SPEEDL  0X20
  12. #define ADC_SPEEDH  0X40
  13. #define ADC_SPEEDHH 0X60
  14. #define N 12

  16. sbit PWM1=P2^0;
  17. sbit P3_1=P3^1;
  18. uchar time;
  19. uint Val=3;
  20. uint Serror,FError,MK=2;
  21. uchar Kp,Ti,Td;

  23. void delay(uint n)
  24. {
  25.         uint x;
  26.         while(n--)
  27.         {
  28.                 x=5000;
  29.                 while(x--);
  30.         }
  31. }

  33. /*---------------------------- 初始化ADC特殊功能寄存器 -------------------*/

  35. void InitADC( )
  36. {

  38.           P1ASF = P1 | 0x3f;                //Set  P1.0 - P1.5 as analog input port
  39.           ADC_RES  = 0;                  //Clear previous result
  40.           ADC_RESL = 0;
  41.           ADC_CONTR = ADC_POWER | ADC_SPEEDLL ;
  42.           delay(20);                      //ADC power-on delay and Start A/D conversion
  43. }
  44. unsigned int AD_get(unsigned char channel)                //ad取值
  45. {
  46.         ADC_CONTR=0x88|channel;   
  47.         _nop_(); _nop_(); _nop_(); _nop_();
  48.         while(!(ADC_CONTR&0x10));   
  49.                 ADC_CONTR&=0xe7;   
  50.         return(ADC_RES*4+ADC_RESL);  
  51. }
  52. float AD_work(unsigned char channel)                         //ad求平均值
  53. {
  54.         float AD_val;   
  55.         unsigned char i;
  56.         for(i=0;i<100;i++)
  57.         AD_val+=AD_get(channel);
  58.         AD_val/=100;
  59.         AD_val=AD_get(channel);
  60.         AD_val=AD_val*(5.0/1024);
  61.         return AD_val;
  62. }
  63. void UART_init()
  64. {
  65.         TMOD = 0x20;          //T1工作模式2  8位自动重装
  66.         TH1 = 0xfd;
  67.         TL1 = 0xfd;         //比特率9600
  68.         TR1 = 1;                //启动T1定时器
  69.         SM0 = 0;
  70.         SM1 = 1;                 //串口工作方式1 10位异步
  71.         REN = 1;                //串口允许接收
  72.         EA  = 1;                //开总中断
  73.         ES  = 1;                //串口中断打开
  74. }

  76. /*********************************************************

  78.   发送数据函数

  80. *********************************************************/
  81. void senddata(float dat)
  82. {
  83.          ES=0;
  84.          TI=1;
  85.      printf("%f \n",dat);
  86.      while(!TI);
  87.      TI = 0;
  88.          ES=1;
  89. }

  91. /*************PID初始化函数***************/
  92. void PID_init(void){
  93.         Serror=0;
  94.         FError=0;
  95.         Kp=2;
  96.         Ti=500;
  97.         Td=10;
  98.         }

  100. int PID_control(int Now_speed)
  101. {
  102.         int Error,Serror,result;
  103.         Error=Now_speed-Val;
  104.         Serror=Serror+Error;
  105.         MK=(Kp*Error+Kp*0.05/Ti*Serror+Kp*Td/0.05*(Error-FError));
  106.         FError=Error;
  107.         //对占空比进行限幅处理
  108.         if(MK<1)
  109.         {MK=1;}
  110.         else if(MK>9)
  111.         {result=9;}
  112.         return MK;
  113. }

  115. void key()
  116. {

  118. }


  121. void main()
  122. {      
  123.         UART_init();
  124.         InitADC( );
  125. //        TMOD=0x01;//定时器0工作方式1
  126. //        TH0=0xff;//(65536-10)/256;//赋初值定时
  127. //        TL0=0xf7;//(65536-10)%256;//0.01ms
  128. //        EA=1;//开总中断
  129. //        ET0=1;//开定时器0中断
  130. //        TR0=1;//启动定时器0
  131.         PID_init();
  132.         while(1)
  133.         {
  134.                 float k;
  135.       
  136.                 k=41*AD_work(0);
  137.                 PID_control(k);
  138.                 senddata(Val);
  139.                 delay(100);
  140.                         if(P3_1==0)
  141.         {
  142.                 Val++;
  143.         }
  144.                
  145.         }
  146. }


  149. //void tim0() interrupt 1
  150. //{
  151. //        TR0=0;//赋初值时，关闭定时器
  152. //        TH0=0xff;//(65536-10)/256;//赋初值定时
  153. //        TL0=0xf9;//(65536-10)%256;//0.01ms
  154. //        TR0=1;//打开定时器
  155. //        time++;
  156. //        if(time>=10) time=0;//1khz
  157. //        if(time>=MK) PWM1=0;//点空比%80
  158. //        else PWM1=1;
  159. //        PWM2=0;      
  160. //}
复制代码


作者: lxbhcy    时间: 2020-7-28 15:19
试试一阶滤波



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1