zoomone 发表于 2011-10-12 12:40
角度、角速度AD转换函数
请教一下:
void AD_calculate(void)
{
acceler=ADport(2)+28; //角度校正
gyro=ADport(3);
acceler*=0.004069; //系数换算:2.5/(1.2*512);
acceler=asin(acceler);
gyro*=0.00341; //角速度系数:(3.14/180)* 100/512=0.01364;
Kalman_Filter(acceler,gyro);
//complement_filter(acceler,gyro);
}
acceler*=0.004069; //系数换算:2.5/(1.2*512);
gyro*=0.00341; //角速度系数:(3.14/180)* 100/512=0.01364;
这两个系数是咋搞出来了?求原理,谢谢。 |