Quadcopter using MPU6050 and GY521

Hey guys so I have some problems I need some help with. So I have a code for this quadcopter project. We are able to send commands and make it spin up and down. It can do error correction (i think) but I am not too sure if it is doing it properly. Right now only the gyro is implemented and the accel isn't fully implemented. We are using a Kalman filter that we found and implemented it.

I am stuck at fully implementation of the accel.

  1. My question is how do I incorporate the values of the accel into the gyro values?
  2. What are ways of approaching on how to control it? We will be using a r/c controller and need some suggestions on controller boards.
  3. Easy reading on quadcopter stabilization and corrections?

Attached is the quadcopter code that my team has written. Thank you!

IMU_6050_v3.zip (10.3 KB)