【电子DIY作品】跌倒告警 Ai-M61-32su + MPU6050

设计之初想的是，在不能关照老人与小孩儿的时候，可能会存在老人或小孩儿摔倒的情况。如果摔倒不及时处置可能造成比较严重的伤害。这个小作品主要就是，跌倒提醒的功能，网上也有类似的作品。这里使用Ai-M61-32su复刻一下。如果有跌倒状态，亮红灯，默认绿灯。还可以增加蜂鸣器等。

        摔倒检测算法可以通过检测加速度和角速度的变化来判断物体是否发生了摔倒。在实现MPU6050摔倒检测算法时，首先需要读取MPU6050传感器的原始数据。然后，通过计算加速度和角速度的变化率来判断物体是否摔倒。通常，可以通过设置一个阈值来判断加速度和角速度是否超过了正常范围。如果超过了阈值，则可认为物体发生了摔倒。另外，还可以使用一些机器学习算法来提高摔倒检测的准确性。通过对大量的摔倒和非摔倒状态的数据进行训练，可以建立一个模型来判断物体是否发生了摔倒。这种方法可以更好地适应不同物体和环境的情况，并提高摔倒检测的灵敏度和准确性。




下面对设备所使用的主要硬件进行介绍
对于 MPU6050网上有很多博主的介绍，这里【转载】知乎鱼芯工作室的文章

MPU6050简介 - 鱼芯工作室的文章 - 知乎
https://zhuanlan.zhihu.com/p/346764320

内容如下，可以更好的理解 MPU6050
一、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（0~65535），将其测量的模拟量转化为可输出的数字量。为了精确跟踪快速和慢速的运动，传感器的测量范围都是用户可控的，陀螺仪可测范围为±250，±500，±1000，±2000°/秒（dps），加速度计可测范围为±2，±4，±8，±16g。
芯片尺寸4×4×0.9mm，采用QFN 封装（无引线方形封装），可承受最大10000g 的冲击，并有可编程的低通滤波器。
MPU6050的内部框图如下图所示：

其中，需要了解的引脚有：SCL和 SDA是连接MCU的 IIC接口，MCU通过这个IIC 接口来控制MPU6050，另外还有一个 IIC 接口：AUX_CL和AUX_DA ，这个接口可用来连外部从设备比如磁力计，这样就可以组成一个九轴传感器。VLOGIC是IO口电压，该引脚最低可以到1.8V电压， 我们一般直接连VDD即可。AD0是从IIC 接口（接 MCU）的地址控制引脚，该引脚控制的是IIC 地址的最低位。如果接 GND ，则 MPU6050的IIC地址是：0X68，如果接VDD，则是0X69。需要注意的是：这里的地址0x68和0x69是不包含用于数据传输的最低位的，因此并不是八位数据，如0x68表示的是110 1000，0x69表示的则是110 1001，通常最低位用于表示IIC主机的读取数据/写数据模式。self test为自检，自检的作用是可用来测试传感器的机械和电气结构。也就是说通过自检来测试芯片是否损坏。自检启动后，电路会使传感器工作并且产生输出信号。关于自检的具体说明，官方芯片手册里有详细描述。如下：

• Gyroscope Self-Test
  When self-test is activated, the on-board electronics will actuate the appropriate sensor. This actuation will move the sensor’s proof masses over a distance equivalent to a pre-defined Coriolis force. This proof mass displacement results in a change in the sensor output, which is reflected in the output signal. The output signal is used to observe the self-test response.
  The self-test response is defined as follows:
  Self-test response = Sensor output with self-test enabled – Sensor output without self-test enabledThe self-test limits for each gyroscope axis is provided in the electrical characteristics tables of the MPU-6000/MPU-6050 Product Specification document. When the value of the self-test response is within the min/max limits of the product specification, the part has passed self test. When the self-test response exceeds the min/max values specified in the document, the part is deemed to have failed self-test.
• Accelerometer Self-Test
  When self-test is activated, the on-board electronics will actuate the appropriate sensor. This actuation simulates an external force. The actuated sensor, in turn, will produce a corresponding output signal. The output signal is used to observe the self-test response.
  The self-test response is defined as follows:
  Self-test response = Sensor output with self-test enabled – Sensor output without self-test enabledThe self-test limits for each accelerometer axis is provided in the electrical characteristics tables of the MPU-6000/MPU-6050 Product Specification document. When the value of the self-test response is within the min/max limits of the product specification, the part has passed self test. When the self-test response exceeds the min/max values specified in the document, the part is deemed to have failed self-test.
  

二、MPU6050相关寄存器

MPU6050官方的寄存器手册上共介绍了40个寄存器的内容和功能，在此我只选取一些常用的和重要的寄存器作为了解。

1.采样分频寄存器 Sample Rate Divider


说明：该寄存器指定陀螺仪输出速率的分频器，用于为MPU-60X0生成采样速率。
传感器寄存器输出，FIFO输出，DMP采样，运动检测，静止检测和自由落体检测都基于这个采样频率。
采样频率=陀螺仪输出频率/（1+SMPLRT_DIV）
当 DLPF（数字低通滤波器，见寄存器Configuration）禁用时（DLPF_CFG=0 or 7），陀螺输出频率=8kHz；当 DLPF 使能，陀螺仪输出频率=1KHz。注意：加速度计输出频率为 1KHz。这意味着，当采样频率大于1KHZ时，同个加速度计采样得到的数据，可能不止一次输出到FIFO、DMP、传感器寄存器。

2.配置寄存器 Configuration

说明：该寄存器为陀螺仪和加速度计配置外部帧同步(FSYNC) 管脚的采样和数字低通滤波(DLPF)设置。
其中，数字低通滤波器DLPF由DLPF_CFG配置。根据下表所示的DLPF_CFG值对加速度计和陀螺仪进行滤波。

其中，FS为陀螺仪输出频率。SMPLRT_DIV由预设定的采样频率根据上述的公式计算得出。一般情况下，DPLF滤波频率为采样频率的一半，如设定采样频率为50Hz，由表可知当FS为1kHz，SMPLRT_DIV的值为1000/50-1=19。

3.陀螺仪配置寄存器 Gyroscope Configuration



说明：该寄存器是用来触发陀螺仪自检和配置陀螺仪的满量程范围。
其中，XG_ST、YG_ST、ZG_ST分别用来设置陀螺仪X轴、Y轴、Z轴自检，置0则不触发自检。FS_SEL[1:0]用于设置陀螺仪的满量程，如下表：




我们一般设置为3，即满量程为±2000°/s，由于采用16位ADC即0-65536，则灵敏度G=65536/4000=16.4LSB/（°/s），LSB表示最低有效位，即1°/s对应的数字量为16.4。最终即可将陀螺仪输出的数字量数据转化为角速度。

4.加速度计配置寄存器 Accelerometer Configuration
说明：该寄存器是用来触发加速度计自检和配置加速度计的满量程范围。同时这个寄存器也可以用于配置数字高通滤波器（DHPF）。
其中，XA_ST、YA_ST、ZA_ST分别用来设置加速度计X轴、Y轴、Z轴自检，置0则不触发自检。AFS_SEL[1:0]用于选择加速度计的满量程范围，如下表：]



我们一般设置为0，即满量程为±2g，由于采用16位ADC即0-65536，则灵敏度G=65536/4=16384LSB/（g），LSB表示最低有效位，即1g对应的数字量为16384。最终即可将加速度计输出的数字量数据转化为加速度。

5.加速度计测量值寄存器 Accelerometer Measurements

说明：该寄存器存储最近加速度计的测量值。加速度计根据采样频率（由采样分频寄存器寄存器设定 ）写入到这些寄存器。即采样频率为50Hz，写入数据的时间间隔为0.02s。加速度计测量值寄存器和温度测量值寄存器，陀螺仪测量值寄存器，外部传感器数据寄存器都是由两组寄存器构成：一个内部寄存器集和一个用于用户读取的寄存器集。
加速度计传感器的内部寄存器集合里的数据根据采样频率更新。以此同时，每当串行接口处于闲置状态，面向用户的读取寄存器集合会复制内部寄存器集合的数据值。这保证了突发读取时传感器寄存器可以读到相同的采样时刻的测量值。需要注意的是，如果没有突发读取，则用户负责通过检查数据就绪中断（Data Ready interrupt）来确保瞬时的一组单字节读取对应于单字节的采样数据。
参数：
ACCEL_XOUT ：
由 2部分组成的 16位数值存储最近X 轴加速度计的测量值。
ACCEL_YOUT ：
由 2部分组成的 16位数值存储最近Y 轴加速度计的测量值。
ACCEL_ZOUT ：由 2部分组成的 16位数值存储最近Z 轴加速度计的测量值。

6.陀螺仪测量值寄存器 Gyroscope Measurements

说明：该寄存器存储最近加陀螺仪的测量值。大致构成与加速度计测量值寄存器相同，此处便不做叙述。参数分别为：GYRO_XOUT 、GYRO_YOUT 、GYRO_ZOUT 。

7.电源管理寄存器1 Power Management 1
说明：该寄存器允许用户配置电源模式和时钟源，还提供了复位整个设备和禁用温度传感器的位。当置SLEEP位为1时，MPU-60X0 可以进入低功耗睡眠模式。当SLEEP位禁用且 CYCLE位置 1时，MPU-60X0进入循环模式（CycleMode）。在循环模式下，设备在休眠模式和唤醒之间循环，以LP_WAKE_CTRL（由电源管理2寄存器配置）确定的速率从active sensors（此处不知如何翻译）获取单个数据样本。
该寄存器的最低三位用于设置系统的时钟源选择，默认值是0（内部8M RC振荡），不过一般设置为1，选择x轴陀螺PLL作为时钟源，以获得更高精度的时钟。同时，使能角速度传感器和加速度传感器，这两个操作通过电源管理寄存器2配置，设置对应位为0即可开启。
附英文手册原文片段：Upon power up, the MPU-60X0 clock source defaults to
the internal oscillator. However, it is highly recommended that the device be configured to use one of the gyroscopes (or an ext ernal clock source) as the clock reference for improved stability.

其他参数：
DEVICE_RESET
该位置 1，重启内部寄存器到默认值。复位完成后该位自动清0。
TEMP_DIS该位置 1，禁用温度传感器。

8.电源管理寄存器2 Power Management 2


说明：该寄存器允许用户在加速度计低功耗模式下配置唤醒频率。也允许用户让加速度计和陀螺仪的个别轴进入待机模式。
只让MPU-60X0的加速度计进入低功耗模式的步骤如下：
1.置 CYCLE位为 1
2.置 SLEEP位为 1
3.置 TEMP_DIS位为 1
4.置 STBY_XG,STBY_YG,STBY_ZG位为 1
在这种模式下，设备会关闭除了主 I2C接口外其他所有设备，加速度计只在固定的间隔唤醒并测量一次。唤醒的频率可以通过配置 LP_WAKE_CTRL实现如下：



参数：
LP_WAKE_CTRL ：
2位无符号数值。指定加速度计在低功耗模式下的唤醒频率。
STBY_XA ：
该位置 1，加速度计的 X轴进入待机模式。
STBY_YA ：
该位置 1，加速度计的 Y轴进入待机模式。
STBY_ZA ：
该位置 1，加速度计的 Z轴进入待机模式。
STBY_XG ：
该位置 1，陀螺仪的 X轴进入待机模式。
STBY_YG ：
该位置 1，陀螺仪的 Y轴进入待机模式。
STBY_ZG ：该位置 1，陀螺仪的 Z轴进入待机模式。



对于MPU 6050 进行了简单的介绍，也对这个模块有了一些了解。
mpu6050.h

1. 
   
2. #ifndef __MPU6050_H
   
3. #define __MPU6050_H
   
4. 
   
5. #include <stdlib.h>
   
6. #include <stdbool.h>
   
7. #include <stdarg.h>
   
8. #include <stddef.h>
   
9. #include <string.h>
   
10. #include <math.h>
    
11. #include <stdint.h>        //Added for uint_t
    
12. #include <stdio.h>
    
13. #include "bflb_mtimer.h"
    
14. 
    
15. 
    
16. #define MPU6050_ADDRESS_AD0_LOW     0x68 // address pin low (GND), default for InvenSense evaluation board
    
17. #define MPU6050_ADDRESS_AD0_HIGH    0x69 // address pin high (VCC)
    
18. #define MPU6050_DEFAULT_ADDRESS     MPU6050_ADDRESS_AD0_LOW
    
19. 
    
20. #define MPU6050_RA_XG_OFFS_TC       0x00 //[7] PWR_MODE, [6:1] XG_OFFS_TC, [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. #define MPU6050_RA_ZG_OFFS_TC       0x02 //[7] PWR_MODE, [6:1] ZG_OFFS_TC, [0] OTP_BNK_VLD
    
23. #define MPU6050_RA_X_FINE_GAIN      0x03 //[7:0] X_FINE_GAIN
    
24. #define MPU6050_RA_Y_FINE_GAIN      0x04 //[7:0] Y_FINE_GAIN
    
25. #define MPU6050_RA_Z_FINE_GAIN      0x05 //[7:0] Z_FINE_GAIN
    
26. #define MPU6050_RA_XA_OFFS_H        0x06 //[15:0] XA_OFFS
    
27. #define MPU6050_RA_XA_OFFS_L_TC     0x07
    
28. #define MPU6050_RA_YA_OFFS_H        0x08 //[15:0] YA_OFFS
    
29. #define MPU6050_RA_YA_OFFS_L_TC     0x09
    
30. #define MPU6050_RA_ZA_OFFS_H        0x0A //[15:0] ZA_OFFS
    
31. #define MPU6050_RA_ZA_OFFS_L_TC     0x0B
    
32. #define MPU6050_RA_XG_OFFS_USRH     0x13 //[15:0] XG_OFFS_USR
    
33. #define MPU6050_RA_XG_OFFS_USRL     0x14
    
34. #define MPU6050_RA_YG_OFFS_USRH     0x15 //[15:0] YG_OFFS_USR
    
35. #define MPU6050_RA_YG_OFFS_USRL     0x16
    
36. #define MPU6050_RA_ZG_OFFS_USRH     0x17 //[15:0] ZG_OFFS_USR
    
37. #define MPU6050_RA_ZG_OFFS_USRL     0x18
    
38. #define MPU6050_RA_SMPLRT_DIV       0x19
    
39. #define MPU6050_RA_CONFIG           0x1A
    
40. #define MPU6050_RA_GYRO_CONFIG      0x1B
    
41. #define MPU6050_RA_ACCEL_CONFIG     0x1C
    
42. #define MPU6050_RA_FF_THR           0x1D
    
43. #define MPU6050_RA_FF_DUR           0x1E
    
44. #define MPU6050_RA_MOT_THR          0x1F
    
45. #define MPU6050_RA_MOT_DUR          0x20
    
46. #define MPU6050_RA_ZRMOT_THR        0x21
    
47. #define MPU6050_RA_ZRMOT_DUR        0x22
    
48. #define MPU6050_RA_FIFO_EN          0x23
    
49. #define MPU6050_RA_I2C_MST_CTRL     0x24
    
50. #define MPU6050_RA_I2C_SLV0_ADDR    0x25
    
51. #define MPU6050_RA_I2C_SLV0_REG     0x26
    
52. #define MPU6050_RA_I2C_SLV0_CTRL    0x27
    
53. #define MPU6050_RA_I2C_SLV1_ADDR    0x28
    
54. #define MPU6050_RA_I2C_SLV1_REG     0x29
    
55. #define MPU6050_RA_I2C_SLV1_CTRL    0x2A
    
56. #define MPU6050_RA_I2C_SLV2_ADDR    0x2B
    
57. #define MPU6050_RA_I2C_SLV2_REG     0x2C
    
58. #define MPU6050_RA_I2C_SLV2_CTRL    0x2D
    
59. #define MPU6050_RA_I2C_SLV3_ADDR    0x2E
    
60. #define MPU6050_RA_I2C_SLV3_REG     0x2F
    
61. #define MPU6050_RA_I2C_SLV3_CTRL    0x30
    
62. #define MPU6050_RA_I2C_SLV4_ADDR    0x31
    
63. #define MPU6050_RA_I2C_SLV4_REG     0x32
    
64. #define MPU6050_RA_I2C_SLV4_DO      0x33
    
65. #define MPU6050_RA_I2C_SLV4_CTRL    0x34
    
66. #define MPU6050_RA_I2C_SLV4_DI      0x35
    
67. #define MPU6050_RA_I2C_MST_STATUS   0x36
    
68. #define MPU6050_RA_INT_PIN_CFG      0x37
    
69. #define MPU6050_RA_INT_ENABLE       0x38
    
70. #define MPU6050_RA_DMP_INT_STATUS   0x39
    
71. #define MPU6050_RA_INT_STATUS       0x3A
    
72. #define MPU6050_RA_ACCEL_XOUT_H     0x3B
    
73. #define MPU6050_RA_ACCEL_XOUT_L     0x3C
    
74. #define MPU6050_RA_ACCEL_YOUT_H     0x3D
    
75. #define MPU6050_RA_ACCEL_YOUT_L     0x3E
    
76. #define MPU6050_RA_ACCEL_ZOUT_H     0x3F
    
77. #define MPU6050_RA_ACCEL_ZOUT_L     0x40
    
78. #define MPU6050_RA_TEMP_OUT_H       0x41
    
79. #define MPU6050_RA_TEMP_OUT_L       0x42
    
80. #define MPU6050_RA_GYRO_XOUT_H      0x43
    
81. #define MPU6050_RA_GYRO_XOUT_L      0x44
    
82. #define MPU6050_RA_GYRO_YOUT_H      0x45
    
83. #define MPU6050_RA_GYRO_YOUT_L      0x46
    
84. #define MPU6050_RA_GYRO_ZOUT_H      0x47
    
85. #define MPU6050_RA_GYRO_ZOUT_L      0x48
    
86. #define MPU6050_RA_EXT_SENS_DATA_00 0x49
    
87. #define MPU6050_RA_EXT_SENS_DATA_01 0x4A
    
88. #define MPU6050_RA_EXT_SENS_DATA_02 0x4B
    
89. #define MPU6050_RA_EXT_SENS_DATA_03 0x4C
    
90. #define MPU6050_RA_EXT_SENS_DATA_04 0x4D
    
91. #define MPU6050_RA_EXT_SENS_DATA_05 0x4E
    
92. #define MPU6050_RA_EXT_SENS_DATA_06 0x4F
    
93. #define MPU6050_RA_EXT_SENS_DATA_07 0x50
    
94. #define MPU6050_RA_EXT_SENS_DATA_08 0x51
    
95. #define MPU6050_RA_EXT_SENS_DATA_09 0x52
    
96. #define MPU6050_RA_EXT_SENS_DATA_10 0x53
    
97. #define MPU6050_RA_EXT_SENS_DATA_11 0x54
    
98. #define MPU6050_RA_EXT_SENS_DATA_12 0x55
    
99. #define MPU6050_RA_EXT_SENS_DATA_13 0x56
    
100. #define MPU6050_RA_EXT_SENS_DATA_14 0x57
     
101. #define MPU6050_RA_EXT_SENS_DATA_15 0x58
     
102. #define MPU6050_RA_EXT_SENS_DATA_16 0x59
     
103. #define MPU6050_RA_EXT_SENS_DATA_17 0x5A
     
104. #define MPU6050_RA_EXT_SENS_DATA_18 0x5B
     
105. #define MPU6050_RA_EXT_SENS_DATA_19 0x5C
     
106. #define MPU6050_RA_EXT_SENS_DATA_20 0x5D
     
107. #define MPU6050_RA_EXT_SENS_DATA_21 0x5E
     
108. #define MPU6050_RA_EXT_SENS_DATA_22 0x5F
     
109. #define MPU6050_RA_EXT_SENS_DATA_23 0x60
     
110. #define MPU6050_RA_MOT_DETECT_STATUS    0x61
     
111. #define MPU6050_RA_I2C_SLV0_DO      0x63
     
112. #define MPU6050_RA_I2C_SLV1_DO      0x64
     
113. #define MPU6050_RA_I2C_SLV2_DO      0x65
     
114. #define MPU6050_RA_I2C_SLV3_DO      0x66
     
115. #define MPU6050_RA_I2C_MST_DELAY_CTRL   0x67
     
116. #define MPU6050_RA_SIGNAL_PATH_RESET    0x68
     
117. #define MPU6050_RA_MOT_DETECT_CTRL      0x69
     
118. #define MPU6050_RA_USER_CTRL        0x6A
     
119. #define MPU6050_RA_PWR_MGMT_1       0x6B
     
120. #define MPU6050_RA_PWR_MGMT_2       0x6C
     
121. #define MPU6050_RA_BANK_SEL         0x6D
     
122. #define MPU6050_RA_MEM_START_ADDR   0x6E
     
123. #define MPU6050_RA_MEM_R_W          0x6F
     
124. #define MPU6050_RA_DMP_CFG_1        0x70
     
125. #define MPU6050_RA_DMP_CFG_2        0x71
     
126. #define MPU6050_RA_FIFO_COUNTH      0x72
     
127. #define MPU6050_RA_FIFO_COUNTL      0x73
     
128. #define MPU6050_RA_FIFO_R_W         0x74
     
129. #define MPU6050_RA_WHO_AM_I         0x75
     
130. 
     
131. #define MPU6050_TC_PWR_MODE_BIT     7
     
132. #define MPU6050_TC_OFFSET_BIT       6
     
133. #define MPU6050_TC_OFFSET_LENGTH    6
     
134. #define MPU6050_TC_OTP_BNK_VLD_BIT  0
     
135. 
     
136. #define MPU6050_VDDIO_LEVEL_VLOGIC  0
     
137. #define MPU6050_VDDIO_LEVEL_VDD     1
     
138. 
     
139. #define MPU6050_CFG_EXT_SYNC_SET_BIT    5
     
140. #define MPU6050_CFG_EXT_SYNC_SET_LENGTH 3
     
141. #define MPU6050_CFG_DLPF_CFG_BIT    2
     
142. #define MPU6050_CFG_DLPF_CFG_LENGTH 3
     
143. 
     
144. #define MPU6050_EXT_SYNC_DISABLED       0x0
     
145. #define MPU6050_EXT_SYNC_TEMP_OUT_L     0x1
     
146. #define MPU6050_EXT_SYNC_GYRO_XOUT_L    0x2
     
147. #define MPU6050_EXT_SYNC_GYRO_YOUT_L    0x3
     
148. #define MPU6050_EXT_SYNC_GYRO_ZOUT_L    0x4
     
149. #define MPU6050_EXT_SYNC_ACCEL_XOUT_L   0x5
     
150. #define MPU6050_EXT_SYNC_ACCEL_YOUT_L   0x6
     
151. #define MPU6050_EXT_SYNC_ACCEL_ZOUT_L   0x7
     
152. 
     
153. #define MPU6050_DLPF_BW_256         0x00
     
154. #define MPU6050_DLPF_BW_188         0x01
     
155. #define MPU6050_DLPF_BW_98          0x02
     
156. #define MPU6050_DLPF_BW_42          0x03
     
157. #define MPU6050_DLPF_BW_20          0x04
     
158. #define MPU6050_DLPF_BW_10          0x05
     
159. #define MPU6050_DLPF_BW_5           0x06
     
160. 
     
161. #define MPU6050_GCONFIG_FS_SEL_BIT      4
     
162. #define MPU6050_GCONFIG_FS_SEL_LENGTH   2
     
163. 
     
164. #define MPU6050_GYRO_FS_250         0x00
     
165. #define MPU6050_GYRO_FS_500         0x01
     
166. #define MPU6050_GYRO_FS_1000        0x02
     
167. #define MPU6050_GYRO_FS_2000        0x03
     
168. 
     
169. #define MPU6050_ACONFIG_XA_ST_BIT           7
     
170. #define MPU6050_ACONFIG_YA_ST_BIT           6
     
171. #define MPU6050_ACONFIG_ZA_ST_BIT           5
     
172. #define MPU6050_ACONFIG_AFS_SEL_BIT         4
     
173. #define MPU6050_ACONFIG_AFS_SEL_LENGTH      2
     
174. #define MPU6050_ACONFIG_ACCEL_HPF_BIT       2
     
175. #define MPU6050_ACONFIG_ACCEL_HPF_LENGTH    3
     
176. 
     
177. #define MPU6050_ACCEL_FS_2          0x00
     
178. #define MPU6050_ACCEL_FS_4          0x01
     
179. #define MPU6050_ACCEL_FS_8          0x02
     
180. #define MPU6050_ACCEL_FS_16         0x03
     
181. 
     
182. #define MPU6050_DHPF_RESET          0x00
     
183. #define MPU6050_DHPF_5              0x01
     
184. #define MPU6050_DHPF_2P5            0x02
     
185. #define MPU6050_DHPF_1P25           0x03
     
186. #define MPU6050_DHPF_0P63           0x04
     
187. #define MPU6050_DHPF_HOLD           0x07
     
188. 
     
189. #define MPU6050_TEMP_FIFO_EN_BIT    7
     
190. #define MPU6050_XG_FIFO_EN_BIT      6
     
191. #define MPU6050_YG_FIFO_EN_BIT      5
     
192. #define MPU6050_ZG_FIFO_EN_BIT      4
     
193. #define MPU6050_ACCEL_FIFO_EN_BIT   3
     
194. #define MPU6050_SLV2_FIFO_EN_BIT    2
     
195. #define MPU6050_SLV1_FIFO_EN_BIT    1
     
196. #define MPU6050_SLV0_FIFO_EN_BIT    0
     
197. 
     
198. #define MPU6050_MULT_MST_EN_BIT     7
     
199. #define MPU6050_WAIT_FOR_ES_BIT     6
     
200. #define MPU6050_SLV_3_FIFO_EN_BIT   5
     
201. #define MPU6050_I2C_MST_P_NSR_BIT   4
     
202. #define MPU6050_I2C_MST_CLK_BIT     3
     
203. #define MPU6050_I2C_MST_CLK_LENGTH  4
     
204. 
     
205. #define MPU6050_CLOCK_DIV_348       0x0
     
206. #define MPU6050_CLOCK_DIV_333       0x1
     
207. #define MPU6050_CLOCK_DIV_320       0x2
     
208. #define MPU6050_CLOCK_DIV_308       0x3
     
209. #define MPU6050_CLOCK_DIV_296       0x4
     
210. #define MPU6050_CLOCK_DIV_286       0x5
     
211. #define MPU6050_CLOCK_DIV_276       0x6
     
212. #define MPU6050_CLOCK_DIV_267       0x7
     
213. #define MPU6050_CLOCK_DIV_258       0x8
     
214. #define MPU6050_CLOCK_DIV_500       0x9
     
215. #define MPU6050_CLOCK_DIV_471       0xA
     
216. #define MPU6050_CLOCK_DIV_444       0xB
     
217. #define MPU6050_CLOCK_DIV_421       0xC
     
218. #define MPU6050_CLOCK_DIV_400       0xD
     
219. #define MPU6050_CLOCK_DIV_381       0xE
     
220. #define MPU6050_CLOCK_DIV_364       0xF
     
221. 
     
222. #define MPU6050_I2C_SLV_RW_BIT      7
     
223. #define MPU6050_I2C_SLV_ADDR_BIT    6
     
224. #define MPU6050_I2C_SLV_ADDR_LENGTH 7
     
225. #define MPU6050_I2C_SLV_EN_BIT      7
     
226. #define MPU6050_I2C_SLV_BYTE_SW_BIT 6
     
227. #define MPU6050_I2C_SLV_REG_DIS_BIT 5
     
228. #define MPU6050_I2C_SLV_GRP_BIT     4
     
229. #define MPU6050_I2C_SLV_LEN_BIT     3
     
230. #define MPU6050_I2C_SLV_LEN_LENGTH  4
     
231. 
     
232. #define MPU6050_I2C_SLV4_RW_BIT         7
     
233. #define MPU6050_I2C_SLV4_ADDR_BIT       6
     
234. #define MPU6050_I2C_SLV4_ADDR_LENGTH    7
     
235. #define MPU6050_I2C_SLV4_EN_BIT         7
     
236. #define MPU6050_I2C_SLV4_INT_EN_BIT     6
     
237. #define MPU6050_I2C_SLV4_REG_DIS_BIT    5
     
238. #define MPU6050_I2C_SLV4_MST_DLY_BIT    4
     
239. #define MPU6050_I2C_SLV4_MST_DLY_LENGTH 5
     
240. 
     
241. #define MPU6050_MST_PASS_THROUGH_BIT    7
     
242. #define MPU6050_MST_I2C_SLV4_DONE_BIT   6
     
243. #define MPU6050_MST_I2C_LOST_ARB_BIT    5
     
244. #define MPU6050_MST_I2C_SLV4_NACK_BIT   4
     
245. #define MPU6050_MST_I2C_SLV3_NACK_BIT   3
     
246. #define MPU6050_MST_I2C_SLV2_NACK_BIT   2
     
247. #define MPU6050_MST_I2C_SLV1_NACK_BIT   1
     
248. #define MPU6050_MST_I2C_SLV0_NACK_BIT   0
     
249. 
     
250. #define MPU6050_INTCFG_INT_LEVEL_BIT        7
     
251. #define MPU6050_INTCFG_INT_OPEN_BIT         6
     
252. #define MPU6050_INTCFG_LATCH_INT_EN_BIT     5
     
253. #define MPU6050_INTCFG_INT_RD_CLEAR_BIT     4
     
254. #define MPU6050_INTCFG_FSYNC_INT_LEVEL_BIT  3
     
255. #define MPU6050_INTCFG_FSYNC_INT_EN_BIT     2
     
256. #define MPU6050_INTCFG_I2C_BYPASS_EN_BIT    1
     
257. #define MPU6050_INTCFG_CLKOUT_EN_BIT        0
     
258. 
     
259. #define MPU6050_INTMODE_ACTIVEHIGH  0x00
     
260. #define MPU6050_INTMODE_ACTIVELOW   0x01
     
261. 
     
262. #define MPU6050_INTDRV_PUSHPULL     0x00
     
263. #define MPU6050_INTDRV_OPENDRAIN    0x01
     
264. 
     
265. #define MPU6050_INTLATCH_50USPULSE  0x00
     
266. #define MPU6050_INTLATCH_WAITCLEAR  0x01
     
267. 
     
268. #define MPU6050_INTCLEAR_STATUSREAD 0x00
     
269. #define MPU6050_INTCLEAR_ANYREAD    0x01
     
270. 
     
271. #define MPU6050_INTERRUPT_FF_BIT            7
     
272. #define MPU6050_INTERRUPT_MOT_BIT           6
     
273. #define MPU6050_INTERRUPT_ZMOT_BIT          5
     
274. #define MPU6050_INTERRUPT_FIFO_OFLOW_BIT    4
     
275. #define MPU6050_INTERRUPT_I2C_MST_INT_BIT   3
     
276. #define MPU6050_INTERRUPT_PLL_RDY_INT_BIT   2
     
277. #define MPU6050_INTERRUPT_DMP_INT_BIT       1
     
278. #define MPU6050_INTERRUPT_DATA_RDY_BIT      0
     
279. 
     
280. // TODO: figure out what these actually do
     
281. // UMPL source code is not very obivous
     
282. #define MPU6050_DMPINT_5_BIT            5
     
283. #define MPU6050_DMPINT_4_BIT            4
     
284. #define MPU6050_DMPINT_3_BIT            3
     
285. #define MPU6050_DMPINT_2_BIT            2
     
286. #define MPU6050_DMPINT_1_BIT            1
     
287. #define MPU6050_DMPINT_0_BIT            0
     
288. 
     
289. #define MPU6050_MOTION_MOT_XNEG_BIT     7
     
290. #define MPU6050_MOTION_MOT_XPOS_BIT     6
     
291. #define MPU6050_MOTION_MOT_YNEG_BIT     5
     
292. #define MPU6050_MOTION_MOT_YPOS_BIT     4
     
293. #define MPU6050_MOTION_MOT_ZNEG_BIT     3
     
294. #define MPU6050_MOTION_MOT_ZPOS_BIT     2
     
295. #define MPU6050_MOTION_MOT_ZRMOT_BIT    0
     
296. 
     
297. #define MPU6050_DELAYCTRL_DELAY_ES_SHADOW_BIT   7
     
298. #define MPU6050_DELAYCTRL_I2C_SLV4_DLY_EN_BIT   4
     
299. #define MPU6050_DELAYCTRL_I2C_SLV3_DLY_EN_BIT   3
     
300. #define MPU6050_DELAYCTRL_I2C_SLV2_DLY_EN_BIT   2
     
301. #define MPU6050_DELAYCTRL_I2C_SLV1_DLY_EN_BIT   1
     
302. #define MPU6050_DELAYCTRL_I2C_SLV0_DLY_EN_BIT   0
     
303. 
     
304. #define MPU6050_PATHRESET_GYRO_RESET_BIT    2
     
305. #define MPU6050_PATHRESET_ACCEL_RESET_BIT   1
     
306. #define MPU6050_PATHRESET_TEMP_RESET_BIT    0
     
307. 
     
308. #define MPU6050_DETECT_ACCEL_ON_DELAY_BIT       5
     
309. #define MPU6050_DETECT_ACCEL_ON_DELAY_LENGTH    2
     
310. #define MPU6050_DETECT_FF_COUNT_BIT             3
     
311. #define MPU6050_DETECT_FF_COUNT_LENGTH          2
     
312. #define MPU6050_DETECT_MOT_COUNT_BIT            1
     
313. #define MPU6050_DETECT_MOT_COUNT_LENGTH         2
     
314. 
     
315. #define MPU6050_DETECT_DECREMENT_RESET  0x0
     
316. #define MPU6050_DETECT_DECREMENT_1      0x1
     
317. #define MPU6050_DETECT_DECREMENT_2      0x2
     
318. #define MPU6050_DETECT_DECREMENT_4      0x3
     
319. 
     
320. #define MPU6050_USERCTRL_DMP_EN_BIT             7
     
321. #define MPU6050_USERCTRL_FIFO_EN_BIT            6
     
322. #define MPU6050_USERCTRL_I2C_MST_EN_BIT         5
     
323. #define MPU6050_USERCTRL_I2C_IF_DIS_BIT         4
     
324. #define MPU6050_USERCTRL_DMP_RESET_BIT          3
     
325. #define MPU6050_USERCTRL_FIFO_RESET_BIT         2
     
326. #define MPU6050_USERCTRL_I2C_MST_RESET_BIT      1
     
327. #define MPU6050_USERCTRL_SIG_COND_RESET_BIT     0
     
328. 
     
329. #define MPU6050_PWR1_DEVICE_RESET_BIT   7
     
330. #define MPU6050_PWR1_SLEEP_BIT          6
     
331. #define MPU6050_PWR1_CYCLE_BIT          5
     
332. #define MPU6050_PWR1_TEMP_DIS_BIT       3
     
333. #define MPU6050_PWR1_CLKSEL_BIT         2
     
334. #define MPU6050_PWR1_CLKSEL_LENGTH      3
     
335. 
     
336. #define MPU6050_CLOCK_INTERNAL          0x00
     
337. #define MPU6050_CLOCK_PLL_XGYRO         0x01
     
338. #define MPU6050_CLOCK_PLL_YGYRO         0x02
     
339. #define MPU6050_CLOCK_PLL_ZGYRO         0x03
     
340. #define MPU6050_CLOCK_PLL_EXT32K        0x04
     
341. #define MPU6050_CLOCK_PLL_EXT19M        0x05
     
342. #define MPU6050_CLOCK_KEEP_RESET        0x07
     
343. 
     
344. #define MPU6050_PWR2_LP_WAKE_CTRL_BIT       7
     
345. #define MPU6050_PWR2_LP_WAKE_CTRL_LENGTH    2
     
346. #define MPU6050_PWR2_STBY_XA_BIT            5
     
347. #define MPU6050_PWR2_STBY_YA_BIT            4
     
348. #define MPU6050_PWR2_STBY_ZA_BIT            3
     
349. #define MPU6050_PWR2_STBY_XG_BIT            2
     
350. #define MPU6050_PWR2_STBY_YG_BIT            1
     
351. #define MPU6050_PWR2_STBY_ZG_BIT            0
     
352. 
     
353. #define MPU6050_WAKE_FREQ_1P25      0x0
     
354. #define MPU6050_WAKE_FREQ_2P5       0x1
     
355. #define MPU6050_WAKE_FREQ_5         0x2
     
356. #define MPU6050_WAKE_FREQ_10        0x3
     
357. 
     
358. #define MPU6050_BANKSEL_PRFTCH_EN_BIT       6
     
359. #define MPU6050_BANKSEL_CFG_USER_BANK_BIT   5
     
360. #define MPU6050_BANKSEL_MEM_SEL_BIT         4
     
361. #define MPU6050_BANKSEL_MEM_SEL_LENGTH      5
     
362. 
     
363. #define MPU6050_WHO_AM_I_BIT        6
     
364. #define MPU6050_WHO_AM_I_LENGTH     6
     
365. 
     
366. #define MPU6050_DMP_MEMORY_BANKS        8
     
367. #define MPU6050_DMP_MEMORY_BANK_SIZE    256
     
368. #define MPU6050_DMP_MEMORY_CHUNK_SIZE   16
     
369. 
     
370. // 1000ms default read timeout (modify with "I2Cdev::readTimeout = [ms];")
     
371. #define I2CDEV_DEFAULT_READ_TIMEOUT     1000
     
372. 
     
373. void MPU6050();
     
374. // SMPLRT_DIV register
     
375. uint8_t getRate();
     
376. void setRate(uint8_t rate);
     
377. uint8_t getClockSource();
     
378. void setClockSource(uint8_t source);
     
379. // GYRO_CONFIG register
     
380. uint8_t getFullScaleGyroRange();
     
381. void setFullScaleGyroRange(uint8_t range);
     
382. uint8_t getFullScaleAccelRange();
     
383. void setFullScaleAccelRange(uint8_t range);
     
384. uint8_t getDHPFMode();
     
385. void setDHPFMode(uint8_t mode);
     
386. // PWR_MGMT_1 register
     
387. void reset();
     
388. bool getSleepEnabled();
     
389. void setSleepEnabled(bool enabled);
     
390. bool getTempSensorEnabled();
     
391. void setTempSensorEnabled(bool enabled);
     
392. 
     
393. uint8_t getMasterClockSpeed();
     
394. void setMasterClockSpeed(uint8_t speed);
     
395. int8_t writeBit(uint8_t devAddr, uint8_t regAddr, uint8_t bitNum, uint8_t data);
     
396. int8_t writeBits(uint8_t devAddr, uint8_t regAddr, uint8_t bitStart, uint8_t length, uint8_t data);
     
397. int8_t writeByte(uint8_t devAddr, uint8_t regAddr, uint8_t data);
     
398. int8_t writeBytes(uint8_t devAddr, uint8_t regAddr, uint8_t length, uint8_t *data);
     
399. int8_t readByte(uint8_t devAddr, uint8_t regAddr, uint8_t *data);
     
400. int8_t readBytes(uint8_t devAddr, uint8_t regAddr, uint8_t length, uint8_t *data);
     
401. int8_t readBits(uint8_t devAddr, uint8_t regAddr, uint8_t bitStart, uint8_t length, uint8_t *data);
     
402. int8_t readBit(uint8_t devAddr, uint8_t regAddr, uint8_t bitNum, uint8_t *data);
     
403. int getState();
     
404. // WHO_AM_I register
     
405. uint8_t getDeviceID();
     
406. void getAcceleration(int16_t* x, int16_t* y, int16_t* z);
     
407. int16_t getAccelerationX();
     
408. int16_t getAccelerationY();
     
409. int16_t getAccelerationZ();
     
410. 
     
411. // TEMP_OUT_* registers
     
412. int16_t getTemperature();
     
413. 
     
414. // GYRO_*OUT_* registers
     
415. void getRotation(int16_t* x, int16_t* y, int16_t* z);
     
416. int16_t getRotationX();
     
417. int16_t getRotationY();
     
418. int16_t getRotationZ();
     
419. void getMotion6(int16_t* ax, int16_t* ay, int16_t* az, int16_t* gx, int16_t* gy, int16_t* gz);
     
420. 
     
421. #endif
     

复制代码

mpu6050.c

1. #include "Wire.h"
   
2. #include "MPU6050.h"
   
3. #include "log.h"
   
4. 
   
5. #define MPU6050_ADDR 0x68
   
6. 
   
7. uint8_t buffer[14];
   
8. 
   
9. int8_t readBytes(uint8_t devAddr, uint8_t regAddr, uint8_t length, uint8_t *data) {
   
10.     beginTransmission(devAddr);
    
11.     write_char(regAddr);
    
12.     requestFrom(devAddr, length);
    
13.     endTransmission();
    
14.     int8_t count = 0;
    
15.     while (available()) {
    
16.       data[count] = readI2c();
    
17.       count++;
    
18.     }
    
19.     LOG_E("=============================\r\n");
    
20.     for (size_t i = 0; i < count; i++)
    
21.     {
    
22.         LOG_E("%2x data%d: %2x \r\n", regAddr, i, data[0]);
    
23.     }
    
24.     LOG_E("==============================\r\n");
    
25.     return count;
    
26. }
    
27. 
    
28. 
    
29. int8_t readByte(uint8_t devAddr, uint8_t regAddr, uint8_t *data) {
    
30.     return readBytes(devAddr, regAddr, 1, data);
    
31. }
    
32. 
    
33. /** Read a single bit from an 8-bit device register.
    
34. * @param devAddr I2C slave device address
    
35. * @param regAddr Register regAddr to read from
    
36. * @param bitNum Bit position to read (0-7)
    
37. * @param data Container for single bit value
    
38. * @param timeout Optional read timeout in milliseconds (0 to disable, leave off to use default class value in I2Cdev::readTimeout)
    
39. * @return Status of read operation (true = success)
    
40. */
    
41. int8_t readBit(uint8_t devAddr, uint8_t regAddr, uint8_t bitNum, uint8_t *data) {
    
42.     uint8_t b;
    
43.     uint8_t count = readByte(devAddr, regAddr, &b);
    
44.     *data = b & (1 << bitNum);
    
45.     return count;
    
46. }
    
47. 
    
48. /** Read multiple bits from an 8-bit device register.
    
49. * @param devAddr I2C slave device address
    
50. * @param regAddr Register regAddr to read from
    
51. * @param bitStart First bit position to read (0-7)
    
52. * @param length Number of bits to read (not more than 8)
    
53. * @param data Container for right-aligned value (i.e. '101' read from any bitStart position will equal 0x05)
    
54. * @param timeout Optional read timeout in milliseconds (0 to disable, leave off to use default class value in I2Cdev::readTimeout)
    
55. * @return Status of read operation (true = success)
    
56. */
    
57. int8_t readBits(uint8_t devAddr, uint8_t regAddr, uint8_t bitStart, uint8_t length, uint8_t *data) {
    
58.     // 01101001 read byte
    
59.     // 76543210 bit numbers
    
60.     //    xxx   args: bitStart=4, length=3
    
61.     //    010   masked
    
62.     //   -> 010 shifted
    
63.     uint8_t count, b;
    
64.     if ((count = readByte(devAddr, regAddr, &b)) != 0) {
    
65.         uint8_t mask = ((1 << length) - 1) << (bitStart - length + 1);
    
66.         b &= mask;
    
67.         b >>= (bitStart - length + 1);
    
68.         *data = b;
    
69.     }
    
70.     return count;
    
71. }
    
72. 
    
73. int8_t writeBytes(uint8_t devAddr, uint8_t regAddr, uint8_t length, uint8_t* data) {
    
74.     beginTransmission(devAddr);
    
75.     write_char((uint8_t) regAddr); // send address
    
76.     for (uint8_t i = 0; i < length; i++) {
    
77.       write_char((uint8_t) data[i]);
    
78.     }
    
79.     endTransmission();
    
80.     return 0;
    
81. }
    
82. 
    
83. int8_t writeByte(uint8_t devAddr, uint8_t regAddr, uint8_t data) {
    
84.     return writeBytes(devAddr, regAddr, 1, &data);
    
85. }
    
86. 
    
87. int8_t writeBits(uint8_t devAddr, uint8_t regAddr, uint8_t bitStart, uint8_t length, uint8_t data) {
    
88.     //      010 value to write
    
89.     // 76543210 bit numbers
    
90.     //    xxx   args: bitStart=4, length=3
    
91.     // 00011100 mask byte
    
92.     // 10101111 original value (sample)
    
93.     // 10100011 original & ~mask
    
94.     // 10101011 masked | value
    
95.     uint8_t b;
    
96.     if(readByte(devAddr, regAddr, &b)!=0){
    
97.       uint8_t mask = ((1 << length) - 1) << (bitStart - length + 1);
    
98.       data <<= (bitStart - length + 1); // shift data into correct position
    
99.       data &= mask; // zero all non-important bits in data
    
100.       b &= ~(mask); // zero all important bits in existing byte
     
101.       b |= data; // combine data with existing byte
     
102.       return writeByte(devAddr, regAddr, b);
     
103.     }
     
104.     return 0;
     
105. }
     
106. 
     
107. int8_t writeBit(uint8_t devAddr, uint8_t regAddr, uint8_t bitNum, uint8_t data) {
     
108.     uint8_t b;
     
109.     readByte(devAddr, regAddr, &b);
     
110.     b = (data != 0) ? (b | (1 << bitNum)) : (b & ~(1 << bitNum));
     
111.     return writeByte(devAddr, regAddr, b);
     
112. }
     
113. 
     
114. /** Get clock source setting.
     
115. * @return Current clock source setting
     
116. * @see MPU6050_RA_PWR_MGMT_1
     
117. * @see MPU6050_PWR1_CLKSEL_BIT
     
118. * @see MPU6050_PWR1_CLKSEL_LENGTH
     
119. */
     
120. uint8_t getClockSource() {
     
121.     readBits(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_CLKSEL_BIT, MPU6050_PWR1_CLKSEL_LENGTH, buffer);
     
122.     return buffer[0];
     
123. }
     
124. /** Set clock source setting.
     
125. * An internal 8MHz oscillator, gyroscope based clock, or external sources can
     
126. * be selected as the MPU-60X0 clock source. When the internal 8 MHz oscillator
     
127. * or an external source is chosen as the clock source, the MPU-60X0 can operate
     
128. * in low power modes with the gyroscopes disabled.
     
129. *
     
130. * Upon power up, the MPU-60X0 clock source defaults to the internal oscillator.
     
131. * However, it is highly recommended that the device be configured to use one of
     
132. * the gyroscopes (or an external clock source) as the clock reference for
     
133. * improved stability. The clock source can be selected according to the following table:
     
134. *
     
135. * <pre>
     
136. * CLK_SEL | Clock Source
     
137. * --------+--------------------------------------
     
138. * 0       | Internal oscillator
     
139. * 1       | PLL with X Gyro reference
     
140. * 2       | PLL with Y Gyro reference
     
141. * 3       | PLL with Z Gyro reference
     
142. * 4       | PLL with external 32.768kHz reference
     
143. * 5       | PLL with external 19.2MHz reference
     
144. * 6       | Reserved
     
145. * 7       | Stops the clock and keeps the timing generator in reset
     
146. * </pre>
     
147. *
     
148. * @param source New clock source setting
     
149. * @see getClockSource()
     
150. * @see MPU6050_RA_PWR_MGMT_1
     
151. * @see MPU6050_PWR1_CLKSEL_BIT
     
152. * @see MPU6050_PWR1_CLKSEL_LENGTH
     
153. */
     
154. void setClockSource(uint8_t source) {
     
155.   writeBits(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_CLKSEL_BIT, MPU6050_PWR1_CLKSEL_LENGTH, source);
     
156. }
     
157. 
     
158. // GYRO_CONFIG register
     
159. 
     
160. /** Get full-scale gyroscope range.
     
161. * The FS_SEL parameter allows setting the full-scale range of the gyro sensors,
     
162. * as described in the table below.
     
163. *
     
164. * <pre>
     
165. * 0 = +/- 250 degrees/sec
     
166. * 1 = +/- 500 degrees/sec
     
167. * 2 = +/- 1000 degrees/sec
     
168. * 3 = +/- 2000 degrees/sec
     
169. * </pre>
     
170. *
     
171. * @return Current full-scale gyroscope range setting
     
172. * @see MPU6050_GYRO_FS_250
     
173. * @see MPU6050_RA_GYRO_CONFIG
     
174. * @see MPU6050_GCONFIG_FS_SEL_BIT
     
175. * @see MPU6050_GCONFIG_FS_SEL_LENGTH
     
176. */
     
177. uint8_t getFullScaleGyroRange() {
     
178.     readBits(MPU6050_ADDR, MPU6050_RA_GYRO_CONFIG, MPU6050_GCONFIG_FS_SEL_BIT, MPU6050_GCONFIG_FS_SEL_LENGTH, buffer);
     
179.     return buffer[0];
     
180. }
     
181. 
     
182. /** Set full-scale gyroscope range.
     
183. * @param range New full-scale gyroscope range value
     
184. * @see getFullScaleRange()
     
185. * @see MPU6050_GYRO_FS_250
     
186. * @see MPU6050_RA_GYRO_CONFIG
     
187. * @see MPU6050_GCONFIG_FS_SEL_BIT
     
188. * @see MPU6050_GCONFIG_FS_SEL_LENGTH
     
189. */
     
190. void setFullScaleGyroRange(uint8_t range) {
     
191.   writeBits(MPU6050_ADDR, MPU6050_RA_GYRO_CONFIG, MPU6050_GCONFIG_FS_SEL_BIT, MPU6050_GCONFIG_FS_SEL_LENGTH, range);
     
192. }
     
193. 
     
194. /** Get full-scale accelerometer range.
     
195. * The FS_SEL parameter allows setting the full-scale range of the accelerometer
     
196. * sensors, as described in the table below.
     
197. *
     
198. * <pre>
     
199. * 0 = +/- 2g
     
200. * 1 = +/- 4g
     
201. * 2 = +/- 8g
     
202. * 3 = +/- 16g
     
203. * </pre>
     
204. *
     
205. * @return Current full-scale accelerometer range setting
     
206. * @see MPU6050_ACCEL_FS_2
     
207. * @see MPU6050_RA_ACCEL_CONFIG
     
208. * @see MPU6050_ACONFIG_AFS_SEL_BIT
     
209. * @see MPU6050_ACONFIG_AFS_SEL_LENGTH
     
210. */
     
211. uint8_t getFullScaleAccelRange() {
     
212.     readBits(MPU6050_ADDR, MPU6050_RA_ACCEL_CONFIG, MPU6050_ACONFIG_AFS_SEL_BIT, MPU6050_ACONFIG_AFS_SEL_LENGTH, buffer);
     
213.     return buffer[0];
     
214. }
     
215. /** Set full-scale accelerometer range.
     
216. * @param range New full-scale accelerometer range setting
     
217. * @see getFullScaleAccelRange()
     
218. */
     
219. void setFullScaleAccelRange(uint8_t range) {
     
220.   writeBits(MPU6050_ADDR, MPU6050_RA_ACCEL_CONFIG, MPU6050_ACONFIG_AFS_SEL_BIT, MPU6050_ACONFIG_AFS_SEL_LENGTH, range);
     
221. }
     
222. 
     
223. /** Get the high-pass filter configuration.
     
224. * The DHPF is a filter module in the path leading to motion detectors (Free
     
225. * Fall, Motion threshold, and Zero Motion). The high pass filter output is not
     
226. * available to the data registers (see Figure in Section 8 of the MPU-6000/
     
227. * MPU-6050 Product Specification document).
     
228. *
     
229. * The high pass filter has three modes:
     
230. *
     
231. * <pre>
     
232. *    Reset: The filter output settles to zero within one sample. This
     
233. *           effectively disables the high pass filter. This mode may be toggled
     
234. *           to quickly settle the filter.
     
235. *
     
236. *    On:    The high pass filter will pass signals above the cut off frequency.
     
237. *
     
238. *    Hold:  When triggered, the filter holds the present sample. The filter
     
239. *           output will be the difference between the input sample and the held
     
240. *           sample.
     
241. * </pre>
     
242. *
     
243. * <pre>
     
244. * ACCEL_HPF | Filter Mode | Cut-off Frequency
     
245. * ----------+-------------+------------------
     
246. * 0         | Reset       | None
     
247. * 1         | On          | 5Hz
     
248. * 2         | On          | 2.5Hz
     
249. * 3         | On          | 1.25Hz
     
250. * 4         | On          | 0.63Hz
     
251. * 7         | Hold        | None
     
252. * </pre>
     
253. *
     
254. * @return Current high-pass filter configuration
     
255. * @see MPU6050_DHPF_RESET
     
256. * @see MPU6050_RA_ACCEL_CONFIG
     
257. */
     
258. uint8_t getDHPFMode() {
     
259.     readBits(MPU6050_ADDR, MPU6050_RA_ACCEL_CONFIG, MPU6050_ACONFIG_ACCEL_HPF_BIT, MPU6050_ACONFIG_ACCEL_HPF_LENGTH, buffer);
     
260.     return buffer[0];
     
261. }
     
262. /** Set the high-pass filter configuration.
     
263. * @param bandwidth New high-pass filter configuration
     
264. * @see setDHPFMode()
     
265. * @see MPU6050_DHPF_RESET
     
266. * @see MPU6050_RA_ACCEL_CONFIG
     
267. */
     
268. void setDHPFMode(uint8_t bandwidth) {
     
269.     writeBits(MPU6050_ADDR, MPU6050_RA_ACCEL_CONFIG, MPU6050_ACONFIG_ACCEL_HPF_BIT, MPU6050_ACONFIG_ACCEL_HPF_LENGTH, bandwidth);
     
270. }
     
271. 
     
272. /** Get I2C master clock speed.
     
273. * I2C_MST_CLK is a 4 bit unsigned value which configures a divider on the
     
274. * MPU-60X0 internal 8MHz clock. It sets the I2C master clock speed according to
     
275. * the following table:
     
276. *
     
277. * <pre>
     
278. * I2C_MST_CLK | I2C Master Clock Speed | 8MHz Clock Divider
     
279. * ------------+------------------------+-------------------
     
280. * 0           | 348kHz                 | 23
     
281. * 1           | 333kHz                 | 24
     
282. * 2           | 320kHz                 | 25
     
283. * 3           | 308kHz                 | 26
     
284. * 4           | 296kHz                 | 27
     
285. * 5           | 286kHz                 | 28
     
286. * 6           | 276kHz                 | 29
     
287. * 7           | 267kHz                 | 30
     
288. * 8           | 258kHz                 | 31
     
289. * 9           | 500kHz                 | 16
     
290. * 10          | 471kHz                 | 17
     
291. * 11          | 444kHz                 | 18
     
292. * 12          | 421kHz                 | 19
     
293. * 13          | 400kHz                 | 20
     
294. * 14          | 381kHz                 | 21
     
295. * 15          | 364kHz                 | 22
     
296. * </pre>
     
297. *
     
298. * @return Current I2C master clock speed
     
299. * @see MPU6050_RA_I2C_MST_CTRL
     
300. */
     
301. uint8_t getMasterClockSpeed() {
     
302.     readBits(MPU6050_ADDR, MPU6050_RA_I2C_MST_CTRL, MPU6050_I2C_MST_CLK_BIT, MPU6050_I2C_MST_CLK_LENGTH, buffer);
     
303.     return buffer[0];
     
304. }
     
305. /** Set I2C master clock speed.
     
306. * @reparam speed Current I2C master clock speed
     
307. * @see MPU6050_RA_I2C_MST_CTRL
     
308. */
     
309. void setMasterClockSpeed(uint8_t speed) {
     
310.     writeBits(MPU6050_ADDR, MPU6050_RA_I2C_MST_CTRL, MPU6050_I2C_MST_CLK_BIT, MPU6050_I2C_MST_CLK_LENGTH, speed);
     
311. }
     
312. 
     
313. /** Get 3-axis accelerometer readings.
     
314. * These registers store the most recent accelerometer measurements.
     
315. * Accelerometer measurements are written to these registers at the Sample Rate
     
316. * as defined in Register 25.
     
317. *
     
318. * The accelerometer measurement registers, along with the temperature
     
319. * measurement registers, gyroscope measurement registers, and external sensor
     
320. * data registers, are composed of two sets of registers: an internal register
     
321. * set and a user-facing read register set.
     
322. *
     
323. * The data within the accelerometer sensors' internal register set is always
     
324. * updated at the Sample Rate. Meanwhile, the user-facing read register set
     
325. * duplicates the internal register set's data values whenever the serial
     
326. * interface is idle. This guarantees that a burst read of sensor registers will
     
327. * read measurements from the same sampling instant. Note that if burst reads
     
328. * are not used, the user is responsible for ensuring a set of single byte reads
     
329. * correspond to a single sampling instant by checking the Data Ready interrupt.
     
330. *
     
331. * Each 16-bit accelerometer measurement has a full scale defined in ACCEL_FS
     
332. * (Register 28). For each full scale setting, the accelerometers' sensitivity
     
333. * per LSB in ACCEL_xOUT is shown in the table below:
     
334. *
     
335. * <pre>
     
336. * AFS_SEL | Full Scale Range | LSB Sensitivity
     
337. * --------+------------------+----------------
     
338. * 0       | +/- 2g           | 8192 LSB/mg
     
339. * 1       | +/- 4g           | 4096 LSB/mg
     
340. * 2       | +/- 8g           | 2048 LSB/mg
     
341. * 3       | +/- 16g          | 1024 LSB/mg
     
342. * </pre>
     
343. *
     
344. * @param x 16-bit signed integer container for X-axis acceleration
     
345. * @param y 16-bit signed integer container for Y-axis acceleration
     
346. * @param z 16-bit signed integer container for Z-axis acceleration
     
347. * @see MPU6050_RA_GYRO_XOUT_H
     
348. */
     
349. void getAcceleration(int16_t* x, int16_t* y, int16_t* z) {
     
350.     readBytes(MPU6050_ADDR, MPU6050_RA_ACCEL_XOUT_H, 6, buffer);
     
351.     *x = (((int16_t)buffer[0]) << 8) | buffer[1];
     
352.     *y = (((int16_t)buffer[2]) << 8) | buffer[3];
     
353.     *z = (((int16_t)buffer[4]) << 8) | buffer[5];
     
354. }
     
355. /** Get X-axis accelerometer reading.
     
356. * @return X-axis acceleration measurement in 16-bit 2's complement format
     
357. * @see getMotion6()
     
358. * @see MPU6050_RA_ACCEL_XOUT_H
     
359. */
     
360. int16_t getAccelerationX() {
     
361.     readBytes(MPU6050_ADDR, MPU6050_RA_ACCEL_XOUT_H, 2, buffer);
     
362.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
363. }
     
364. /** Get Y-axis accelerometer reading.
     
365. * @return Y-axis acceleration measurement in 16-bit 2's complement format
     
366. * @see getMotion6()
     
367. * @see MPU6050_RA_ACCEL_YOUT_H
     
368. */
     
369. int16_t getAccelerationY() {
     
370.     readBytes(MPU6050_ADDR, MPU6050_RA_ACCEL_YOUT_H, 2, buffer);
     
371.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
372. }
     
373. /** Get Z-axis accelerometer reading.
     
374. * @return Z-axis acceleration measurement in 16-bit 2's complement format
     
375. * @see getMotion6()
     
376. * @see MPU6050_RA_ACCEL_ZOUT_H
     
377. */
     
378. int16_t getAccelerationZ() {
     
379.     readBytes(MPU6050_ADDR, MPU6050_RA_ACCEL_ZOUT_H, 2, buffer);
     
380.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
381. }
     
382. 
     
383. // TEMP_OUT_* registers
     
384. 
     
385. /** Get current internal temperature.
     
386. * @return Temperature reading in 16-bit 2's complement format
     
387. * @see MPU6050_RA_TEMP_OUT_H
     
388. */
     
389. int16_t getTemperature() {
     
390.     readBytes(MPU6050_ADDR, MPU6050_RA_TEMP_OUT_H, 2, buffer);
     
391.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
392. }
     
393. 
     
394. // GYRO_*OUT_* registers
     
395. 
     
396. /** Get 3-axis gyroscope readings.
     
397. * These gyroscope measurement registers, along with the accelerometer
     
398. * measurement registers, temperature measurement registers, and external sensor
     
399. * data registers, are composed of two sets of registers: an internal register
     
400. * set and a user-facing read register set.
     
401. * The data within the gyroscope sensors' internal register set is always
     
402. * updated at the Sample Rate. Meanwhile, the user-facing read register set
     
403. * duplicates the internal register set's data values whenever the serial
     
404. * interface is idle. This guarantees that a burst read of sensor registers will
     
405. * read measurements from the same sampling instant. Note that if burst reads
     
406. * are not used, the user is responsible for ensuring a set of single byte reads
     
407. * correspond to a single sampling instant by checking the Data Ready interrupt.
     
408. *
     
409. * Each 16-bit gyroscope measurement has a full scale defined in FS_SEL
     
410. * (Register 27). For each full scale setting, the gyroscopes' sensitivity per
     
411. * LSB in GYRO_xOUT is shown in the table below:
     
412. *
     
413. * <pre>
     
414. * FS_SEL | Full Scale Range   | LSB Sensitivity
     
415. * -------+--------------------+----------------
     
416. * 0      | +/- 250 degrees/s  | 131 LSB/deg/s
     
417. * 1      | +/- 500 degrees/s  | 65.5 LSB/deg/s
     
418. * 2      | +/- 1000 degrees/s | 32.8 LSB/deg/s
     
419. * 3      | +/- 2000 degrees/s | 16.4 LSB/deg/s
     
420. * </pre>
     
421. *
     
422. * @param x 16-bit signed integer container for X-axis rotation
     
423. * @param y 16-bit signed integer container for Y-axis rotation
     
424. * @param z 16-bit signed integer container for Z-axis rotation
     
425. * @see getMotion6()
     
426. * @see MPU6050_RA_GYRO_XOUT_H
     
427. */
     
428. void getRotation(int16_t* x, int16_t* y, int16_t* z) {
     
429.     readBytes(MPU6050_ADDR, MPU6050_RA_GYRO_XOUT_H, 6, buffer);
     
430.     *x = (((int16_t)buffer[0]) << 8) | buffer[1];
     
431.     *y = (((int16_t)buffer[2]) << 8) | buffer[3];
     
432.     *z = (((int16_t)buffer[4]) << 8) | buffer[5];
     
433. }
     
434. /** Get X-axis gyroscope reading.
     
435. * @return X-axis rotation measurement in 16-bit 2's complement format
     
436. * @see getMotion6()
     
437. * @see MPU6050_RA_GYRO_XOUT_H
     
438. */
     
439. int16_t getRotationX() {
     
440.     readBytes(MPU6050_ADDR, MPU6050_RA_GYRO_XOUT_H, 2, buffer);
     
441.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
442. }
     
443. /** Get Y-axis gyroscope reading.
     
444. * @return Y-axis rotation measurement in 16-bit 2's complement format
     
445. * @see getMotion6()
     
446. * @see MPU6050_RA_GYRO_YOUT_H
     
447. */
     
448. int16_t getRotationY() {
     
449.     readBytes(MPU6050_ADDR, MPU6050_RA_GYRO_YOUT_H, 2, buffer);
     
450.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
451. }
     
452. /** Get Z-axis gyroscope reading.
     
453. * @return Z-axis rotation measurement in 16-bit 2's complement format
     
454. * @see getMotion6()
     
455. * @see MPU6050_RA_GYRO_ZOUT_H
     
456. */
     
457. int16_t getRotationZ() {
     
458.     readBytes(MPU6050_ADDR, MPU6050_RA_GYRO_ZOUT_H, 2, buffer);
     
459.     return (((int16_t)buffer[0]) << 8) | buffer[1];
     
460. }
     
461. 
     
462. // PWR_MGMT_1 register
     
463. 
     
464. /** Trigger a full device reset.
     
465. * A small delay of ~50ms may be desirable after triggering a reset.
     
466. * @see MPU6050_RA_PWR_MGMT_1
     
467. * @see MPU6050_PWR1_DEVICE_RESET_BIT
     
468. */
     
469. void reset() {
     
470.     writeBit(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_DEVICE_RESET_BIT, true);
     
471. }
     
472. /** Get sleep mode status.
     
473. * Setting the SLEEP bit in the register puts the device into very low power
     
474. * sleep mode. In this mode, only the serial interface and internal registers
     
475. * remain active, allowing for a very low standby current. Clearing this bit
     
476. * puts the device back into normal mode. To save power, the individual standby
     
477. * selections for each of the gyros should be used if any gyro axis is not used
     
478. * by the application.
     
479. * @return Current sleep mode enabled status
     
480. * @see MPU6050_RA_PWR_MGMT_1
     
481. * @see MPU6050_PWR1_SLEEP_BIT
     
482. */
     
483. bool getSleepEnabled() {
     
484.     readBit(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_SLEEP_BIT, buffer);
     
485.     return buffer[0];
     
486. }
     
487. 
     
488. /** Set sleep mode status.
     
489. * @param enabled New sleep mode enabled status
     
490. * @see getSleepEnabled()
     
491. * @see MPU6050_RA_PWR_MGMT_1
     
492. * @see MPU6050_PWR1_SLEEP_BIT
     
493. */
     
494. void setSleepEnabled(bool enabled) {
     
495.     writeBit(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_SLEEP_BIT, enabled);
     
496. }
     
497. 
     
498. /** Get temperature sensor enabled status.
     
499. * Control the usage of the internal temperature sensor.
     
500. *
     
501. * Note: this register stores the *disabled* value, but for consistency with the
     
502. * rest of the code, the function is named and used with standard true/false
     
503. * values to indicate whether the sensor is enabled or disabled, respectively.
     
504. *
     
505. * @return Current temperature sensor enabled status
     
506. * @see MPU6050_RA_PWR_MGMT_1
     
507. * @see MPU6050_PWR1_TEMP_DIS_BIT
     
508. */
     
509. bool getTempSensorEnabled() {
     
510.     readBit(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_TEMP_DIS_BIT, buffer);
     
511.     return buffer[0] == 0; // 1 is actually disabled here
     
512. }
     
513. /** Set temperature sensor enabled status.
     
514. * Note: this register stores the *disabled* value, but for consistency with the
     
515. * rest of the code, the function is named and used with standard true/false
     
516. * values to indicate whether the sensor is enabled or disabled, respectively.
     
517. *
     
518. * @param enabled New temperature sensor enabled status
     
519. * @see getTempSensorEnabled()
     
520. * @see MPU6050_RA_PWR_MGMT_1
     
521. * @see MPU6050_PWR1_TEMP_DIS_BIT
     
522. */
     
523. void setTempSensorEnabled(bool enabled) {
     
524.     // 1 is actually disabled here
     
525.     writeBit(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_TEMP_DIS_BIT, !enabled);
     
526. }
     
527. 
     
528. 
     
529. uint8_t getDeviceID() {
     
530.   uint8_t buf[1];
     
531.   readByte(MPU6050_ADDR, MPU6050_RA_WHO_AM_I, buf);
     
532.   LOG_E("MPU6050 getDeviceID ： %2x!\r\n", buf[0]);
     
533.   return buf[0];
     
534. }
     
535. 
     
536. // SMPLRT_DIV register
     
537. 
     
538. /** Get gyroscope output rate divider.
     
539. * The sensor register output, FIFO output, DMP sampling, Motion detection, Zero
     
540. * Motion detection, and Free Fall detection are all based on the Sample Rate.
     
541. * The Sample Rate is generated by dividing the gyroscope output rate by
     
542. * SMPLRT_DIV:
     
543. *
     
544. * Sample Rate = Gyroscope Output Rate / (1 + SMPLRT_DIV)
     
545. *
     
546. * where Gyroscope Output Rate = 8kHz when the DLPF is disabled (DLPF_CFG = 0 or
     
547. * 7), and 1kHz when the DLPF is enabled (see Register 26).
     
548. *
     
549. * Note: The accelerometer output rate is 1kHz. This means that for a Sample
     
550. * Rate greater than 1kHz, the same accelerometer sample may be output to the
     
551. * FIFO, DMP, and sensor registers more than once.
     
552. *
     
553. * For a diagram of the gyroscope and accelerometer signal paths, see Section 8
     
554. * of the MPU-6000/MPU-6050 Product Specification document.
     
555. *
     
556. * @return Current sample rate
     
557. * @see MPU6050_RA_SMPLRT_DIV
     
558. */
     
559. uint8_t getRate() {
     
560.     readByte(MPU6050_ADDR, MPU6050_RA_SMPLRT_DIV, buffer);
     
561.     return buffer[0];
     
562. }
     
563. /** Set gyroscope sample rate divider.
     
564. * @param rate New sample rate divider
     
565. * @see getRate()
     
566. * @see MPU6050_RA_SMPLRT_DIV
     
567. */
     
568. void setRate(uint8_t rate) {
     
569.     writeByte(MPU6050_ADDR, MPU6050_RA_SMPLRT_DIV, rate);
     
570. }
     
571. 
     
572. void getMotion6(int16_t* ax, int16_t* ay, int16_t* az, int16_t* gx, int16_t* gy, int16_t* gz) {
     
573.    
     
574.     LOG_E("MPU6050 getMotion6!\r\n");
     
575.     readBytes(MPU6050_ADDR, MPU6050_RA_ACCEL_XOUT_H, 14, buffer);
     
576.     *ax = (((int16_t)buffer[0]) << 8) | buffer[1];
     
577.     *ay = (((int16_t)buffer[2]) << 8) | buffer[3];
     
578.     *az = (((int16_t)buffer[4]) << 8) | buffer[5];
     
579.     *gx = (((int16_t)buffer[8]) << 8) | buffer[9];
     
580.     *gy = (((int16_t)buffer[10]) << 8) | buffer[11];
     
581.     *gz = (((int16_t)buffer[12]) << 8) | buffer[13];
     
582. }
     
583. 
     
584. void MPU6050() {
     
585.     begin();
     
586.     // setClockSource(MPU6050_CLOCK_PLL_XGYRO);
     
587.     // setFullScaleGyroRange(MPU6050_GYRO_FS_1000);
     
588.     // setFullScaleAccelRange(MPU6050_ACCEL_FS_2);
     
589.     // setSleepEnabled(false);
     
590.     writeByte(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_1, 0x01);
     
591.     writeByte(MPU6050_ADDR, MPU6050_RA_PWR_MGMT_2, 0x00);
     
592.     writeByte(MPU6050_ADDR, MPU6050_RA_GYRO_CONFIG, 0x18);
     
593.     writeByte(MPU6050_ADDR, MPU6050_RA_ACCEL_CONFIG, 0x18);
     
594. }
     

复制代码

main.c

1. 
   

复制代码

消息推送目前还么时间完善，使用pushplus
官方地址https://www.pushplus.plus/，申请注册后拿到token使用http请求即可实现消息推送。
消息推送到微信可以参考

1. #!/bin/sh

复制代码

这个是做内网穿透的时候，由于natapp免费版总是变地址，写了个脚本，定时发送新的域名用的。日志经过清理，只保留的INFO部分，基本不会太大。
可以直接将消息推送到微信。

赞一个

学到了

厉害

哇，大佬

大学生毕设一个

赞👍🏻

赞

期待完整的作品

赞