以下为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中。
完整代码下载地址：
函数库.rar
(39.41 KB, 下载次数: 9)
|
QQ好友和群
QQ空间
腾讯微博
腾讯朋友
收藏
淘帖
顶
踩
