|
MPU6050模塊應用于零知平臺,使用該模塊測量三軸加速度和三軸陀螺儀數據。
硬件準備
(1)零知開發板-標準板
好看的標準板 (2).jpg (95.5 KB, 下載次數: 50)
下載附件
2019-5-24 15:12 上傳
(2)MPU6050模塊
MPU6050模塊.png (298.93 KB, 下載次數: 53)
下載附件
2019-5-24 15:11 上傳
(3)杜邦線若干
1、電路連接
模塊的SCL和SDA分別與零知標準板的I2C接口連接即A5和A4腳,供電3.3V,其他腳默認。
接線.png (289.79 KB, 下載次數: 47)
下載附件
2019-5-24 15:14 上傳
2、程序燒錄
打開零知開發工具,找到相應代碼即可。
零知界面.png (73.3 KB, 下載次數: 50)
下載附件
2019-5-24 15:15 上傳
界面.png (118.76 KB, 下載次數: 53)
下載附件
2019-5-24 15:15 上傳
3、核心代碼如下:
- /* I2C interface MPU6050 demo
- * powered by 零知實驗室
- */
- #include "MPU6050.h"
-
- // 默認I2C地址為 0x68
- // AD0 low = 0x68
- // AD0 high = 0x69
-
- MPU6050 accelgyro;
-
- int16_t ax, ay, az;//三軸加速度值
- int16_t gx, gy, gz;//三軸陀螺儀值
-
- float nax,nay,naz;
- float ngx,ngy,ngz;//轉換后的實際值
-
- #define LED_PIN LED_BUILTIN
- bool blinkState = false;
-
- void setup() {
-
- Serial.begin(9600);
-
- // MPU6050初始化設置
- Serial.println("Initializing I2C devices...");
- accelgyro.initialize();
-
- // verify connection
- Serial.println("Testing device connections...");
- if(accelgyro.testConnection()){
- Serial.println("MPU6050 connection successful");
- }else{
- Serial.println("MPU6050 connection failed");
- }
-
- //使用LED進行指示
- pinMode(LED_PIN, OUTPUT);
-
- // accelgyro.setFullScaleAccelRange(MPU6050_ACCEL_FS_16);//加速度參數
- // accelgyro.setFullScaleGyroRange(MPU6050_GYRO_FS_500);//陀螺儀
- }
-
- void loop() {
- // 獲取原始的數值:三軸加速度值和三軸陀螺儀數值
- accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
-
- // 分別獲取
- //accelgyro.getAcceleration(&ax, &ay, &az);
- //accelgyro.getRotation(&gx, &gy, &gz);
-
- // 顯示打印
- Serial.print(" acc:\t");
- Serial.print(ax); Serial.print("\t");
- Serial.print(ay); Serial.print("\t");
- Serial.print(az); Serial.print("\t");
- Serial.print("\t gyro:\t");
- Serial.print(gx); Serial.print("\t");
- Serial.print(gy); Serial.print("\t");
- Serial.println(gz);
-
- //實際數值轉換
- accelgyro.readNormalizeAccel(&nax,&nay,&naz);
- accelgyro.readNormalizeGyro(&ngx,&ngy,&ngz);
- Serial.print("Normalize acc:\t");
- Serial.print(nax); Serial.print("\t");
- Serial.print(nay); Serial.print("\t");
- Serial.print(naz); Serial.print("\t");
- Serial.print("\t Normalize gyro:\t");
- Serial.print(ngx); Serial.print("\t");
- Serial.print(ngy); Serial.print("\t");
- Serial.println(ngz);
-
- // blink LED to indicate activity
- blinkState = !blinkState;
- digitalWrite(LED_PIN, blinkState);
-
- delay(300);
- }
復制代碼 完整工程可到零知實驗室官網免費獲取。
4、當我們讀取到原始數值后需要進行轉換才能得到實際的值,完整代碼已經做了轉換,結果如下:
結果.png (169.95 KB, 下載次數: 51)
下載附件
2019-5-24 15:17 上傳
更多詳細資料可到零知實驗室官網免費獲取。
|
|