欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: 求助用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://m.raoushi.com/bbs/)