PIDController class

Wrote PIDController class and tested it in a simulation. Seems like it should work for stabilizing the quadcopter with the correct tuning.

Added member variables to Drive in preparation for including PIDController in the stabilization algorithm.