陀螺仪MPU6050(IIC&源码)

1. 陀螺仪

1.1 什么是陀螺仪?

检测角度变化的一个装置。

1.1.1 有什么用??

用于检测角度变化,用角度变化的值判断物体的运动轨迹。

1.1.2 我们怎么用?

我们是使用这个装置(或者说设备)获取到数据,再使用这个数据得到我们想要的信息。

这里我使用陀螺仪获取板子的运动轨迹(其实是陀螺仪的运动轨迹)。

​​​​​​​1.1.4 看原理图

 

又又又使用的是IIC通信协议,而且引脚又是PB6和PB7。

​​​​​​​1.1.5 地址是多少??

结合原理图可以知道地址是0x68。 

​​​​​​​1.1.6 陀螺仪如何工作?

陀螺仪在你设置好参数之后,就会根据你设置的参数获取数据,数据存储在对应的寄存器中,你可以通过对应寄存器读取到想要的数据。

​​​​​​​1.1.7 参数怎么设置?

源码m:

mpu6050.c

#include "mpu6050.h"
#include "systick.h"
#include "usart1.h"   
/*********************************************************************************************************
* 函 数 名 : Mpu6050_Init
* 功能说明 : 初始化MPU6050
* 形    参 : 无
* 返 回 值 : 0:成功;其他:错误代码
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_Init(void)
{ 
	unsigned char res;
	GPIO_InitTypeDef GPIO_InitStructure;            	 	
	
	RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOB, ENABLE);	
	
	GPIO_InitStructure.GPIO_Pin   = GPIO_Pin_6 | GPIO_Pin_7;	
	GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_OUT; 
	GPIO_InitStructure.GPIO_OType = GPIO_OType_OD;   
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; 
	GPIO_InitStructure.GPIO_PuPd  = GPIO_PuPd_NOPULL; 
	GPIO_Init(GPIOB, &GPIO_InitStructure);          
	
	GPIO_SetBits(GPIOB, GPIO_Pin_6 | GPIO_Pin_7); 
	
	Mpu6050_WriteByte(MPU_PWR_MGMT1_REG, 0X80);	//复位MPU6050
   delay_ms(500);
	delay_ms(500);
	Mpu6050_WriteByte(MPU_PWR_MGMT1_REG, 0X00);	//唤醒MPU6050 
	Mpu6050_SetGyroFsr(3);						//陀螺仪传感器,±2000dps
	Mpu6050_SetAccelFsr(0);						//加速度传感器,±2g
	Mpu6050_SetRate(50);						//设置采样率50Hz
	Mpu6050_WriteByte(MPU_INT_EN_REG, 0X00);	//关闭所有中断
	Mpu6050_WriteByte(MPU_USER_CTRL_REG, 0X00);	//I2C主模式关闭
	Mpu6050_WriteByte(MPU_FIFO_EN_REG, 0X00);	//关闭FIFO
	Mpu6050_WriteByte(MPU_INTBP_CFG_REG, 0X80);	//INT引脚低电平有效
	res = Mpu6050_ReadByte(MPU_DEVICE_ID_REG);

	if(res == MPU_ADDR){							//器件ID正确
		Mpu6050_WriteByte(MPU_PWR_MGMT1_REG, 0X01);	//设置CLKSEL,PLL X轴为参考
		Mpu6050_WriteByte(MPU_PWR_MGMT2_REG, 0X00);	//加速度与陀螺仪都工作
		Mpu6050_SetRate(50);						//设置采样率为50Hz
 	}else{
		return 1;
	}
	
	return 0;
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_SetGyroFsr
* 功能说明 : 设置MPU6050陀螺仪传感器满量程范围
* 形    参 : fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_SetGyroFsr(unsigned char fsr)
{
	return Mpu6050_WriteByte(MPU_GYRO_CFG_REG, fsr<<3);		//设置陀螺仪满量程范围  
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_SetAccelFsr
* 功能说明 : 设置MPU6050加速度传感器满量程范围
* 形    参 : fsr:0,±2g;1,±4g;2,±8g;3,±16g
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_SetAccelFsr(unsigned char fsr)
{
	return Mpu6050_WriteByte(MPU_ACCEL_CFG_REG, fsr<<3);	//设置加速度传感器满量程范围  
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_SetLPF
* 功能说明 : 设置MPU6050的数字低通滤波器
* 形    参 : lpf:数字低通滤波频率(Hz)
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_SetLPF(unsigned short lpf)
{
	unsigned char data = 0;
	
	if(lpf >= 188){
		data = 1;
	}else if(lpf >= 98){
		data = 2;
	}else if(lpf >= 42){
		data = 3;
	}else if(lpf >= 20){
		data = 4;
	}else if(lpf >= 10){
		data = 5;
	}else{
		data = 6; 
	}
	
	return Mpu6050_WriteByte(MPU_CFG_REG, data);	//设置数字低通滤波器  
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_SetRate
* 功能说明 : 设置MPU6050的采样率(假定Fs=1KHz)
* 形    参 : rat:4~1000(Hz)
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_SetRate(unsigned short rate)
{
	unsigned char data;
	
	if(rate > 1000){
		rate = 1000;
	}
	
	if(rate < 4){
		rate = 4;
	}
	
	data = 1000/rate - 1;
	data = Mpu6050_WriteByte(MPU_SAMPLE_RATE_REG, data);	//设置数字低通滤波器
	
 	return Mpu6050_SetLPF(rate/2);								//自动设置LPF为采样率的一半
}
/*********************************************************************************************************
* 函 数 名 : usart1_report_imu
* 功能说明 : 通过串口一上报姿态数据
* 形    参 : roll:横滚角;pitch:俯仰角;yaw:航向角;
* 返 回 值 : 无
* 备    注 : 此函数上报至匿名上位机(v7),传入的角度数据应扩大100倍
*********************************************************************************************************/ 
void usart1_report_imu(short roll, short pitch, short yaw)
{
	unsigned char tbuf[20] = {0}; 
	unsigned char cnt = 0, i = 0;
	unsigned char sumcheck = 0;
	unsigned char addcheck = 0;
	
	tbuf[cnt++] = 0xaa;		//帧头
	tbuf[cnt++] = 0xff;		//目标地址
	tbuf[cnt++] = 0x03;		//功能码,0x03:飞控姿态,欧拉角模式
	tbuf[cnt++] = 0x07;		//数据长度固定7个
	
	tbuf[cnt++] = BYTE0(roll);
	tbuf[cnt++] = BYTE1(roll);
	
	tbuf[cnt++] = BYTE0(pitch);
	tbuf[cnt++] = BYTE1(pitch);
	
	tbuf[cnt++] = BYTE0(yaw);
	tbuf[cnt++] = BYTE1(yaw);
	
	tbuf[cnt++] = 255;			//融合状态
	
	for(i=0; i<(tbuf[3]+4); i++){
		sumcheck += tbuf[i]; 	//从帧头开始,对每一字节进行求和,直到DATA区结束
		addcheck += sumcheck; 	//每一字节的求和操作,进行一次sumcheck的累加
	}
	tbuf[cnt++] = sumcheck;		//和校验
	tbuf[cnt++] = addcheck;		//附加校验
	
	Usart1_SendPackage(tbuf, cnt);
} 
/*********************************************************************************************************
* 函 数 名 : Mpu6050_GetTemperature
* 功能说明 : 读取MPU6050温度值
* 形    参 : 无
* 返 回 值 : 温度值(扩大了100倍)
* 备    注 : 无
*********************************************************************************************************/ 
short Mpu6050_GetTemperature(void)
{
    unsigned char buf[2]; 
    short raw;
	float temp;
	
	Mpu6050_ReadLen(MPU_ADDR, MPU_TEMP_OUTH_REG, 2, buf); 
    raw = ((unsigned short)buf[0]<<8) | buf[1];  
    temp = 36.53 + ((double)raw)/340;  
	
    return temp * 100;
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_GetGyroscope
* 功能说明 : 读取MPU6050陀螺仪值(原始值)
* 形    参 : gx、gy、gz:陀螺仪x、y、z轴的原始读数(带符号)
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_GetGyroscope(short *gx, short *gy, short *gz)
{
    unsigned char buf[6], res;  
	
	res = Mpu6050_ReadLen(MPU_ADDR, MPU_GYRO_XOUTH_REG, 6, buf);
	if(res == 0){
		*gx = ((unsigned short)buf[0]<<8) | buf[1];  
		*gy = ((unsigned short)buf[2]<<8) | buf[3];  
		*gz = ((unsigned short)buf[4]<<8) | buf[5];
	}
 	
    return res;
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_GetAccelerometer
* 功能说明 : 读取MPU6050加速度值(原始值)
* 形    参 : ax、ay、az:加速度计x、y、z轴的原始读数(带符号)
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_GetAccelerometer(short *ax,short *ay,short *az)
{
    unsigned char buf[6], res;  
	
	res = Mpu6050_ReadLen(MPU_ADDR,MPU_ACCEL_XOUTH_REG, 6, buf);
	if(res == 0){
		*ax = ((unsigned short)buf[0]<<8) | buf[1];  
		*ay = ((unsigned short)buf[2]<<8) | buf[3];  
		*az = ((unsigned short)buf[4]<<8) | buf[5];
	} 	
	
    return res;
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_WriteLen
* 功能说明 : IIC连续写
* 形    参 : addr:器件地址;reg:寄存器地址;len:写入长度;buf:数据区;
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_WriteLen(unsigned char addr, unsigned char reg, unsigned char len, unsigned char *buf)
{
	unsigned char i; 
	
    IIC_Start(); 
	IIC_WriteByte((addr<<1) | 0);	//发送器件地址+写命令	
	if(IIC_Wait_ACK()){				//等待应答
		IIC_Stop();		 
		return 1;		
	}
	
    IIC_WriteByte(reg);				//写寄存器地址
    IIC_Wait_ACK();					//等待应答
	for(i=0; i<len; i++){
		IIC_WriteByte(buf[i]);		//发送数据
		if(IIC_Wait_ACK()){			//等待ACK
			IIC_Stop();	 
			return 1;		 
		}		
	}    
    IIC_Stop();
	
	return 0;	
} 
/*********************************************************************************************************
* 函 数 名 : Mpu6050_ReadLen
* 功能说明 : IIC连续读
* 形    参 : addr:器件地址;reg:寄存器地址;len:写入长度;buf:数据区;
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_ReadLen(unsigned char addr, unsigned char reg, unsigned char len, unsigned char *buf)
{ 
 	IIC_Start(); 
	IIC_WriteByte((addr<<1) | 0);	//发送器件地址+写命令	
	if(IIC_Wait_ACK()){				//等待应答
		IIC_Stop();		 
		return 1;		
	}
	
    IIC_WriteByte(reg);				//写寄存器地址
    IIC_Wait_ACK();					//等待应答
    IIC_Start();
	IIC_WriteByte((addr<<1) | 1);	//发送器件地址+读命令	
    IIC_Wait_ACK();					//等待应答 
	while(len){
		if(len==1){
			*buf=IIC_ReadByte(1);	//读数据,发送nACK 
		}else{
			*buf=IIC_ReadByte(0);	//读数据,发送ACK  
		}
		len--;
		buf++; 
	}    
    IIC_Stop();						//产生一个停止条件 
	
	return 0;	
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_WriteByte
* 功能说明 : IIC写一个字节 
* 形    参 : reg:寄存器地址;data:写入的数据;
* 返 回 值 : 0:成功;其他:失败
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_WriteByte(unsigned char reg,unsigned char data) 				 
{ 
    IIC_Start(); 
	IIC_WriteByte((MPU_ADDR<<1) | 0);	//发送器件地址+写命令	
	if(IIC_Wait_ACK()){					//等待应答
		IIC_Stop();		 
		return 1;		
	}
	
    IIC_WriteByte(reg);					//写寄存器地址
    IIC_Wait_ACK();						//等待应答 
	IIC_WriteByte(data);				//发送数据
	if(IIC_Wait_ACK()){					//等待ACK
		IIC_Stop();	 
		return 1;		 
	}		 
    IIC_Stop();	
	
	return 0;
}
/*********************************************************************************************************
* 函 数 名 : Mpu6050_ReadByte
* 功能说明 : IIC读一个字节 
* 形    参 : reg:寄存器地址
* 返 回 值 : 读到的数据
* 备    注 : 无
*********************************************************************************************************/ 
unsigned char Mpu6050_ReadByte(unsigned char reg)
{
	unsigned char res;
	
    IIC_Start(); 
	IIC_WriteByte((MPU_ADDR<<1) | 0);	//发送器件地址+写命令	
	IIC_Wait_ACK();						//等待应答 
    IIC_WriteByte(reg);					//写寄存器地址
    IIC_Wait_ACK();						//等待应答
    IIC_Start();
	IIC_WriteByte((MPU_ADDR<<1) | 1);	//发送器件地址+读命令	
    IIC_Wait_ACK();						//等待应答 
	res=IIC_ReadByte(1);				//读取数据,发送nACK 
    IIC_Stop();							//产生一个停止条件 
	
	return res;		
}

mpu6050.h

#ifndef __MPU6050_H
#define __MPU6050_H

#include "iic.h"   												  	  

//#define MPU_ACCEL_OFFS_REG		0X06	//accel_offs寄存器,可读取版本号,寄存器手册未提到
//#define MPU_PROD_ID_REG			0X0C	//prod id寄存器,在寄存器手册未提到
#define MPU_SELF_TESTX_REG		0X0D	//自检寄存器X
#define MPU_SELF_TESTY_REG		0X0E	//自检寄存器Y
#define MPU_SELF_TESTZ_REG		0X0F	//自检寄存器Z
#define MPU_SELF_TESTA_REG		0X10	//自检寄存器A
#define MPU_SAMPLE_RATE_REG		0X19	//采样频率分频器
#define MPU_CFG_REG				0X1A	//配置寄存器
#define MPU_GYRO_CFG_REG		0X1B	//陀螺仪配置寄存器
#define MPU_ACCEL_CFG_REG		0X1C	//加速度计配置寄存器
#define MPU_MOTION_DET_REG		0X1F	//运动检测阀值设置寄存器
#define MPU_FIFO_EN_REG			0X23	//FIFO使能寄存器
#define MPU_I2CMST_CTRL_REG		0X24	//IIC主机控制寄存器
#define MPU_I2CSLV0_ADDR_REG	0X25	//IIC从机0器件地址寄存器
#define MPU_I2CSLV0_REG			0X26	//IIC从机0数据地址寄存器
#define MPU_I2CSLV0_CTRL_REG	0X27	//IIC从机0控制寄存器
#define MPU_I2CSLV1_ADDR_REG	0X28	//IIC从机1器件地址寄存器
#define MPU_I2CSLV1_REG			0X29	//IIC从机1数据地址寄存器
#define MPU_I2CSLV1_CTRL_REG	0X2A	//IIC从机1控制寄存器
#define MPU_I2CSLV2_ADDR_REG	0X2B	//IIC从机2器件地址寄存器
#define MPU_I2CSLV2_REG			0X2C	//IIC从机2数据地址寄存器
#define MPU_I2CSLV2_CTRL_REG	0X2D	//IIC从机2控制寄存器
#define MPU_I2CSLV3_ADDR_REG	0X2E	//IIC从机3器件地址寄存器
#define MPU_I2CSLV3_REG			0X2F	//IIC从机3数据地址寄存器
#define MPU_I2CSLV3_CTRL_REG	0X30	//IIC从机3控制寄存器
#define MPU_I2CSLV4_ADDR_REG	0X31	//IIC从机4器件地址寄存器
#define MPU_I2CSLV4_REG			0X32	//IIC从机4数据地址寄存器
#define MPU_I2CSLV4_DO_REG		0X33	//IIC从机4写数据寄存器
#define MPU_I2CSLV4_CTRL_REG	0X34	//IIC从机4控制寄存器
#define MPU_I2CSLV4_DI_REG		0X35	//IIC从机4读数据寄存器

#define MPU_I2CMST_STA_REG		0X36	//IIC主机状态寄存器
#define MPU_INTBP_CFG_REG		0X37	//中断/旁路设置寄存器
#define MPU_INT_EN_REG			0X38	//中断使能寄存器
#define MPU_INT_STA_REG			0X3A	//中断状态寄存器

#define MPU_ACCEL_XOUTH_REG		0X3B	//加速度值,X轴高8位寄存器
#define MPU_ACCEL_XOUTL_REG		0X3C	//加速度值,X轴低8位寄存器
#define MPU_ACCEL_YOUTH_REG		0X3D	//加速度值,Y轴高8位寄存器
#define MPU_ACCEL_YOUTL_REG		0X3E	//加速度值,Y轴低8位寄存器
#define MPU_ACCEL_ZOUTH_REG		0X3F	//加速度值,Z轴高8位寄存器
#define MPU_ACCEL_ZOUTL_REG		0X40	//加速度值,Z轴低8位寄存器

#define MPU_TEMP_OUTH_REG		0X41	//温度值高八位寄存器
#define MPU_TEMP_OUTL_REG		0X42	//温度值低8位寄存器

#define MPU_GYRO_XOUTH_REG		0X43	//陀螺仪值,X轴高8位寄存器
#define MPU_GYRO_XOUTL_REG		0X44	//陀螺仪值,X轴低8位寄存器
#define MPU_GYRO_YOUTH_REG		0X45	//陀螺仪值,Y轴高8位寄存器
#define MPU_GYRO_YOUTL_REG		0X46	//陀螺仪值,Y轴低8位寄存器
#define MPU_GYRO_ZOUTH_REG		0X47	//陀螺仪值,Z轴高8位寄存器
#define MPU_GYRO_ZOUTL_REG		0X48	//陀螺仪值,Z轴低8位寄存器

#define MPU_I2CSLV0_DO_REG		0X63	//IIC从机0数据寄存器
#define MPU_I2CSLV1_DO_REG		0X64	//IIC从机1数据寄存器
#define MPU_I2CSLV2_DO_REG		0X65	//IIC从机2数据寄存器
#define MPU_I2CSLV3_DO_REG		0X66	//IIC从机3数据寄存器

#define MPU_I2CMST_DELAY_REG	0X67	//IIC主机延时管理寄存器
#define MPU_SIGPATH_RST_REG		0X68	//信号通道复位寄存器
#define MPU_MDETECT_CTRL_REG	0X69	//运动检测控制寄存器
#define MPU_USER_CTRL_REG		0X6A	//用户控制寄存器
#define MPU_PWR_MGMT1_REG		0X6B	//电源管理寄存器1
#define MPU_PWR_MGMT2_REG		0X6C	//电源管理寄存器2 
#define MPU_FIFO_CNTH_REG		0X72	//FIFO计数寄存器高八位
#define MPU_FIFO_CNTL_REG		0X73	//FIFO计数寄存器低八位
#define MPU_FIFO_RW_REG			0X74	//FIFO读写寄存器
#define MPU_DEVICE_ID_REG		0X75	//器件ID寄存器
 
//如果AD0脚(9脚)接地,IIC地址为0X68(不包含最低位).
//如果接V3.3,则IIC地址为0X69(不包含最低位).
#define MPU_ADDR				0X68

unsigned char Mpu6050_Init(void); 								
unsigned char Mpu6050_WriteLen(unsigned char addr, unsigned char reg, unsigned char len, unsigned char *buf);	//IIC连续写
unsigned char Mpu6050_ReadLen(unsigned char addr, unsigned char reg, unsigned char len, unsigned char *buf); 	//IIC连续读 
unsigned char Mpu6050_WriteByte(unsigned char reg, unsigned char data);											//IIC写一个字节
unsigned char Mpu6050_ReadByte(unsigned char reg);																//IIC读一个字节

unsigned char Mpu6050_SetGyroFsr(unsigned char fsr);
unsigned char Mpu6050_SetAccelFsr(unsigned char fsr);
unsigned char Mpu6050_SetLPF(unsigned short lpf);
unsigned char Mpu6050_SetRate(unsigned short rate);
unsigned char Mpu6050_SetFifo(unsigned char sens);

short Mpu6050_GetTemperature(void);
unsigned char Mpu6050_GetGyroscope(short *gx, short *gy, short *gz);
unsigned char Mpu6050_GetAccelerometer(short *ax, short *ay, short *az);

void usart1_report_imu(short roll, short pitch, short yaw);

#endif




































  • 6
    点赞
  • 42
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值