互补滤波

只看该作者 · 2025-5-26 07:56

void DEVICE_INFO::TX_updata()



{



 

//使用一阶互补滤波算法



static u16 bre_i=0;



static u16 bre_ii=0;



static u16 bre_v=0;



static u16 bre_vv=0;



 

u16 adci,adcv;



unsigned char r_buff[33];



//TX电流



adci=Get_Adc_Average(ADC_CH11,10); //此处有10次平均滤波



adci=(adci*3300)/4096;



 

//TX_electricity=adci;



//电压



adcv=Get_Adc_Average(ADC_CH10,10);



adcv=(adcv*3300)/4096;



 

//TX_voltage=adcv;



 

//说明一下 0.92和0.08是权值 ，0.000001是处理周期，我这里处理比较快，单位是s



 

TX_electricity=0.92*(TX_electricity-bre_i*0.000001)+0.08*bre_ii;



TX_voltage=0.92*(TX_voltage-bre_v*0.000001)+0.08*bre_vv;



 

bre_ii=bre_i; //保存上次值



bre_i=adci; //保存本次值



 

bre_vv=bre_v;



bre_v=adcv; //保存本次值



 

}