原创 [Studio] 零知开源分享 - MPU6050六轴数据输出

1. /* I2C interface MPU6050 demo
   
2. * powered by   零知实验室
   
3. */
   
4. #include "MPU6050.h"
   
5. 
   
6. // 默认I2C地址为 0x68
   
7. // AD0 low = 0x68
   
8. // AD0 high = 0x69
   
9. 
   
10. MPU6050 accelgyro;
    
11. 
    
12. int16_t ax, ay, az;//三轴加速度值
    
13. int16_t gx, gy, gz;//三轴陀螺仪值
    
14. 
    
15. float nax,nay,naz;
    
16. float ngx,ngy,ngz;//转换后的实际值
    
17. 
    
18. #define LED_PIN LED_BUILTIN
    
19. bool blinkState = false;
    
20. 
    
21. void setup() {
    
22. 
    
23.     Serial.begin(9600);
    
24. 
    
25.     // MPU6050初始化设置
    
26.     Serial.println("Initializing I2C devices...");
    
27.     accelgyro.initialize();
    
28. 
    
29.     // verify connection
    
30.     Serial.println("Testing device connections...");
    
31.         if(accelgyro.testConnection()){
    
32.                 Serial.println("MPU6050 connection successful");
    
33.         }else{
    
34.                 Serial.println("MPU6050 connection failed");
    
35.         }
    
36.      
    
37.     //使用LED进行指示
    
38.     pinMode(LED_PIN, OUTPUT);
    
39.          
    
40. //        accelgyro.setFullScaleAccelRange(MPU6050_ACCEL_FS_16);//加速度参数
    
41. //        accelgyro.setFullScaleGyroRange(MPU6050_GYRO_FS_500);//陀螺仪
    
42. }
    
43. 
    
44. void loop() {
    
45.     // 获取原始的数值：三轴加速度值和三轴陀螺仪数值
    
46.     accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
    
47. 
    
48.     // 分别获取
    
49.     //accelgyro.getAcceleration(&ax, &ay, &az);
    
50.     //accelgyro.getRotation(&gx, &gy, &gz);
    
51. 
    
52.     // 显示打印
    
53.     Serial.print(" acc:\t");
    
54.     Serial.print(ax); Serial.print("\t");
    
55.     Serial.print(ay); Serial.print("\t");
    
56.     Serial.print(az); Serial.print("\t");
    
57.         Serial.print("\t gyro:\t");
    
58.     Serial.print(gx); Serial.print("\t");
    
59.     Serial.print(gy); Serial.print("\t");
    
60.     Serial.println(gz);
    
61.          
    
62.         //实际数值转换
    
63.         accelgyro.readNormalizeAccel(&nax,&nay,&naz);
    
64.         accelgyro.readNormalizeGyro(&ngx,&ngy,&ngz);
    
65.         Serial.print("Normalize acc:\t");
    
66.     Serial.print(nax); Serial.print("\t");
    
67.     Serial.print(nay); Serial.print("\t");
    
68.     Serial.print(naz); Serial.print("\t");
    
69.         Serial.print("\t Normalize gyro:\t");
    
70.     Serial.print(ngx); Serial.print("\t");
    
71.     Serial.print(ngy); Serial.print("\t");
    
72.     Serial.println(ngz);
    
73. 
    
74.     // blink LED to indicate activity
    
75.     blinkState = !blinkState;
    
76.     digitalWrite(LED_PIN, blinkState);
    
77. 
    
78.     delay(300);
    
79. }

结果.png (189.51 KB, 下载次数: 1)

下载附件  保存到相册

2019-5-24 16:18 上传