Basic Throttle/Thrust and Z motion working.

Can fly up and fall down with the quad.
Linear acceleration calculation has been verified.

Linear acceleration and integrating for velocity and position has now
been verified. Performed roll, pitch, and yaw tests by setting initial
orientations and then providing throttle inputs.
Added aerodynamic drag model.

Poor mans drag model added. Refactoring still needed.