以下為MPU6050姿態解鎖程序
為arduino板子的,運行的前提是需要將I^2Cdev庫函數MPU6050庫函數放置于arduino的libraries中,有些電腦在你放置于libraries后會自動被復制于我的文檔中,這會在檢測程序時自動告訴你某個庫函數有兩個地址,其中一個未運行。此時刪除剛才放置于arduino的libraries的那幾個庫函數即可,軟件會自動運行我的文檔中的程序。但未報錯請勿刪除!!!
- #include "Wire.h"
- #include "I2Cdev.h"
- #include "MPU6050.h"
- MPU6050 accelgyro;
- int16_t ax, ay, az;
- int16_t gx, gy, gz;
- bool blinkState = false;
- void setup() {
- Wire.begin();
- Serial.begin(38400);
- accelgyro.initialize();
- }
- void loop() {
- //加速度G量程范圍對應的最低有效位靈敏度,+、-2G 16384lsb;+、-4G 8192LSB;+、-8G 4096lsb;+、-16G 2048LSB.
- //角速度A量程范圍對應的最低有效位靈敏度,205度/S 131LSB;500度/S 65.5LSB;1000度/S 32.8LSB;2000度/S 16.4LSB.
- int g=2048;
- int a=131;
- accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
- Serial.print("a/g:\t");
- Serial.print(ax/a); Serial.print("\t");
- Serial.print(ay/a); Serial.print("\t");
- Serial.print(az/a); Serial.print("\t");
- Serial.print(gx/g); Serial.print("\t");
- Serial.print(gy/g); Serial.print("\t");
- Serial.println(gz/g);
- blinkState = !blinkState;
- }
復制代碼
同時需要注意的是,每個庫函數有兩個文件但后綴不同,所以一共四個全部需要復制進入arduino的libraries中。
0.png (4.79 KB, 下載次數: 95)
下載附件
2017-10-27 00:55 上傳
完整代碼下載地址:
函數庫.rar
(39.41 KB, 下載次數: 9)
2017-10-26 20:22 上傳
點擊文件名下載附件
mpu6050庫函數,I^2Cdev庫函數 下載積分: 黑幣 -5
|