mpu6050 dmp读出的角度为啥没有变化
液晶屏显示读书一直是-533 为啥呢while(1)
{
i=getFIFOCount();//读取FIFO计数
i2cread(0x3A,&zd); //读取中断状态
if((zd & 0x10)||i==1024) //判断FIFO是否溢出
{
writeBit(0x6A,2,1); //复位 FIFO
}
else if (zd & 0x02)
{
while(i<42) i=getFIFOCount();
readdmp(dmpdatas); //读取FIFO数据
getquaternion();
getyawpitchroll();
tt= yprf%1000-533;
if(tt<0) yprf=tt*(-1);
q=yprf/1000;
b=yprf/100%10;
s=yprf%100/10;
g=yprf%10;
write_com(0x80);
if(tt<0)
write_data('-');
else
write_data('+');
write_com(0x81);
write_data(table);
write_com(0x82);
write_data(table);
write_com(0x83);
write_data(table);
write_com(0x84);
write_data(table);
页:
[1]