智能车制作

标题: 寄存器的值能读取正确，但是MPU6050数据跳变厉害 [打印本页]

作者: yzx 时间: 2015-9-22 10:23
标题: 寄存器的值能读取正确，但是MPU6050数据跳变厉害
求大神指导，有遇到这个问题的吗

作者: yzx 时间: 2015-9-22 10:45

la9998372 发表于 2015-9-22 10:26
你是什么类型的数据？应该是int16吧？
你先用iar在线调试看看变量的值，在看看是不是串口发数据的时候，高 ...

是int16_t型的数据

作者: yzx 时间: 2015-9-22 11:55
求指导有哪位知道吗

作者: 机遇 时间: 2015-9-22 12:39
提供下程序

作者: yzx 时间: 2015-9-22 15:54

la9998372 发表于 2015-9-22 12:14
你拿iar看数值了吗？数值稳定吗?

但不运行了几十次，加速度计x轴的值分别为0x3434,0x342e,0x342a,0x340e,0x332c,0x3430,0x3420,0x3422,0x3402,0x3428,0x343a,0xfff6,0x3404,0x3436,0x330c,0x3438,0x3442,0x3412,0x3400,0x3408,0x3422,0x343c,0x3414,0x3434,0x3420,0x342a,0x342c,0x3422,0x3424,0x342c,0x3446,0x3400,也不稳定，有的差很多的啊

作者: yzx 时间: 2015-9-22 15:56

机遇发表于 2015-9-22 12:39
提供下程序

#include "I2C.h"

GPIO_InitTypeDef GPIO_InitStructure;
void I2c_Init()
{

RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);

GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_11;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;

GPIO_Init(GPIOB,&GPIO_InitStructure);

SDA_HIGH();
SCL_HIGH();
}

void I2c_Start(void)
{
SDA_OUT();
SDA_HIGH();
SCL_HIGH();
Delay_I2c();
SDA_LOW();
Delay_I2c();
SCL_LOW();
Delay_I2c();
}

void I2c_Stop(void)
{
SCL_LOW();
SDA_OUT();
SDA_LOW();
// Delay_I2c();
SCL_HIGH();
Delay_I2c();
SDA_HIGH();
Delay_I2c();
SCL_LOW();//oó¼ó
}

//μè′yó|′eDÅoÅ￡¬·μ»Ø0±íê¾Î′êÕμ½ó|′e￡¬1±íê¾êÕμ½ó|′e
u8 I2c_Wait_Ack()
{
u8 i=0;
//SCL_LOW();
SDA_IN();
SCL_HIGH();
// Delay_I2c();
while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_11))
{
i++;
if(i>250)
{
I2c_Stop();
return 0;
}
}
SCL_LOW();
return 1;
}

void I2c_Ack()
{
SCL_LOW();
SDA_OUT();
//SCL_LOW();
SDA_LOW();
Delay_I2c();
SCL_HIGH();
Delay_I2c();
SCL_LOW();
}

void I2c_NAck()
{
SCL_LOW();
SDA_OUT();
SDA_HIGH();
Delay_I2c();
SCL_HIGH();
Delay_I2c();
SCL_LOW();
}

void I2c_SendByte(u8 data)
{
u8 i;
SDA_OUT();
SCL_LOW();
for(i = 0;i<8;i++)
{
GPIO_WriteBit(GPIOB,GPIO_Pin_11,(data&0x80)>>7);
data<<=1;
Delay_I2c();
SCL_HIGH();
Delay_I2c();
SCL_LOW();
Delay_I2c();
}
}

int8_t I2c_ReadByte(unsigned char ack)
{
unsigned char i,receive=0;
SDA_IN();
SCL_LOW();
for(i = 0;i<8;i++)
{
SCL_HIGH();
Delay_I2c();
receive<<=1;
if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_11))
   receive++;
SCL_LOW();
Delay_I2c();
}
if(!ack)
I2c_NAck();
else
I2c_Ack();
return receive;
}

void Delay_I2c()
{
u16 count;
for(count = 50;count>0;count--);
}

u8 MPU_Init()
{
I2c_Init();
MPU_Delay();
MPU_Delay();
MPU_Delay();
MPU_Delay();
while(!MPU_Write_Data(MPU6050_RA_PWR_MGMT_1,0x00));
MPU_Delay();
while(!MPU_Write_Data(MPU6050_RA_SMPLRT_DIV,0x07));
MPU_Delay();
while(!MPU_Write_Data(MPU6050_RA_CONFIG,0x03));//06
MPU_Delay();
while(!MPU_Write_Data(MPU6050_RA_GYRO_CONFIG,0x00));  // 00á¿3ì￡o500
MPU_Delay();
while(!MPU_Write_Data(MPU6050_RA_ACCEL_CONFIG,0x00)); //á¿3ì 4g
MPU_Delay();

return 1;
}

u8 MPU_Read()
{
int8_t buf[14];
if(MPU_Read_Len(MPU6050_RA_ACCEL_XOUT_H,14,buf))
{
Acc_XYZ.X = ((int16_t)buf[0])<<8 | buf[1] -Acc_OFFSET.X;
Acc_XYZ.Y = ((int16_t)buf[2])<<8 | buf[3] - Acc_OFFSET.Y;
Acc_XYZ.Z = ((int16_t)buf[4])<<8 | buf[5] - Acc_OFFSET.Z;
Gyro_XYZ.X = ((int16_t)buf[8])<<8 | buf[9] - Gyro_OFFSET.X;
Gyro_XYZ.Y = ((int16_t)buf[10])<<8 | buf[11] - Gyro_OFFSET.Y;
Gyro_XYZ.Z = ((int16_t)buf[12])<<8 | buf[13] - Gyro_OFFSET.Z;
}

else return 0;
  return 1;
}
//μÃμ½íóÂYòÇÔ-ê¼Öμ
u8 MPU_Get_Gyro()
{
u8 buf[6];
if(MPU_Read_Len(MPU6050_RA_GYRO_XOUT_H,6,buf))
{
Gyro_XYZ.X = ((u16)buf[0]<<8)|((u16)buf[1]);
Gyro_XYZ.Y = ((u16)buf[2]<<8)|((u16)buf[3]);
Gyro_XYZ.Z = ((u16)buf[4]<<8)|((u16)buf[5]);
}
else return 0;
  return 1;
}

//μÃμ½¼óËù¶è¼ÆμÄÔ-ê¼Öμ
u8 MPU_Get_Acce(MPU6050_XYZ Acce_XYZ)
{
u8 buf[6];
if(MPU_Read_Len(MPU6050_RA_ACCEL_XOUT_H,6,buf))
{
Acce_XYZ.X = ((u16)buf[0]<<8)|((u16)buf[1]);
Acce_XYZ.Y = ((u16)buf[2]<<8)|((u16)buf[3]);
Acce_XYZ.Z = ((u16)buf[4]<<8)|((u16)buf[5]);
}
else return 0;
  return 1;
}

//á¬DøD′
u8 MPU_Write_Len(u8 reg,u8 len,u8* buf)
{
u8 i;
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|0); //·￠ËíÆ÷¼tμØÖ·+D′Ãüáî
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_SendByte(reg);
I2c_Wait_Ack();
for(i = 0;i < len;i++)
{
I2c_SendByte(buf);
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
}
I2c_Stop();
return 1;
}

//á¬Dø¶á
u8 MPU_Read_Len(u8 reg,u8 len,int8_t* buf)
{
u8 i;
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|0); //·￠ËíÆ÷¼tμØÖ·+D′Ãüáî
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_SendByte(reg);
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|1); //·￠ËíÆ÷¼tμØÖ·+¶áÃüáî
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
while(len)
{
if (len==1) *buf = I2c_ReadByte(0); //·￠ËíNACK
else
*buf = I2c_ReadByte(1); //·￠ËíACK
buf++;
len--;
}
I2c_Stop();
return 1;
}

//Ïò¼Ä′æÆ÷D′μ￥×Ö½ú
u8 MPU_Write_Data(u8 reg,u8 data)
{
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|0); //·￠ËíÆ÷¼tμØÖ·+D′Ãüáî

if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_SendByte(reg);
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}

I2c_SendByte(data);

if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_Stop();
return 1;
}

//Ïò¼Ä′æÆ÷¶áμ￥×Ö½ú
int8_t MPU_Read_Data(u8 reg)
{
u8 res;
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|0); //·￠ËíÆ÷¼tμØÖ·+D′Ãüáî
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_SendByte(reg);
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
I2c_Start();
I2c_SendByte(MPU6050_ADD<<1|1); //·￠ËíÆ÷¼tμØÖ·+¶áÃüáî
if(!I2c_Wait_Ack())
{
I2c_Stop();
return 0;
}
res = I2c_ReadByte(0); //2»·￠ËíACK
I2c_Stop();
return res;
}
void MPU_Delay()
{
u16 i=500;
while(i)
{
i--;
}
}
能帮忙看看吗，用的是stm32，SDA输入的时候是浮空输入

作者: yzx 时间: 2015-9-22 16:02

la9998372 发表于 2015-9-22 12:14
你拿iar看数值了吗？数值稳定吗?

静止和动的时候的波形如下图

作者: 机遇 时间: 2015-9-23 08:44

yzx 发表于 2015-9-22 15:56
#include "I2C.h"

GPIO_InitTypeDef GPIO_InitStructure;

Gyro_XYZ.X = (int16)(((u16)buf[0]<<8&0xff00)|((u16)buf[1])); 不行的话可能是读多个字节有问题，先试试单字节读写。

作者: yzx 时间: 2015-9-23 08:59

机遇发表于 2015-9-23 08:44
Gyro_XYZ.X = (int16)(((u16)buf[0]

读单字节也是不行，还是波动很大，不知道是不是模块有问题了，打算再买一个试试

作者: 机遇 时间: 2015-9-23 11:20
本帖最后由机遇于 2015-9-23 11:27 编辑

yzx 发表于 2015-9-23 08:59
读单字节也是不行，还是波动很大，不知道是不是模块有问题了，打算再买一个试试
可能是IIC时序有问题，你用示波器看下吧，或者你那个上位机用法用错了，我看你图像最小刻度才几十，实际上加速度计静止的数字应该很大吧，你可以先在上位机画条正弦函数。

欢迎光临智能车制作 (http://111.231.132.190/) Powered by Discuz! X3.2