|
以下為MPU6050姿態(tài)解鎖程序
為arduino板子的,運(yùn)行的前提是需要將I^2Cdev庫函數(shù)MPU6050庫函數(shù)放置于arduino的libraries中,有些電腦在你放置于libraries后會自動被復(fù)制于我的文檔中,這會在檢測程序時自動告訴你某個庫函數(shù)有兩個地址,其中一個未運(yùn)行。此時刪除剛才放置于arduino的libraries的那幾個庫函數(shù)即可,軟件會自動運(yùn)行我的文檔中的程序。但未報錯請勿刪除!。
- #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量程范圍對應(yīng)的最低有效位靈敏度,+、-2G 16384lsb;+、-4G 8192LSB;+、-8G 4096lsb;+、-16G 2048LSB.
- //角速度A量程范圍對應(yīng)的最低有效位靈敏度,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;
- }
復(fù)制代碼
同時需要注意的是,每個庫函數(shù)有兩個文件但后綴不同,所以一共四個全部需要復(fù)制進(jìn)入arduino的libraries中。
完整代碼下載地址:
函數(shù)庫.rar
(39.41 KB, 下載次數(shù): 9)
2017-10-26 20:22 上傳
點(diǎn)擊文件名下載附件
mpu6050庫函數(shù),I^2Cdev庫函數(shù)
|
評分
-
查看全部評分
|