赞
踩
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
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
Copyright © 2003-2013 www.wpsshop.cn 版权所有,并保留所有权利。