How to make MPU-6050 Accelerometer and Gyroscope Robot

In this project, I'm going to show you how to make a MPU6050 based small hand gesture robot. It only can rotate its head from your hand gest

BeginnerFull instructions provided1 hour2,659

How to make MPU-6050 Accelerometer and Gyroscope Robot

Things used in this project

Hardware components

Arduino UNO

SparkFun Triple Axis Accelerometer and Gyro Breakout - MPU-6050

UTSOURCE Electronic Parts

SG90 Micro-servo motor

Adafruit RGB Backlight LCD - 16x2

Jumper wires (generic)

Breadboard (generic)

Software apps and online services

Arduino IDE

Story

In this project, I'm going to show you how to make a MPU6050 based small hand gesture robot. It only can rotate its head from your hand gesture. Here I have fixed a servo motor to rotate where it can fix the angle by the gesture of your hand. as well as you can see the angle of your hand rotation through LCD display also.

MPU6050 is an IC 3-axis accelerometer and 3-axis gyroscope combined into one unit. It's also include temperature sensor DCM to perform complex tasks. It is commonly used in building drone, self balancing robots.

Thanks UTSOURCE.net to offer electronic components for my projects

An accelerometer is used to measure the acceleration. It can actually measure both dynamic and static acceleration of an object. for example You can see on smart phone, when you rotate the phone, it can sense that where it is on landscape or portrait.

A gyroscope is used to measure angular velocity that uses earth’s gravity to determine the orientation of the object in motion.

you can watch the tutorial from YouTube also

Components

1.Arduino uno

2. Servo motor

3. MPU6050

4. jumper wires

5. LCD display

click here to Download the library

Note: while you are making wire connection make sure to wire it properly. because I had faced some problem with the output that I had connected all the wire perfectly but circuit was very complex so I didn't see any changes in the values of angle and no any changes in servo motor's position. then when I make the circuit without any complex wiring as well as I could see output through my eyes.

Finally when you have done those wiring part then move into programming criteria. before going to upload the code please make sure to add the library into your Arduino library directory. you can add the library through add zip folder option in your Arduino IDE. then select the correct COM port and board type after click on Upload button to upload the code.

Hope You have like this post also keep share this post between your friends or family members who aspiring to make these kind of stuffs. and don't forget to press the subscribe button for my You Tube channel that I had provided above in this article.😊

Code

code

#include <Servo.h>                 //Include Servo Motor library for using Servo 
#include <LiquidCrystal.h>         //Include LCD library for using LCD 
#include <Wire.h>                  //Include WIre library for using I2C 
//#include <MPU6050.h>

LiquidCrystal lcd(2,3,4,5,6,7);   //Define LCD display pins RS,E,D4,D5,D6,D7

const int MPU_addr=0x68;         //I2C MPU6050 Address

Servo myservo;                  //myservo object for class servo 

int16_t axis_X,axis_Y,axis_Z;    

int minVal=265;
int maxVal=402;

double x;
double y;
double z;

int pos = 0;  

void setup()
{
  Wire.begin();                        //Begins I2C communication
  Wire.beginTransmission(MPU_addr);    //Begins Transmission with MPU6050
  Wire.write(0x6B);                    //Puts MPU6050 in Sleep Mode
  Wire.write(0);                       //Puts MPU6050 in power mode 
  Wire.endTransmission(true);          //Ends Trasmission
  
  myservo.attach(9);               //Servo PWM pin as 9 in UNO
  lcd.begin(16,2);                 //Sets LCD in 16X2 Mode
  lcd.print("BLACK KEYHOLE");   
  delay(1000);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("Arduino");
  lcd.setCursor(0,1);
  lcd.print("MPU6050");
  delay(2000);
  lcd.clear();
  Serial.begin(115200);
}

void loop()
{
  Wire.beginTransmission(MPU_addr); //Begins I2C transmission 
  Wire.write(0x3B);                 //Start with register 0x3B (ACCEL_XOUT_H)             
  Wire.endTransmission(false);
  Wire.requestFrom(MPU_addr,14,true); //Request 14 Registers from MPU6050
  
  axis_X=Wire.read()<<8|Wire.read(); //Obtain 0x3B (ACCEL_XOUT_H) & 0x3C (ACCEL_XOUT_L) 
  axis_Y=Wire.read()<<8|Wire.read(); //0x3B (ACCEL_YOUT_H) & 0x3C (ACCEL_YOUT_L)
  axis_Z=Wire.read()<<8|Wire.read(); //0x3B (ACCEL_ZOUT_H) & 0x3C (ACCEL_ZOUT_L)
    
    int xAng = map(axis_X,minVal,maxVal,-90,90); 
    int yAng = map(axis_Y,minVal,maxVal,-90,90);
    int zAng = map(axis_Z,minVal,maxVal,-90,90);

   x= RAD_TO_DEG * (atan2(-yAng, -zAng)+PI);     //Formula to calculate x values in degree
     int pos = map(x,0,180,0,180); // As X value is from 0 to 360 deg
     myservo.write(pos);           // Write angle obtained 0 to 180 to servo
     lcd.setCursor(0,0);
     lcd.print("Angle");
     lcd.setCursor(0,1);
     lcd.print(x); 
     Serial.println("Angle:");
     Serial.print(x);
     Serial.print('\n');               
     delay(500);
     lcd.clear();
}