零知开源分享 - MPU6050六轴数据输出 -

/* I2C interface MPU6050 demo
* powered by 零知实验室
*/
#include "MPU6050.h"
// 默认I2C地址为 0x68
// AD0 low = 0x68
// AD0 high = 0x69
MPU6050 accelgyro;
int16_t ax, ay, az;//三轴加速度值
int16_t gx, gy, gz;//三轴陀螺仪值
float nax,nay,naz;
float ngx,ngy,ngz;//转换后的实际值
#define LED_PIN LED_BUILTIN
bool blinkState = false;
void setup() {
Serial.begin(9600);
// MPU6050初始化设置
Serial.println("Initializing I2C devices...");
accelgyro.initialize();
// verify connection
Serial.println("Testing device connections...");
if(accelgyro.testConnection()){
Serial.println("MPU6050 connection successful");
}else{
Serial.println("MPU6050 connection failed");
}
//使用LED进行指示
pinMode(LED_PIN, OUTPUT);
// accelgyro.setFullScaleAccelRange(MPU6050_ACCEL_FS_16);//加速度参数
// accelgyro.setFullScaleGyroRange(MPU6050_GYRO_FS_500);//陀螺仪
}
void loop() {
// 获取原始的数值：三轴加速度值和三轴陀螺仪数值
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
// 分别获取
//accelgyro.getAcceleration(&ax, &ay, &az);
//accelgyro.getRotation(&gx, &gy, &gz);
// 显示打印
Serial.print(" acc:\t");
Serial.print(ax); Serial.print("\t");
Serial.print(ay); Serial.print("\t");
Serial.print(az); Serial.print("\t");
Serial.print("\t gyro:\t");
Serial.print(gx); Serial.print("\t");
Serial.print(gy); Serial.print("\t");
Serial.println(gz);
//实际数值转换
accelgyro.readNormalizeAccel(&nax,&nay,&naz);
accelgyro.readNormalizeGyro(&ngx,&ngy,&ngz);
Serial.print("Normalize acc:\t");
Serial.print(nax); Serial.print("\t");
Serial.print(nay); Serial.print("\t");
Serial.print(naz); Serial.print("\t");
Serial.print("\t Normalize gyro:\t");
Serial.print(ngx); Serial.print("\t");
Serial.print(ngy); Serial.print("\t");
Serial.println(ngz);
// blink LED to indicate activity
blinkState = !blinkState;
digitalWrite(LED_PIN, blinkState);
delay(300);
}

复制代码