极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 11276|回复: 1

求助 MPU6050读数问题

[复制链接]
发表于 2016-3-19 11:53:14 | 显示全部楼层 |阅读模式
[pre lang="C" line="1" file="timer.c"]
void TIM6_Init(void)
{
        RCC->APB1ENR|=1<<4;
        TIM6->PSC=999;
        TIM6->ARR=200;
        TIM6->EGR=1;
        TIM6->DIER|=1<<0;
        TIM6->CR1|=1<<0;
        NVIC->ISER[1]|=1<<22;
        NVIC->IP[54]=1;
}

void TIM6_DAC_IRQHandler(void)
{
       
       
        mpu.AXtemp=Get(0x3b);
        mpu.AYtemp=Get(0x3d);
        mpu.AZtemp=Get(0x3f);
        mpu.GXtemp=Get(0x43);
        mpu.GYtemp=Get(0x45);
        mpu.GZtemp=Get(0x47);
        mpu.GX+=(((mpu.GXtemp-22)*0.061035f)/500.0f);
        mpu.GY+=((mpu.GYtemp-45)*0.061035f)/500.0f;
        mpu.GZ+=((mpu.GZtemp+6)*0.061035f)/500.0f;
        mpu.AXtemp1=(float)mpu.AXtemp/4096.0f;
        mpu.AYtemp1=(float)mpu.AYtemp/4096.0f;
        mpu.AZtemp1=(float)mpu.AZtemp/4096.0f;

        mpu.AX=atan2f(mpu.AYtemp1,mpu.AZtemp1)*57.2958f;
        mpu.AY=atan2f(mpu.AXtemp1,mpu.AZtemp1)*57.2958f;
        mpu.AZ=atan2f(mpu.AXtemp1,mpu.AYtemp1)*57.2958f;
        TIM6->SR=0;
       
       
}[/code]


角速度换算成的角度总是 正常值的一半, MPU角度上的寄存器 我设置的是0x18;
回复

使用道具 举报

 楼主| 发表于 2016-3-19 16:14:07 | 显示全部楼层
IIC读取时间的延时时间太长了。。。。。。
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则 需要先绑定手机号

Archiver|联系我们|极客工坊

GMT+8, 2024-3-29 01:07 , Processed in 0.041113 second(s), 18 queries .

Powered by Discuz! X3.4 Licensed

Copyright © 2001-2021, Tencent Cloud.

快速回复 返回顶部 返回列表