C mt cch chng nhiu na l dng Runge-Kutta filter lc tn hiu :

y l on code mu mnh vit dng C :

for (i=0; i < 6; i++)
{
adc_filter_buffer[current_buf][i] = ADC16Ptr[i];
}
for (i=0; i < 6; i++)
{
adc_buf[i] = (adc_filter_buffer[current_buf][i]/6 +
adc_filter_buffer[(current_buf+1)%4][i]/6 +
adc_filter_buffer[(current_buf+2)%4][i]/3 +
adc_filter_buffer[(current_buf+3)%4][i]/3);
}
current_buf = (current_buf+1) % 4;