求助大神MPU6050平衡车问题

2019-10-16 07:59发布

大神们帮我看看,这样的放置MPU6050,我的代码这么写对不对
void Angle_Calculate()
{
        Gyro_y = GetData(GYRO_YOUT_H);            
        Gyro_y = -(Gyro_y +4)/16.4;  

        Accel_x  = GetData(ACCEL_YOUT_H);          
        Angle_ax = (Accel_x-zero) /16384;
        Angle_ax = Angle_ax*1.2*180/3.14;  

}
Gyro_y 这样求出的是不是车子对应平衡方向上的角速度?,然后经过卡尔曼滤波?急求
Kalman_Filter(Angle_ax,Gyro_y);
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。