Quadcopter stabilization algorithm

sbright33:
Ideas for improvement?

How are you measuring altitude, and what sort of accuracy in the altitude hold are you trying to achieve?