陀螺仪数据转换成角度_MPU6050 计算角度

float res=0;

switch(dir)

{

case 0://

与自然

Z

轴的角度

temp=sqrt((x*x+y*y))/z;

res=atan(temp);

break;

case 1://

与自然

X

轴的角度

temp=x/sqrt((y*y+z*z));

res=atan(temp);

break;

case 2://

与自然

Y

轴的角度

temp=y/sqrt((x*x+z*z));

res=atan(temp);

break;

}

return res*1800/3.14;//

把弧度转换成角度

}

QQ

截图

20121029102235.jpg

(18.21 KB,

下载次数

: 130)

有更简单的

accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

angleAx=atan2(ax,az)*180/PI;

计算量更少，而且

atan2

返回值范围

-PI~PI

角速度传感器输出的是某个轴的角速度，

所以，

如果想计算某个轴的角度

(一般是相对于自