高中生
最后登录1970-1-1
在线时间 小时
注册时间2020-10-31
|
以下是我的配置:
u8 MPU_Init(void)
{
u8 res;
MPU_IIC_Init();//初始化IIC总线
// MPU_INT_Init();
MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X80); //复位MPU6050
DelayMs(100);
MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X00); //唤醒MPU6050
MPU_Set_Gyro_Fsr(3); //陀螺仪传感器,±2000dps
MPU_Set_Accel_Fsr(0); //加速度传感器,±2g
MPU_Set_Rate(50); //设置采样率50Hz
MPU_Write_Byte(MPU_INT_EN_REG,0X00); //关闭所有中断
MPU_Write_Byte(MPU_USER_CTRL_REG,0X00); //I2C主模式关闭
MPU_Write_Byte(MPU_FIFO_EN_REG,0X00); //关闭FIFO
MPU_Write_Byte(MPU_INTBP_CFG_REG,0X80); //INT引脚低电平有效
MPU_Write_Byte(MPU_MOTION_DET_REG,0X01); //运动阈值
MPU_Write_Byte(MPU_CFG_REG,0x04); //配置外部引脚采样和DLPF数字低通滤波器
MPU_Write_Byte(MPU_ACCEL_CFG_REG,0X1C); //加速度传感器配置
MPU_Write_Byte(MPU_INTBP_CFG_REG, 0X1C); //INT引脚低电
MPU_Write_Byte(MPU_INT_EN_REG, 0X01); //使能中断
res=MPU_Read_Byte(MPU_DEVICE_ID_REG);
if(res==MPU_ADDR)//器件ID正确
{
MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X01); //设置CLKSEL,PLL X轴为参考
MPU_Write_Byte(MPU_PWR_MGMT2_REG,0X00); //加速度与陀螺仪都工作
MPU_Set_Rate(50); //设置采样率为50Hz
}else return 1;
return 0;
}
|
|