最近在研究四轴飞行器的问题,仔细看了几篇帖子,然后用弘毅老师的这个代码做实验,发现一个很奇怪的现象,就是mpu6050刚开始的一段时间输出的数据还很正常,但是到了后面输出就会全部变成0。代码如下,请不吝赐教!
#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
MPU6050 accelgyro;
int16_t ax, ay, az;
int16_t gx, gy, gz;
char str[512];
void setup() {
Wire.begin();
Serial.begin(9600);
accelgyro.initialize();
}
void loop() {
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
sprintf(str, "%d,%d,%d,%d,%d,%d,%d", ax, ay, az, gx, gy, gz);
Serial.print(str);
Serial.write(byte(10));
delay(50);
} |