|
|
以下為MPU6050姿態(tài)解鎖程序
為arduino板子的，運行的前提是需要將I^2Cdev庫函數(shù)MPU6050庫函數(shù)放置于arduino的libraries中，有些電腦在你放置于libraries后會自動被復(fù)制于我的文檔中，這會在檢測程序時自動告訴你某個庫函數(shù)有兩個地址，其中一個未運行。此時刪除剛才放置于arduino的libraries的那幾個庫函數(shù)即可，軟件會自動運行我的文檔中的程序。但未報錯請勿刪除！！！
- #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;
- }
同時需要注意的是，每個庫函數(shù)有兩個文件但后綴不同，所以一共四個全部需要復(fù)制進入arduino的libraries中。
完整代碼下載地址：
函數(shù)庫.rar
(39.41 KB, 下載次數(shù): 9)
2017-10-26 20:22 上傳
點擊文件名下載附件
mpu6050庫函數(shù)，I^2Cdev庫函數(shù)
|
評分
-
查看全部評分
|
