PID Controller experiment

Something I've been very curious about, so decided to extend the pitch/roll estimation code I'd wrote to drive a stablized servo. Seems to work pretty alright. When I twist the platform rapidly, it does overshoot a little before it stabilizes, and I think, apart from the PID code itself, could also be something to do with the settings of the accelerometer/gyro.