센서 인식 테스트

Tester

STL files

• BalanceTester Bottom
• BalanceTester Body
• BalanceTester Wing

Circuit

Arduino

#include "MPU6050_DMP6.h"

void setup() {
  Serial.begin(9600);

  int mpuInit = mpuSetup();
  if (mpuInit == 0) {
    Serial.println("MPU6050 connected");
  } else {
    Serial.print("DMP Init Fail(");
    Serial.print(mpuInit);
    Serial.println(")");
  }
}

void loop() {
  mpuLoop();

  float roll = mpuRoll();

  Serial.print("Angle: ");
  Serial.println(roll);

  delay(50);
}

Result