Quadcopter stabilization algorithm

@sbright33

Im using the same algorithm for the PID as describe here Improving the Beginner’s PID – Introduction « Project Blog

Its working well for roll and pitch, but I have a lot of problem to stabilize on the yaw axis, did you succeed?