MPU6050 IMU - Gyro angle calc for balancing robot

Primary image

What does it do?

Balancing RObot

I'm building a balancing robot using Arduino Uno & a MPU6050 IMU.

I've never programed anything before so naturally I'm struggling a bit.

I've got some code that calculates an angle from the accelerometer reading & I need to do the same for the gyro reading to feed into a complimentary filter. However it's not working & I haven't figured out why. (I've used the lirbray built by Jeff Rowberg and some of his code too).

Please have a look at the code attached & see if you can help me out a little. 


Cost to build

Embedded video

Finished project


Time to build


URL to more information


read more

[original story: Let's Make Robots]