Gyro Angle Calc - using Arduino Uno & IMU Breakout Board GY-521, MPU6050

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.

 

read more

[original story: Let's Make Robots]