[STM32F1] 【转】STM32驱动MPU6050
MPU-60X0 是全球首例 9轴运动处理传感器。它集成了 3轴 MEMS陀螺仪， 3轴 MEMS
加速度计，以及一个可扩展的数字运动处理器 DMP（Digital Motion Processor），可用 I2C
接口连接一个第三方的数字传感器，比如磁力计。扩展之后就可以通过其 I2C或 SPI接口
输出一个 9 轴的信号（SPI接口仅在 MPU-6000可用）。 MPU-60X0也可以通过其 I2C接口
连接非惯性的数字传感器，比如压力传感器。
MPU-60X0 对陀螺仪和加速度计分别用了三个 16位的 ADC，将其测量的模拟量转化
为可输出的数字量。为了精确跟踪快速和慢速的运动，传感器的测量范围都是用户可控的，
陀螺仪可测范围为±250，±500，±1000，±2000°/秒（dps），加速度计可测范围为±2，±4，±8，±16g
对MPU6050的配置主要需要1.上电检测芯片序列号,自检 2.设定加速度陀螺仪的阈值和检测频率3.设定外部链接设备的驱动模式以及地址4.设定中断模式,比如要打开自由落体中断需要的设置,数据准备好中断需要的设置等5.设定电源管理模式,防止进入休眠6.循环读取数据
MPU输出一共三种数据,包括陀螺仪输出加速度传感器输出和温度输出,温度输出需要计算,计算方法是读出16位温度数据temp,然后temp/340.0 + 36.53
另外,中断引脚的模式也是可以配置的,详细的说明在MPU6050驱动的头文件中有,包含每一个寄存器的说明,请查看源码,如下
1. MPU6050.h
1 #ifndef __MPU6050_H_ 2 #define __MPU6050_H_ 3 4 #include "common.h" 5 #include "ioremap.h" 6 #include "stm32f10x.h" 7 #include "delay.h" 8 #include "uart.h" 9 10 #define MPU_ACK_WAIT_TIME 200 //us 11 12 #define MPU6050_ADDRESS_AD0_LOW 0xD0 // AD0为低的时候设备的写地址 13 #define MPU6050_ADDRESS_AD0_HIGH 0XD1 // AD0为高的时候设备的写地址 14 #define MPU_ADDR 0xD0 //IIC写入时的地址字节数据 15 16 17 #define MPU_DEBUG 1 18 19 //技术文档未公布的寄存器 主要用于官方DMP操作 20 #define MPU6050_RA_XG_OFFS_TC 0x00 //[bit7] PWR_MODE, [6:1] XG_OFFS_TC, [bit 0] OTP_BNK_VLD 21 #define MPU6050_RA_YG_OFFS_TC 0x01 //[7] PWR_MODE, [6:1] YG_OFFS_TC, [0] OTP_BNK_VLD 22 //bit7的定义,当设置为1,辅助I2C总线高电平是VDD。当设置为0,辅助I2C总线高电平是VLOGIC 23 24 #define MPU6050_RA_ZG_OFFS_TC 0x02 //[7] PWR_MODE, [6:1] ZG_OFFS_TC, [0] OTP_BNK_VLD 25 #define MPU6050_RA_X_FINE_GAIN 0x03 //[7:0] X_FINE_GAIN 26 #define MPU6050_RA_Y_FINE_GAIN 0x04 //[7:0] Y_FINE_GAIN 27 #define MPU6050_RA_Z_FINE_GAIN 0x05 //[7:0] Z_FINE_GAIN 28 29 #define MPU6050_RA_XA_OFFS_H 0x06 //[15:0] XA_OFFS 两个寄存器合在一起 30 #define MPU6050_RA_XA_OFFS_L_TC 0x07 31 32 #define MPU6050_RA_YA_OFFS_H 0x08 //[15:0] YA_OFFS 两个寄存器合在一起 33 #define MPU6050_RA_YA_OFFS_L_TC 0x09 34 35 #define MPU6050_RA_ZA_OFFS_H 0x0A //[15:0] ZA_OFFS 两个寄存器合在一起 36 #define MPU6050_RA_ZA_OFFS_L_TC 0x0B 37 38 #define MPU6050_RA_XG_OFFS_USRH 0x13 //[15:0] XG_OFFS_USR 两个寄存器合在一起 39 #define MPU6050_RA_XG_OFFS_USRL 0x14 40 41 #define MPU6050_RA_YG_OFFS_USRH 0x15 //[15:0] YG_OFFS_USR 两个寄存器合在一起 42 #define MPU6050_RA_YG_OFFS_USRL 0x16 43 44 #define MPU6050_RA_ZG_OFFS_USRH 0x17 //[15:0] ZG_OFFS_USR 两个寄存器合在一起 45 #define MPU6050_RA_ZG_OFFS_USRL 0x18 46 47 /*陀螺仪的采样频率*/ 48 /*传感器的寄存器输出,FIFO输出,DMP采样、运动检测、 49 *零运动检测和自由落体检测都是基于采样率。 50 *通过SMPLRT_DIV把陀螺仪输出率分频即可得到采样率 51 *采样率=陀螺仪输出率/ (1 + SMPLRT_DIV) 52 *禁用DLPF的情况下(DLPF_CFG = 0或7) ，陀螺仪输出率= 8 khz 53 *在启用DLPF(见寄存器26)时，陀螺仪输出率= 1 khz 54 *加速度传感器输出率是1 khz。这意味着,采样率大于1 khz时, 55 *同一个加速度传感器的样品可能会多次输入到FIFO、DMP和传感器寄存器*/ 56 #define MPU6050_RA_SMPLRT_DIV 0x19 //[0-7] 陀螺仪输出分频采样率 57 58 /*配置外部引脚采样和DLPF数字低通滤波器*/ 59 #define MPU6050_RA_CONFIG 0x1A 60 //bit5-bit3 一个连接到FSYNC端口的外部信号可以通过配置EXT_SYNC_SET来采样 61 // 也就是说,这里设置之后,FSYNC的电平0或1进入最终数据寄存器,具体如下 62 // 0 不使用 1 FSYNC电平进入所有数据寄存器 2 FSYNC电平进入GYRO_XOUT_L 3 FSYNC电平进入GYRO_YOUT_L 63 // 4 FSYNC电平进入GYRO_ZOUT_L 5 FSYNC电平进入ACCEL_XOUT_L 6 FSYNC电平进入ACCEL_YOUT_L 64 // 7 FSYNC电平进入SYNC_ACCEL_ZOUT_L 65 //bit2-bit0 数字低通滤波器 用于滤除高频干扰 高于这个频率的干扰被滤除掉 66 /*对应关系如下 67 * * | 加速度传感器 | 陀螺仪 68 * * DLPF_CFG | 带宽 | 延迟 | 带宽 | 延迟 | 采样率 69 * -------------+--------+-------+--------+------+------------- 70 * 0 | 260Hz | 0ms | 256Hz | 0.98ms | 8kHz 71 * 1 | 184Hz | 2.0ms | 188Hz | 1.9ms | 1kHz 72 * 2 | 94Hz | 3.0ms | 98Hz | 2.8ms | 1kHz 73 * 3 | 44Hz | 4.9ms | 42Hz | 4.8ms | 1kHz 74 * 4 | 21Hz | 8.5ms | 20Hz | 8.3ms | 1kHz 75 * 5 | 10Hz | 13.8ms | 10Hz | 13.4ms | 1kHz 76 * 6 | 5Hz | 19.0ms | 5Hz | 18.6ms | 1kHz 77 * 7 | Reserved | Reserved | Reserved 78 * */ 79
1 /*陀螺仪的配置,主要是配置陀螺仪的量程与自检(通过相应的位7 6 5 开启自检)*/ 2 #define MPU6050_RA_GYRO_CONFIG 0x1B 3 //bit4-bit3 量程设置如下 4 // 0 = +/- 250 度/秒 5 // 1 = +/- 500 度/秒 6 // 2 = +/- 1000 度/秒 7 // 3 = +/- 2000 度/秒*/ 8 9 /*加速度计的配置,主要是配置加速度计的量程与自检(通过相应的位7 6 5 开启自检) 10 *另外,还能配置系统的高通滤波器*/ 11 #define MPU6050_RA_ACCEL_CONFIG 0x1C 12 //bit7 启动X自检 加速度计的自检 13 //bit6 启动Y自检 14 //bit5 启动Z自检 15 //bit4-bit3 加速度传感器的量程配置 16 // 0 = +/- 2g 17 // 1 = +/- 4g 18 // 2 = +/- 8g 19 // 3 = +/- 16g*/ 20 //bit0到bit2 加速度传感器的高通滤波器 21 /*DHPF是在路径中连接于运动探测器(自由落体,运动阈值,零运动)的一个滤波器模块。 22 *高通滤波器的输出值不在数据寄存器中 23 *高通滤波器有三种模式： 24 *重置:在一个样本中将滤波器输出值设为零。这有效的禁用了高通滤波器。这种模式可以快速切换滤波器的设置模式。 25 *开启:高通滤波器能通过高于截止频率的信号 26 *持续:触发后,过滤器持续当前采样。过滤器输出值是输入样本和持续样本之间的差异 27 *设置值如下所示 28 * ACCEL_HPF | 高通滤波模式| 截止频率 29 * ----------+-------------+------------------ 30 * 0 | Reset | None 31 * 1 | On | 5Hz 32 * 2 | On | 2.5Hz 33 * 3 | On | 1.25Hz 34 * 4 | On | 0.63Hz 35 * 7 | Hold | None 36 */ 37 38 #define MPU6050_RA_FF_THR 0x1D 39 /*自由落体加速度的阈值 40 *这个寄存器为自由落体的阈值检测进行配置。 41 *FF_THR的单位是1LSB = 2mg。当加速度传感器测量而得的三个轴的绝对值 42 *都小于检测阈值时，就可以测得自由落体值。这种情况下，(加速度计每次检测到就+1以下,所以还要依靠加速度采样率) 43 *自由落体时间计数器计数一次 (寄存器30)。当自由落体时间计数器达到 44 *FF_DUR中规定的时间时，自由落体被中断(或发生自由落体中断) 45 **/ 46 47 #define MPU6050_RA_FF_DUR 0x1E 48 /* 49 *自由落体加速度的时间阈值 50 * 这个寄存器为自由落体时间阈值计数器进行配置。 51 * 时间计数频率为1 khz,因此FF_DUR的单位是 1 LSB = 1毫秒。 52 * 当加速度器测量而得的绝对值都小于检测阈值时， 53 * 自由落体时间计数器计数一次。当自由落体时间计数器 54 * 达到该寄存器的规定时间时，自由落体被中断。 55 * (或发生自由落体中断) 56 * */ 57 58 #define MPU6050_RA_MOT_THR 0x1F 59 /* 60 *运动检测的加速度阈值 61 *这个寄存器为运动中断的阈值检测进行配置。 62 *MOT_THR的单位是 1LSB = 2mg。 63 *当加速度器测量而得的绝对值都超过该运动检测的阈值时， 64 *即可测得该运动。这一情况下，运动时间检测计数器计数一次。 65 *当运动检测计数器达到MOT_DUR的规定时间时，运动检测被中断。 66 * 运动中断表明了被检测的运动MOT_DETECT_STATUS (Register 97)的轴和极性。 67 */ 68 69 #define MPU6050_RA_MOT_DUR 0x20 70 /* 71 *运动检测时间的阈值。 72 *这个寄存器为运动中断的阈值检测进行配置。 73 *时间计数器计数频率为1 kHz ，因此MOT_THR的单位是 1LSB = 1ms。 74 *当加速度器测量而得的绝对值都超过该运动检测的阈值时(Register 31)， 75 *运动检测时间计数器计数一次。当运动检测计数器达到该寄存器规定的时间时， 76 *运动检测被中断。 77 **/ 78 79 #define MPU6050_RA_ZRMOT_THR 0x21 80 /* 81 *零运动检测加速度阈值。 82 * 这个寄存器为零运动中断检测进行配置。 83 * ZRMOT_THR的单位是1LSB = 2mg。 84 * 当加速度器测量而得的三个轴的绝对值都小于检测阈值时， 85 * 就可以测得零运动。这种情况下，零运动时间计数器计数一次 (寄存器34)。 86 * 当自零运动时间计数器达到ZRMOT_DUR (Register 34)中规定的时间时，零运动被中断。 87 * 与自由落体或运动检测不同的是，当零运动首次检测到以及当零运动检测不到时，零运动检测都被中断。 88 * 当零运动被检测到时,其状态将在MOT_DETECT_STATUS寄存器(寄存器97) 中显示出来。 89 * 当运动状态变为零运动状态被检测到时,状态位设置为1。当零运动状态变为运动状态被检测到时, 90 * 状态位设置为0。 91 **/ 92 93 #define MPU6050_RA_ZRMOT_DUR 0x22 94 /* 95 *零运动检测的时间阈值 96 * 这个寄存器为零运动中断检测进行时间计数器的配置。 97 * 时间计数器的计数频率为16 Hz,因此ZRMOT_DUR的单位是1 LSB = 64 ms。 98 * 当加速度器测量而得的绝对值都小于检测器的阈值(Register 33)时， 99 * 运动检测时间计数器计数一次。当零运动检测计数器达到该寄存器规定的时间时， 100 * 零运动检测被中断。 101 **/
1 2 /* 3 *设备的各种FIFO使能,包括温度 加速度 陀螺仪 从机 4 *将相关的数据写入FIFO缓冲中 5 **/ 6 #define MPU6050_RA_FIFO_EN 0x23 7 //bit7 温度fifo使能 8 //bit6 陀螺仪Xfifo使能 9 //bit5 陀螺仪Yfifo使能 10 //bit4 陀螺仪Zfifo使能 11 //bit3 加速度传感器fifo使能 12 //bit2 外部从设备2fifo使能 13 //bit1 外部从设备1fifo使能 14 //bit0 外部从设备0fifo使能 15 16 #define MPU6050_RA_I2C_MST_CTRL 0x24 17 //配置单主机或者多主机下的IIC总线 18 //bit7 监视从设备总线,看总线是否可用 MULT_MST_EN设置为1时,MPU-60X0的总线仲裁检测逻辑被打开 19 //bit6 延迟数据就绪中断,直达从设备数据也进入主机再触发 相当于数据同步等待 20 //bit5 当设置为1时,与Slave3 相连的外部传感器数据(寄存器73 到寄存器 96)写入FIFO缓冲中,每次都写入 21 //bit4 主机读取一个从机到下一个从机读取之间的动作 为0 读取之间有一个restart,为1 下一次读取前会有一个重启,然后 22 // 一直读取直到切换写入或者切换设备 23 //bit3-bit0 配置MPU作为IIC主机时的时钟,基于MPU内部8M的分频 24 /* I2C_MST_CLK | I2C 主时钟速度 | 8MHz 时钟分频器 25 * ------------+------------------------+------------------- 26 * 0 | 348kHz | 23 27 * 1 | 333kHz | 24 28 * 2 | 320kHz | 25 29 * 3 | 308kHz | 26 30 * 4 | 296kHz | 27 31 * 5 | 286kHz | 28 32 * 6 | 276kHz | 29 33 * 7 | 267kHz | 30 34 * 8 | 258kHz | 31 35 * 9 | 500kHz | 16 36 * 10 | 471kHz | 17 37 * 11 | 444kHz | 18 38 * 12 | 421kHz | 19 39 * 13 | 400kHz | 20 40 * 14 | 381kHz | 21 41 * 15 | 364kHz | 22 42 * */ 43 44 45 46 /**************************MPU链接IIC从设备控制寄存器,没使用从机连接的基本不用考虑这些************************************/ 47 /*指定slave (0-3)的I2C地址 48 * 注意Bit 7 (MSB)控制了读/写模式。如果设置了Bit 7,那么这是一个读取操作, 49 * 如果将其清除,那么这是一个编写操作。其余位(6-0)是slave设备的7-bit设备地址。 50 * 在读取模式中,读取结果是存储于最低可用的EXT_SENS_DATA寄存器中。 51 * MPU-6050支持全5个slave，但Slave 4有其特殊功能(getSlave4* 和setSlave4*)。 52 * 如寄存器25中所述，I2C数据转换通过采样率体现。用户负责确保I2C数据转换能够 53 * 在一个采样率周期内完成。 54 * I2C slave数据传输速率可根据采样率来减小。 55 * 减小的传输速率是由I2C_MST_DLY(寄存器52)所决定的。 56 * slave数据传输速率是否根据采样率来减小是由I2C_MST_DELAY_CTRL (寄存器103)所决定的。 57 * slave的处理指令是固定的。Slave的处理顺序是Slave 1, Slave 2, Slave 3 和 Slave 4。 58 * 如果某一个Slave被禁用了，那么它会被自动忽略。 59 * 每个slave可按采样率或降低的采样率来读取。在有些slave以采样率读取有些以减小 60 * 的采样率读取的情况下，slave的读取顺序依旧不变。然而， 61 * 如果一些slave的读取速率不能在特定循环中进行读取，那么它们会被自动忽略 62 * 更多降低的读取速率相关信息,请参阅寄存器52。 63 * Slave是否按采样率或降低的采样率来读取由寄存器103得Delay Enable位来决定 64 **/ 65 66 //从机0设置相关 67 #define MPU6050_RA_I2C_SLV0_ADDR 0x25 68 //bit7 当前IIC 从设备0的操作,1为读取 0写入 69 //bit6-bit0 从机设备的地址 70 /* 要读取或者要写入的设备内部的寄存器地址,不管读取还是写入*/ 71 #define MPU6050_RA_I2C_SLV0_REG 0x26 72 /*iic从机系统配置寄存器*/ 73 #define MPU6050_RA_I2C_SLV0_CTRL 0x27 74 //bit7 启动或者禁止这个设备的IIC数据传送过程 75 //bit6 当设置为1时,字节交换启用。当启用字节交换时,词对的高低字节即可交换 76 //bit5 当 I2C_SLV0_REG_DIS 置 1，只能进行读取或者写入数据。当该位清 0，可以再读取 77 // 或写入数据之前写入一个寄存器地址。当指定从机设备内部的寄存器地址进行发送或接收 78 // 数据时，该位必须等于 0 79 //bit4 指定从寄存器收到的字符对的分组顺序。当该位清 0，寄存器地址 80 // 0和 1, 2 和 3 的字节是分别成对（甚至，奇数寄存器地址 ） ，作为一个字符对。当该位置 1， 81 // 寄存器地址 1 和 2， 3 和 4 的字节是分别成对的，作为一个字符对 82 //bit3-bit0 指定从机 0 发送字符的长度。由Slave 0转换而来和转换至Slave 0的字节数,(IIC一次传输的长度) 83 // 该位清 0，I2C_SLV0_EN 位自动置 0. 84 85 /*IIC SLAVE1配置寄存器,与0相同*/ 86 87 #define MPU6050_RA_I2C_SLV1_ADDR 0x28 88 #define MPU6050_RA_I2C_SLV1_REG 0x29 89 #define MPU6050_RA_I2C_SLV1_CTRL 0x2A 90 91 /*IIC SLAVE2配置寄存器,与0相同*/ 92 #define MPU6050_RA_I2C_SLV2_ADDR 0x2B 93 #define MPU6050_RA_I2C_SLV2_REG 0x2C 94 #define MPU6050_RA_I2C_SLV2_CTRL 0x2D 95 96 /*IIC SLAVE3配置寄存器,与0相同*/ 97 #define MPU6050_RA_I2C_SLV3_ADDR 0x2E 98 #define MPU6050_RA_I2C_SLV3_REG 0x2F 99 #define MPU6050_RA_I2C_SLV3_CTRL 0x30 100 101 /*slave4的I2C地址 IIC4与前几个的寄存器定义有所不同*/ 102 #define MPU6050_RA_I2C_SLV4_ADDR 0x31 //与IIC SLAVE1类似 103 #define MPU6050_RA_I2C_SLV4_REG 0x32 /*slave4的当前内部寄存器*/ 104 #define MPU6050_RA_I2C_SLV4_DO 0x33 105 /*写于slave4的新字节这一寄存器可储存写于slave4的数据。 106 * 如果I2C_SLV4_RW设置为1（设置为读取模式），那么该寄存器无法执行操作*/ 107 #define MPU6050_RA_I2C_SLV4_CTRL 0x34 108 //当设置为1时，此位启用了slave4的转换操作。当设置为0时，则禁用该操作 109 #define MPU6050_I2C_SLV4_EN_BIT 7 110 //当设置为1时，此位启用了slave4事务完成的中断信号的生成。 111 // 当清除为0时，则禁用了该信号的生成。这一中断状态可在寄存器54中看到。 112 #define MPU6050_I2C_SLV4_INT_EN_BIT 6 113 //当设置为1时,只进行数据的读或写操作。当设置为0时, 114 // 在读写数据之前将编写一个寄存器地址。当指定寄存器地址在slave设备中时 115 // ，这应该等于0，而在该寄存器中会进行数据处理。 116 #define MPU6050_I2C_SLV4_REG_DIS_BIT 5 117 //采样率延迟,这为根据采样率减小的I2C slaves传输速率进行了配置。 118 // 当一个slave的传输速率是根据采样率而降低的,那么该slave是以每1 / (1 + I2C_MST_DLY) 个样本进行传输。 119 // 这一基本的采样率也是由SMPLRT_DIV (寄存器 25)和DLPF_CFG (寄存器26)所决定的的。 120 // slave传输速率是否根据采样率来减小是由I2C_MST_DELAY_CTRL (寄存器103)所决定的 121 #define MPU6050_I2C_SLV4_MST_DLY_BIT 4 //[4:0] 122 #define MPU6050_I2C_SLV4_MST_DLY_LENGTH 5 123 /*slave4中可读取的最后可用字节*/ 124 #define MPU6050_RA_I2C_SLV4_DI 0x35 125 126 /* 127 * IIC辅助从机系统中断状态 128 **/ 129 #define MPU6050_RA_I2C_MST_STATUS 0x36 130 //bit7 此位反映了一个与MPU-60X0相连的外部设备的FSYNC中断状态。 131 // 当设置为1且在INT_PIN_CFG(寄存器55)中断言FSYNC_INT_EN时，中断产生。 132 //bit6 当slave4事务完成时，设备会自动设置为1 如果定义了INT_ENABLE中的I2C_MST_INT_EN则产生中断 133 //bit5 I2C主机失去辅助I2C总线（一个错误状态）的仲裁，此位自动设置为1.如果断言了INT_ENABLE寄存器 134 // （寄存器56）中的I2C_MST_INT_EN位，则中断产生 135 //bit4 slave4的NACK状态 136 //bit3 slave3的NACK状态 137 //bit2 slave2的NACK状态 138 //bit1 slave1的NACK状态 139 //bit0 slave0的NACK状态 140 141 142 /*中断引脚配置寄存器*/ 143 #define MPU6050_RA_INT_PIN_CFG 0x37 144 //bit7 中断的逻辑电平模式,高电平时，设置为0；低电平时，设置为1 145 //bit6 中断驱动模式,推拉模式设置为0，开漏模式设置为1. 146 //bit5 中断锁存模式.50us-pulse模式设置为0，latch-until-int-cleared模式设置为1 147 //bit4 中断锁存清除模式 status-read-only状态设置为0，any-register-read状态设置为1. 148 //bit3 FSYNC中断逻辑电平模式 0=active-high, 1=active-low 149 //bit2 FSYNC端口中断启用设置设置为0时禁用，设置为1时启用 150 //bit1 I2C支路启用状态,此位等于1且I2C_MST_EN (寄存器 106 位[5])等于0时,主机应用程序处理器能够直接访问MPU-60X0的辅助I2C总线 151 // 否则无论如何都不能直接访问 152 //bit0 当此位为1时，CLKOUT端口可以输出参考时钟。当此位为0时，输出禁用 153 154 155 /*部分中断使能*/ 156 #define MPU6050_RA_INT_ENABLE 0x38 157 //bit7 自由落体中断使能 158 //bit6 运动检测中断使能 159 //bit5 零运动检测中断使能 160 //bit4 FIFO溢出中断使能 161 //bit3 IIC主机所有中断源使能 162 //bit0 数据就绪中断使能 163
1 /*DMP中断配置*/ 2 #define MPU6050_RA_INT_STATUS 0x3A 3 //DMP中断位之一使能 4 #define MPU6050_INTERRUPT_PLL_RDY_INT_BIT 2 5 //DMP中断位之二使能 6 #define MPU6050_INTERRUPT_DMP_INT_BIT 1 7 8 /*加速度X输出*/ 9 #define MPU6050_RA_ACCEL_XOUT_H 0x3B 10 #define MPU6050_RA_ACCEL_XOUT_L 0x3C 11 12 /*加速度Y输出*/ 13 #define MPU6050_RA_ACCEL_YOUT_H 0x3D 14 #define MPU6050_RA_ACCEL_YOUT_L 0x3E 15 16 /*加速度Z输出*/ 17 #define MPU6050_RA_ACCEL_ZOUT_H 0x3F 18 #define MPU6050_RA_ACCEL_ZOUT_L 0x40 19 20 /*温度值输出*/ 21 #define MPU6050_RA_TEMP_OUT_H 0x41 22 #define MPU6050_RA_TEMP_OUT_L 0x42 23 24 /*陀螺仪X输出*/ 25 #define MPU6050_RA_GYRO_XOUT_H 0x43 26 #define MPU6050_RA_GYRO_XOUT_L 0x44 27 28 /*陀螺仪Y输出*/ 29 #define MPU6050_RA_GYRO_YOUT_H 0x45 30 #define MPU6050_RA_GYRO_YOUT_L 0x46 31 32 /*陀螺仪Z输出*/ 33 #define MPU6050_RA_GYRO_ZOUT_H 0x47 34 #define MPU6050_RA_GYRO_ZOUT_L 0x48 35 36 /*从IIC从机上获取到的数据*/ 37 #define MPU6050_RA_EXT_SENS_DATA_00 0x49 38 #define MPU6050_RA_EXT_SENS_DATA_01 0x4A 39 #define MPU6050_RA_EXT_SENS_DATA_02 0x4B 40 #define MPU6050_RA_EXT_SENS_DATA_03 0x4C 41 #define MPU6050_RA_EXT_SENS_DATA_04 0x4D 42 #define MPU6050_RA_EXT_SENS_DATA_05 0x4E 43 #define MPU6050_RA_EXT_SENS_DATA_06 0x4F 44 #define MPU6050_RA_EXT_SENS_DATA_07 0x50 45 #define MPU6050_RA_EXT_SENS_DATA_08 0x51 46 #define MPU6050_RA_EXT_SENS_DATA_09 0x52 47 #define MPU6050_RA_EXT_SENS_DATA_10 0x53 48 #define MPU6050_RA_EXT_SENS_DATA_11 0x54 49 #define MPU6050_RA_EXT_SENS_DATA_12 0x55 50 #define MPU6050_RA_EXT_SENS_DATA_13 0x56 51 #define MPU6050_RA_EXT_SENS_DATA_14 0x57 52 #define MPU6050_RA_EXT_SENS_DATA_15 0x58 53 #define MPU6050_RA_EXT_SENS_DATA_16 0x59 54 #define MPU6050_RA_EXT_SENS_DATA_17 0x5A 55 #define MPU6050_RA_EXT_SENS_DATA_18 0x5B 56 #define MPU6050_RA_EXT_SENS_DATA_19 0x5C 57 #define MPU6050_RA_EXT_SENS_DATA_20 0x5D 58 #define MPU6050_RA_EXT_SENS_DATA_21 0x5E 59 #define MPU6050_RA_EXT_SENS_DATA_22 0x5F 60 #define MPU6050_RA_EXT_SENS_DATA_23 0x60 61 62 //运动检测的状态 63 #define MPU6050_RA_MOT_DETECT_STATUS 0x61 64 //bit7 x轴反向运动检测中断状态 65 //bit6 x轴正向运动检测中断状态 66 //bit5 Y轴反向运动检测中断状态 67 //bit4 Y轴正向运动检测中断状态 68 //bit3 Z轴反向运动检测中断状态 69 //bit2 Z轴正向运动检测中断状态 70 //bit1 71 //bit0 零运动检测中断状态 72 // 73 74 75 /*写入到IIC从机中的数据,指定的slv数据输出容器*/ 76 #define MPU6050_RA_I2C_SLV0_DO 0x63 77 #define MPU6050_RA_I2C_SLV1_DO 0x64 78 #define MPU6050_RA_I2C_SLV2_DO 0x65 79 #define MPU6050_RA_I2C_SLV3_DO 0x66 80 81 /*外部影子寄存器的配置,这个寄存器用于指定外部传感器数据影子的时间 82 *当启用了某一特定的slave，其传输速率就会减小。 83 *当一个slave的传输速率是根据采样率而降低的,那么该slave是以 84 *每1 / (1 + I2C_MST_DLY) 个样本进行传输。 85 * 1 / (1 + I2C_MST_DLY) Samples 86 * 这一基本的采样率也是由SMPLRT_DIV (寄存器 25)和DLPF_CFG (寄存器26)所决定的的。*/ 87 #define MPU6050_RA_I2C_MST_DELAY_CTRL 0x67 88 //DELAY_ES_SHADOW设置为1,跟随外部传感器数据影子将会延迟到所有的数据接收完毕。 89 #define MPU6050_DELAYCTRL_DELAY_ES_SHADOW_BIT 7 90 //slv4-0的配置 91 #define MPU6050_DELAYCTRL_I2C_SLV4_DLY_EN_BIT 4 92 #define MPU6050_DELAYCTRL_I2C_SLV3_DLY_EN_BIT 3 93 #define MPU6050_DELAYCTRL_I2C_SLV2_DLY_EN_BIT 2 94 #define MPU6050_DELAYCTRL_I2C_SLV1_DLY_EN_BIT 1 95 #define MPU6050_DELAYCTRL_I2C_SLV0_DLY_EN_BIT 0 96 97 /*用于陀螺仪，加速度计，温度传感器的模拟和数字信号通道的复位。 98 复位会还原模数转换信号通道和清除他们的上电配置*/ 99 #define MPU6050_RA_SIGNAL_PATH_RESET 0x68 100 //bit2 重置陀螺仪的信号路径 101 //bit1 重置加速度传感器的信号路径 102 //bit0 重置温度传感器的信号路径 103 104 105 /*获取加速度传感器启动延迟 还有滤波器的一些配置 106 * 加速度传感器数据路径为传感器寄存器、运动检测、 107 * 零运动检测和自由落体检测模块提供样本。在检测模块开始操作之前， 108 * 包含过滤器的信号路径必须用新样本来启用。 109 * 默认的4毫秒唤醒延迟时间可以加长3毫秒以上。在ACCEL_ON_DELAY中规定 110 * 这个延迟以1 LSB = 1 毫秒为单位。除非InvenSense另行指示， 111 * 用户可以选择任何大于零的值。*/ 112 #define MPU6050_RA_MOT_DETECT_CTRL 0x69 113 //具体的有效控制位 114 //bit5-bit4 [5:4]1-4ms 延时时间1-4ms选择 115 //bit3-bit2 自由落体检测计数器的减量配置。 116 // 当指定数量的样本的加速度测量都满足其各自的阈值条件时， 117 // 检测结果存储于自由落体检测模块中。当满足阈值条件时， 118 // 相应的检测计数器递增1。用户可通过FF_COUNT配置不满足阈值条件来减量。 119 // 减量率可根据下表进行设置： 120 /* FF_COUNT | 计数器减量 121 * ---------+------------------ 122 * 0 | 重置 123 * 1 | 1 124 * 2 | 2 125 * 3 | 4 126 * 当FF_COUNT配置为0(复位)时,任何不合格的样品都将计数器重置为0*/ 127 //bit1-bit0 运动检测计数器的减量配置。 128 // 当指定数量的样本的加速度测量都满足其各自的阈值条件时， 129 // 检测结果存储于运动检测模块中。当满足阈值条件时，相应的检测计数器递增1。 130 // 用户可通过MOT_COUNT配置不满足阈值条件来减量。减量率可根据下表进行设置： 131 // MOT_COUNT | 计数器减量 132 /* ----------+------------------ 133 * 0 | 重置 134 * 1 | 1 135 * 2 | 2 136 * 3 | 4 137 * 当MOT_COUNT配置为0(复位)时,任何不合格的样品都将计数器重置为0*/ 138 139 140 /*这个寄存器允许用户使能或使能 FIFO 缓冲区， 141 *I2C 主机模式和主要 I2C 接口。FIFO 缓冲 142 区，I2C 主机，传感器信号通道和传感器寄存器也可以使用这个寄存器复位*/ 143 #define MPU6050_RA_USER_CTRL 0x6A 144 //bit7 DMP禁止 145 //bit6 当此位设置为0,FIFO缓冲是禁用的 146 //bit5 当这个模式被启用,MPU-60X0即成为辅助I2C总线上的外部传感器slave设备的I2C主机 147 // 当此位被清除为0时,辅助I2C总线线路(AUX_DA and AUX_CL)理论上是由I2C总线 148 // (SDA和SCL)驱动的。这是启用旁路模式的一个前提 149 //bit4 I2C转换至SPI模式(只允许MPU-6000) 150 //bit3 重置DMP模式,官方文档未说明的寄存器 151 //bit2 重置FIFO当设置为1时，此位将重置FIFO缓冲区，此时FIFO_EN等于0。触发重置后，此位将自动清为0 152 //bit1 重置I2C主机当设置为1时，此位将重置I2C主机，此时I2C_MST_EN等于0。触发重置后，此位将自动清为0 153 //bit0 重置所有传感器寄存器和信号路径 如果只重置信号路径（不重置传感器寄存器），请使用寄存器104 154 155 156 /*允许用户配置电源模式和时钟源。还提供了复位整个设备和禁用温度传感器的位*/ 157 #define MPU6050_RA_PWR_MGMT_1 0x6B 158 //bit7 触发一个设备的完整重置。 触发重置后，一个~ 50 毫秒的小延迟是合理的 159 //bit6 寄存器的SLEEP位设置使设备处于非常低功率的休眠模式。 160 //bit5 唤醒周期启用状态当此位设为1且SLEEP禁用时.在休眠模式和唤醒模式间循环，以此从活跃的传感器中获取数据样本 161 //bit3 温度传感器启用状态控制内部温度传感器的使用 162 //bit2-bit0 设定时钟源设置,一个频率为8 mhz的内部振荡器,基于陀螺仪的时钟或外部信息源都可以被选为MPU-60X0的时钟源 163 /* CLK_SEL | 时钟源 164 * --------+-------------------------------------- 165 * 0 | 内部振荡器 166 * 1 | PLL with X Gyro reference 167 * 2 | PLL with Y Gyro reference 168 * 3 | PLL with Z Gyro reference 169 * 4 | PLL with external 32.768kHz reference 170 * 5 | PLL with external 19.2MHz reference 171 * 6 | Reserved 172 * 7 | Stops the clock and keeps the timing generator in reset 173 * */ 174
1 /*这个寄存器允许用户配置加速度计在低功耗模式下唤起的频率。也允许用户让加速度计和 2 陀螺仪的个别轴进入待机模式。*/ 3 #define MPU6050_RA_PWR_MGMT_2 0x6C 4 //bit7-bit6 Accel-Only低电量模式下的唤醒频率 5 /* 通过把Power Management 1寄存器（寄存器107）中的PWRSEL设为1， 6 * MPU-60X0可以处于Accerlerometer Only的低电量模式。在这种模式下, 7 设备将关闭除了原I2C接口以外的所有设备，只留下accelerometer以固定时间 8 间隔醒来进行测量。唤醒频率可用LP_WAKE_CTRL进行配置，如下表所示： 9 * LP_WAKE_CTRL | 唤醒频率 10 * -------------+------------------ 11 * 0 | 1.25 Hz 12 * 1 | 2.5 Hz 13 * 2 | 5 Hz 14 * 3 | 10 Hz 15 * */ 16 //bit5 备用的x轴加速度传感器启用状态,也就是进入待机模式 17 //bit4 备用的Y轴加速度传感器启用状态 18 //bit3 备用的Z轴加速度传感器启用状态 19 //bit2 备用的x轴陀螺仪启用状态 20 //bit1 备用的Y轴陀螺仪启用状态 21 //bit0 备用的Z轴陀螺仪启用状态 22 23 /*设定DMP模式下的bank*/ 24 #define MPU6050_RA_BANK_SEL 0x6D 25 //DMP内存配置 26 #define MPU6050_BANKSEL_PRFTCH_EN_BIT 6 27 #define MPU6050_BANKSEL_CFG_USER_BANK_BIT 5 28 #define MPU6050_BANKSEL_MEM_SEL_BIT 4 29 #define MPU6050_BANKSEL_MEM_SEL_LENGTH 5 30 //dmp内存地址设置 31 #define MPU6050_DMP_MEMORY_BANKS 8 32 #define MPU6050_DMP_MEMORY_BANK_SIZE 256 33 #define MPU6050_DMP_MEMORY_CHUNK_SIZE 16 34 35 /*设定DMP模式下的起始地址*/ 36 #define MPU6050_RA_MEM_START_ADDR 0x6E 37 /*一个字节的dmp数据缓存*/ 38 #define MPU6050_RA_MEM_R_W 0x6F 39 /*DMP配置寄存器1*/ 40 #define MPU6050_RA_DMP_CFG_1 0x70 41 /*DMP配置寄存器2*/ 42 #define MPU6050_RA_DMP_CFG_2 0x71 43 44 /*当前FIFO缓冲区大小 45 * 这个值表明了存储于FIFO缓冲区的字节数。 46 * 而这个数字也是能从FIFO缓冲区读取的字节数， 47 * 它与存储在FIFO(寄存器35和36)中的传感器数据组所提供的可用样本数成正比。 48 * 两个寄存器一起构成一个16位数据*/ 49 #define MPU6050_RA_FIFO_COUNTH 0x72 50 #define MPU6050_RA_FIFO_COUNTL 0x73 51 52 /*这个寄存器用于从FIFO缓冲区中读取和编写数据。数据在寄存器编号(从低到高)的指 53 *令下编写入数据写入FIFO。如果所有的FIFO启用标志(见下文)都被启用了且 54 *所有外部传感器数据寄存器(寄存器73至寄存器96)都与一个slave设备相连 55 *,那么寄存器59到寄存器96的内容都将在采样率的指令下编写。 56 * 当传感器数据寄存器（寄存器59到寄存器96）的相关FIFO启用标志在FIFO_EN 寄存 57 * 器35)中都设为1时，它们的内容将被写入FIFO缓冲区。在I2C_MST_CTRL (寄存器 36) 58 * 中能找到一个与I2C Slave 3相连的额外的传感器数据寄存器标志。 59 * 如果FIFO缓冲区溢出,状态位FIFO_OFLOW_INT自动设置为1。 60 * 此位位于INT_STATUS (寄存器58)中。当FIFO缓冲区溢出时,最早的数据将会丢失 61 * 而新数据将被写入FIFO。如果FIFO缓冲区为空, 读取将返回原来从FIFO中读取的 62 * 最后一个字节，直到有可用的新数据。用户应检查FIFO_COUNT,以确保不在FIFO缓冲为空时读取。*/ 63 #define MPU6050_RA_FIFO_R_W 0x74 64 65 /*寄存器是用来验证设备的身份的 默认值是0X34*/ 66 #define MPU6050_RA_WHO_AM_I 0x75 67 //bit6-bit1 设备身份验证 0x34 最高位和最低位都剔除掉 68 69 70 71 72 typedef struct ACCELSTRUCT 73 { 74 s16 accelX; 75 s16 accelY; 76 s16 accelZ; 77 }ACCELSTRUCT; 78 79 typedef struct GYROSTRUCT 80 { 81 s16 gyroX; 82 s16 gyroY; 83 s16 gyroZ; 84 }GYROSTRUCT; 85 86 extern struct ACCELSTRUCT accelStruct ; 87 extern struct GYROSTRUCT gyroStruct ; 88 89 90 u8 MpuInit(void); 91 92 void MpuGetData(void); 93 94 95 96 #endif
Mpu6050.c
1 #include "mpu6050.h" 2 3 struct ACCELSTRUCT accelStruct = {0,0,0}; 4 struct GYROSTRUCT gyroStruct = {0,0,0}; 5 6 7 //IO方向设置 8 #define MPU_SDA_IN() {GPIOC->CRH&=0XFFFF0FFF;GPIOC->CRH|=8<<12;} 9 #define MPU_SDA_OUT() {GPIOC->CRH&=0XFFFF0FFF;GPIOC->CRH|=3<<12;} 10 11 //IO操作函数 12 #define MPU_SCL PCout(10) //MPU SCL 13 #define MPU_SDA PCout(11) //MPU SDA 14 #define MPU_READ_SDA PCin(11) //输入SDA 15 16 17 /**************************MPU5883 IIC驱动函数*********************************/ 18 19 static void MPU5883IOInit(void) 20 { 21 GPIO_InitTypeDef GPIO_InitStructure; 22 RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOC, ENABLE ); 23 24 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_11;//PC10 PC11 25 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP ; //推挽输出 26 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; 27 GPIO_Init(GPIOC, &GPIO_InitStructure); 28 29 30 MPU_SCL = 1;//初始化均为浮空状态 31 MPU_SDA = 1; 32 } 33 34 35 36 //发送IIC起始信号 37 static void ComStart(void) 38 { 39 MPU_SDA_OUT(); //sda线输出 40 MPU_SDA=1; 41 MPU_SCL=1; 42 DelayUs(5); 43 MPU_SDA=0;//START:when CLK is high,DATA change form high to low 44 DelayUs(5); 45 MPU_SCL=0;//钳住I2C总线，准备发送或接收数据 46 } 47 //发送IIC停止信号 48 static void ComStop(void) 49 { 50 MPU_SDA_OUT();//sda线输出 51 MPU_SDA=0;//STOP:when CLK is high DATA change form low to high 52 MPU_SCL=1; 53 DelayUs(5); 54 MPU_SDA=1;//发送I2C总线结束信号 55 DelayUs(5); 56 } 57 //等待ACK,为1代表无ACK 为0代表等到了ACK 58 static u8 ComWaitAck(void) 59 { 60 u8 waitTime = 0; 61 MPU_SDA_OUT();//sda线输出 62 MPU_SDA = 1; 63 DelayUs(5); 64 MPU_SDA_IN(); //SDA设置为输入 65 MPU_SCL=1; 66 DelayUs(5); 67 while(MPU_READ_SDA) 68 { 69 waitTime++; 70 DelayUs(1); 71 if(waitTime > MPU_ACK_WAIT_TIME) 72 { 73 ComStop(); 74 return 1; 75 } 76 } 77 MPU_SCL = 0; 78 return 0; 79 80 } 81 82 //static void ComSendAck(void) 83 //{ 84 // MPU_SCL = 0; 85 // MPU_SDA_OUT(); 86 // MPU_SDA = 0; 87 // DelayUs(2); 88 // MPU_SCL = 1; 89 // DelayUs(5); 90 // MPU_SCL = 0; 91 // DelayUs(5); 92 //} 93 94 static void ComSendNoAck(void) 95 { 96 MPU_SCL = 0; 97 MPU_SDA_OUT(); 98 MPU_SDA = 1; 99 DelayUs(2); 100 MPU_SCL = 1; 101 DelayUs(5); 102 MPU_SCL = 0; 103 DelayUs(5); 104 } 105 //返回0 写入收到ACK 返回1写入未收到ACK 106 static u8 ComSendByte(u8 byte) 107 { 108 u8 t; 109 MPU_SDA_OUT(); 110 for(t=0;t<8;t++) 111 { 112 MPU_SDA=(byte&0x80)>>7; 113 byte<<=1; 114 MPU_SCL=1; 115 DelayUs(5); 116 MPU_SCL=0; 117 DelayUs(5); 118 } 119 return ComWaitAck(); 120 } 121 122 static void ComReadByte(u8* byte) 123 { 124 u8 i,receive=0; 125 MPU_SDA_IN();//SDA设置为输入 126 for(i=0;i<8;i++ ) 127 { 128 receive <<= 1; 129 MPU_SCL=1; 130 DelayUs(5); 131 if(MPU_READ_SDA)receive++; 132 MPU_SCL=0; 133 DelayUs(5); 134 } 135 *byte = receive; 136 } 137
1 /**************************MPU5883 IIC驱动函数*********************************/ 2 3 4 //向MPU写入一个字节数据,失败返回1 成功返回0 5 u8 MPUWriteReg(u8 regValue,u8 setValue) 6 { 7 u8 res; 8 ComStart(); //起始信号 9 res = ComSendByte(MPU_ADDR); //发送设备地址+写信号 10 if(res) 11 { 12 #ifdef MPU_DEBUG 13 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 14 #endif 15 return res; 16 } 17 res = ComSendByte(regValue); //内部寄存器地址 18 if(res) 19 { 20 #ifdef MPU_DEBUG 21 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 22 #endif 23 return res; 24 } 25 res = ComSendByte(setValue); //内部寄存器数据 26 if(res) 27 { 28 #ifdef MPU_DEBUG 29 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 30 #endif 31 return res; 32 } 33 ComStop(); //发送停止信号 34 return res; 35 } 36 37 //************************************** 38 //从I2C设备读取一个字节数据 返回值 读取成功或失败 39 //************************************** 40 u8 MPUReadReg(u8 regAddr,u8* readValue) 41 { 42 u8 res; 43 ComStart(); //起始信号 44 res = ComSendByte(MPU_ADDR); //发送设备地址+写信号 45 if(res) 46 { 47 #ifdef MPU_DEBUG 48 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 49 #endif 50 return res; 51 } 52 res = ComSendByte(regAddr); //发送存储单元地址，从0开始 53 if(res) 54 { 55 #ifdef MPU_DEBUG 56 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 57 #endif 58 return res; 59 } 60 ComStart(); //起始信号 61 res = ComSendByte(MPU_ADDR+1); //发送设备地址+读信号 62 if(res) 63 { 64 #ifdef MPU_DEBUG 65 printf("file=%s,func=%s,line=%d\r\n",__FILE__,__FUNCTION__,__LINE__); 66 #endif 67 return res; 68 } 69 ComReadByte(readValue); //读出寄存器数据 70 ComSendNoAck(); //发送非应答信号 71 ComStop(); //停止信号 72 return res; 73 } 74 75 //MPU读取两个字节的数据 76 s16 MpuReadTwoByte(u8 addr) 77 { 78 u8 H,L; 79 MPUReadReg(addr,&H); 80 MPUReadReg(addr+1,&L); 81 return (s16)((((u16)H)<<8)+L); //合成数据 82 } 83 84 /* 85 *初始化，返回0代表失败 返回1代表成功 86 **/ 87 u8 MpuInit(void) 88 { 89 u8 result; 90 u8 id = 0; 91 MPU5883IOInit(); 92 result = MPUReadReg(MPU6050_RA_WHO_AM_I,&id); 93 if(result) return result; //IIC总线错误 94 else 95 { 96 id &= 0x7e;//除去最高位最低位 97 id>>= 1; 98 if(id != 0x34) return 1; //获取到的芯片ID错误 99 } 100 //初始化成功，设置参数 101 MPUWriteReg(MPU6050_RA_PWR_MGMT_1,0x01); // 退出睡眠模式，设取样时钟为陀螺X轴。 102 MPUWriteReg(MPU6050_RA_SMPLRT_DIV,0x04); // 取样时钟4分频，1k/4，取样率为25Hz。 103 MPUWriteReg(MPU6050_RA_CONFIG,2); // 低通滤波，截止频率100Hz左右。 104 MPUWriteReg(MPU6050_RA_GYRO_CONFIG,3<<3); // 陀螺量程，2000dps 105 MPUWriteReg(MPU6050_RA_ACCEL_CONFIG,2<<3); // 加速度计量程，8g。 106 MPUWriteReg(MPU6050_RA_INT_PIN_CFG,0x32); // 中断信号为高电平，推挽输出，直到有读取操作才消失，直通辅助I2C。 107 MPUWriteReg(MPU6050_RA_INT_ENABLE,0x01); // 使用“数据准备好”中断。 108 MPUWriteReg(MPU6050_RA_USER_CTRL,0x00); // 不使用辅助I2C。 109 return 0; 110 } 111 112 113 //获取相应的测量数据 114 void MpuGetData(void) 115 { 116 s16 temp = 0; 117 accelStruct.accelX = MpuReadTwoByte(MPU6050_RA_ACCEL_XOUT_H); 118 accelStruct.accelY = MpuReadTwoByte(MPU6050_RA_ACCEL_YOUT_H); 119 accelStruct.accelZ = MpuReadTwoByte(MPU6050_RA_ACCEL_ZOUT_H); 120 gyroStruct.gyroX = MpuReadTwoByte(MPU6050_RA_GYRO_XOUT_H); 121 gyroStruct.gyroY = MpuReadTwoByte(MPU6050_RA_GYRO_YOUT_H); 122 gyroStruct.gyroZ = MpuReadTwoByte(MPU6050_RA_GYRO_ZOUT_H); 123 temp = MpuReadTwoByte(MPU6050_RA_TEMP_OUT_H); 124 #ifdef MPU_DEBUG 125 printf("accel x = %d ,y = %d ,z = %d \r\n",accelStruct.accelX,accelStruct.accelY,accelStruct.accelZ); 126 printf("gyro x = %d ,y = %d ,z = %d \r\n",gyroStruct.gyroX,gyroStruct.gyroY,gyroStruct.gyroZ); 127 printf("temp is %0.3f \r\n",(((float)temp)/340.0 + 36.53)); 128 #endif 129 130 }
通过加速度传感器和陀螺仪我们就可以知道芯片当前的姿态,从而进行姿态控制,具体姿态算法后续会说明
另,mpu6050有一套自己的DMP姿态解算的算法,不过需要说完姿态解算之后介绍,否则看不懂
http://bbs.21ic.com/icview-1647134-1-1.html
