求助用arduino 读取 mpu6050数据结果串口一片白编译上传都没啥问题 -

标题: 求助用arduino 读取 mpu6050数据结果串口一片白编译上传都没啥问题 [打印本页]

作者: DLAM123 时间: 2020-6-23 17:16
标题: 求助用arduino 读取 mpu6050数据结果串口一片白编译上传都没啥问题

#include <Wire.h>
long accelX,accelY,accelZ;
float gForceX,gForceY,gForceZ;

long gyroX,gyroY,gyroZ;
float rotX,rotY,rotZ;

void setupMPU(){
Wire.beginTransmission(0b1101000);
Wire.write(0x6B);
Wire.write(0b00000000);
Wire.endTransmission(true);
Wire.beginTransmission(0b1101000);
Wire.write(0x1B);
Wire.write(0b00000000);
Wire.endTransmission(true);
Wire.beginTransmission(0b1101000);
Wire.write(0x1C);
Wire.write(0b00000000);
Wire.endTransmission(true);
}

void  recordAccelRegisters() {
Wire.beginTransmission(0b1101000);
Wire.write(0x3B);
Wire.endTransmission(true);
Wire.requestFrom(0b1101000,6);
while(Wire.available()<6);
accelX = Wire.read()<<8|Wire.read();
accelY = Wire.read()<<8|Wire.read();
accelZ = Wire.read()<<8|Wire.read();
processAccelData();
}

void  processAccelData(){
  gForceX = accelX / 16384.0;
  gForceY = accelY / 16384.0;
  gForceZ = accelZ / 16384.0;
}

void  recordGyroRegisters() {
  Wire.beginTransmission(0b1101000);
  Wire.write(0x43);
  Wire.endTransmission(true);
  Wire.requestFrom(0b1101000,6);
  while(Wire.available()<6);
  gyroX = Wire.read()<<8|Wire.read();
  gyroY = Wire.read()<<8|Wire.read();
  gyroZ = Wire.read()<<8|Wire.read();
  processGyroData();
}

void  processGyroData() {
  rotX = gyroX / 131.0;
  rotY = gyroY / 131.0;
  rotZ = gyroZ / 131.0;
}

void printData(){
  Serial.print("Gyro  （deg）");
  Serial.print(" X=");
  Serial.print("rotX");
  Serial.print(" Y=");
  Serial.print("rotY");
  Serial.print(" Z=");
  Serial.print("rotZ");
  Serial.print(" Accel (g)");
  Serial.print(" X=");
  Serial.print("gForceX");
  Serial.print(" Y=");
  Serial.print("gForceY");
  Serial.print(" Z=");
  Serial.println("gForceZ");
}

void setup() {
Serial.begin(9600);
Wire.begin();
setupMPU();
}

void loop() {
  recordAccelRegisters();
  recordGyroRegisters();
  printData();
  delay(100);
}

作者: DLAM123 时间: 2020-6-23 17:17
是程序哪里不对吗

欢迎光临 (http://www.51hei.com/bbs/)