Introduction: How to Measure Angle With MPU-6050(GY-521)

I will measure angle with an Arduino. We need some cables, an Arduino UNO and GY-521(MPU-6050) for measure angle.

Step 1: Connecting MPU-6050 to Arduino UNO

You need some male-female cables, an Arduino UNO and GY-521(MPU-6050) for measure angle. You have to connect MPU-6050 to Arduino UNO like in the picture. So,

  • VCC to 5V(MPU-6050 works with 3.3V but GY-521 increases it to 5V.),
  • GND to GND,
  • SCL to A5,
  • SDA to A4,
  • ADO to GND,
  • INT to digital pin 2.

Step 2: Code

Here is code. It uses I2C. I took some parts of code from internet.(I2C part)

//Written by Ahmet Burkay KIRNIK
//TR_CapaFenLisesi //Measure Angle with a MPU-6050(GY-521)

#include <Wire.h>

const int MPU_addr=0x68; int16_t AcX,AcY,AcZ,Tmp,GyX,GyY,GyZ;

int minVal=265; int maxVal=402;

double x; double y; double z;

void setup(){ Wire.begin(); Wire.beginTransmission(MPU_addr); Wire.write(0x6B); Wire.write(0); Wire.endTransmission(true); Serial.begin(9600); } void loop(){ Wire.beginTransmission(MPU_addr); Wire.write(0x3B); Wire.endTransmission(false); Wire.requestFrom(MPU_addr,14,true); AcX=Wire.read()<<8|Wire.read(); AcY=Wire.read()<<8|Wire.read(); AcZ=Wire.read()<<8|Wire.read(); int xAng = map(AcX,minVal,maxVal,-90,90); int yAng = map(AcY,minVal,maxVal,-90,90); int zAng = map(AcZ,minVal,maxVal,-90,90);

x= RAD_TO_DEG * (atan2(-yAng, -zAng)+PI); y= RAD_TO_DEG * (atan2(-xAng, -zAng)+PI); z= RAD_TO_DEG * (atan2(-yAng, -xAng)+PI);

Serial.print("AngleX= "); Serial.println(x);

Serial.print("AngleY= "); Serial.println(y);

Serial.print("AngleZ= "); Serial.println(z); Serial.println("-----------------------------------------"); delay(400); }

Step 3: Done!

It has finished! If it doesn't work, please leave a comment. By the way, my English is not so good, sorry for my bad English.

Ahmet Burkay KIRNIK

Istanbul/TURKEY

Comments

author
aporizga (author)2017-08-04

nice project

I have getting data in first time then I upload another sketch

after few time I upload this project nothing data why ?

author
BurkayKirnik (author)aporizga2017-08-04

I think this problem is coming from your hardware. Can you check your wires?

author
JakeK74 (author)2017-07-01

Hi Burkay, is it possible to have an LED light and a Piezo buzzer sound when a certain angle is reached?

author
BurkayKirnik (author)JakeK742017-07-03

Yes, it is! You have to add some lines to code to do this. I can help you if you want.

author
IshaqA1 (author)BurkayKirnik2017-07-09

would be awesome if you do a code for this

author
BurkayKirnik (author)IshaqA12017-07-09

contact me on e-mail. My email address: burkaykirnik@gmail.com

author
gabriel.lim_2015 (author)2016-10-03

HI, i got an error in compiling for your code, what should i do now? thanks

author

at the line #include

replace with # include<wire.h>

author

I edited the code and added wire.h. ty

author

tys

author
OraH2 (author)2017-04-28

I have a problem the sensor only measures 255 and doesnt change ?

author
BurkayKirnik (author)OraH22017-07-03

Maybe you connected a wire incorrect. Could you check it?

author
saadmaan made it! (author)2017-06-08

Thanks for getting me started with MPU6050. Works great.

a.jpg
author
mehdi kiani (author)2017-03-30

very good

author
FlavienB (author)2017-02-14

Hello, where from do you take the minVal and maxVal ?

author
MartinK189 made it! (author)2017-02-10

I wanted to test my MPU-6050. Thanks!

IMG_1036.jpg
author
BillD120 (author)2016-12-02

Thnx Mate! Great project to get me started with the MPU-6050(GY-521), worked perfect first time!

thnx

billd

PS. Your English is great, no need to apologies!

author
DIY Hacks and How Tos (author)2016-06-19

Cool project.I need to get some of these sensors and try them out.