Yun Jin YongSeonggyu Oh이하늘gledel
Published

Makers (Cubecon) #2 Gyro Sensor & Bluetooth

A Bongilcheon High School Makers club's team project.

BeginnerWork in progress1 hour4,217
Makers (Cubecon) #2 Gyro Sensor & Bluetooth

Things used in this project

Hardware components

Arduino Nano R3
Arduino Nano R3
×2
Breadboard (generic)
Breadboard (generic)
×2
Arduino MPU-6050
×1
HC-06 Bluetooth Module
×2
Arduino RGB LED
×2

Software apps and online services

Arduino IDE
Arduino IDE

Story

Read more

Schematics

Gyro Sensor_Bluetooth_RGB LED

Bluetooth_RGB LED

Code

Gyro Sensor_Bluetooth_RGB LED

Arduino
#include<Wire.h>
#include<SoftwareSerial.h>

SoftwareSerial btSerial(7, 8);

const int MPU_addr = 0x68; 
int16_t GyX, GyY, GyZ; 
int red = 6;
int green = 5;
int blue = 4;

void setup() {
  Wire.begin(); 
  Wire.beginTransmission(MPU_addr); 
  Wire.write(0x6B);  
  Wire.write(0); 
  Wire.endTransmission(true); 
  Serial.begin(9600);
  btSerial.begin(9600);
  pinMode(red, OUTPUT);
  pinMode(green, OUTPUT);
  pinMode(blue, OUTPUT);
}

void loop() {
  gyro();
  led();
}

void gyro() {
  Wire.beginTransmission(MPU_addr);
  Wire.write(0x3B); 
  Wire.endTransmission(false);
  Wire.requestFrom(MPU_addr, 14, true);
  GyX = Wire.read() << 8|Wire.read(); 
  GyY = Wire.read() << 8|Wire.read(); 
  GyZ = Wire.read() << 8|Wire.read();
  GyX = GyX / 100; 
  GyY = GyY / 100;
  GyZ = GyZ / 100;
  Serial.print(F("gyro x,y,z : "));
  Serial.print("| GyX = ");
  Serial.print(GyX);
  Serial.print("| GyY = ");
  Serial.print(GyY);
  Serial.print("| GyZ = ");
  Serial.print(GyZ);
  Serial.println();
  delay(300);
}

void led() {
    if (GyX >= -20 && GyX <= -10) {
    if (GyY >= -10 && GyY <= 0) {
    if (GyZ >= 145 && GyZ <= 155) {
      btSerial.write('A');
      digitalWrite(red, HIGH);
      digitalWrite(green, HIGH);
      digitalWrite(blue, HIGH);
  }
  }
  }
    else if (GyX >= 0 && GyX <= 10) {
    if (GyY >= -175 && GyY <= -165) {
    if (GyZ >= -20 && GyZ <= -10) {
      btSerial.write('B');
      digitalWrite(red, HIGH);
      digitalWrite(green, LOW);
      digitalWrite(blue, LOW);
  }
  }
  }
    else if (GyX >= 165 && GyX <= 175) {
    if (GyY >= -10 && GyY <= 0) {
    if (GyZ >= 10 && GyZ <= 20) {
      btSerial.write('C');
      digitalWrite(red, LOW);
      digitalWrite(green, HIGH);
      digitalWrite(blue, LOW);
  }
  }
  }
    else if (GyX >= -155 && GyX <= -145) {
    if (GyY >= -5 && GyY <= 5) {
    if (GyZ >= -40 && GyZ <= -30) {
      btSerial.write('D');
      digitalWrite(red, LOW);
      digitalWrite(green, LOW);
      digitalWrite(blue, HIGH);
  }
  }
  }
  else {
    btSerial.write('X');
    digitalWrite(red, LOW);
    digitalWrite(green, LOW);
    digitalWrite(blue, LOW);
  }
}

Bluetooth_RGB LED

Arduino
#include <SoftwareSerial.h>

SoftwareSerial btSerial(7, 8);

int red = 6;
int green = 5;
int blue = 4;

void setup() {
  Serial.begin(9600);
  btSerial.begin(9600);
  pinMode(red, OUTPUT);
  pinMode(green, OUTPUT);
  pinMode(blue, OUTPUT);
}
void loop() {
  byte data;
  data = btSerial.read();
  if(data == 'A') {
    digitalWrite(red, HIGH);
    digitalWrite(green, HIGH);
    digitalWrite(blue, HIGH);
  }
  else if(data == 'B') {
    digitalWrite(red, HIGH);
    digitalWrite(green, LOW);
    digitalWrite(blue, LOW);
  }
  else if(data == 'C') {
    digitalWrite(red, LOW);
    digitalWrite(green, HIGH);
    digitalWrite(blue, LOW);
  }
  else if(data == 'D') {
    digitalWrite(red, LOW);
    digitalWrite(green, LOW);
    digitalWrite(blue, HIGH);
  }
  else if(data == 'X') {
    digitalWrite(red, LOW);
    digitalWrite(green, LOW);
    digitalWrite(blue, LOW);
  }
}

Credits

Yun Jin Yong

Yun Jin Yong

6 projects • 10 followers
Seonggyu Oh

Seonggyu Oh

5 projects • 1 follower
이하늘

이하늘

5 projects • 3 followers
gledel

gledel

100 projects • 115 followers
Looking back on my childhood, I was happy when I was making something and I was proud of myself. "Making is instinct!"

Comments

Related channels and tags