void AD_calculate(void)
{
gyro=0.011557*ADC(1)-3.0396+114*3.14/180;
if(gyro*57.3>43)
gyro=43/57.3;
//acceler
=ADC(0);
acceler=0.003052*ADC(0)-1.4375;
//系数换算:2.5/(1.2*512);
acceler=acceler*1.5+14*3.14/180;
//
acceler=asin(acceler)*1.5+5*3.14/180;
//angle=acceler; angle_dot=gyro;
Kalman_Filter(acceler,gyro);
}
请问下LZ,这个子程序里的0.011557,43,0.003052分别是什么意思啊?还有gyro*57.3后得出的是角度吧? |