Test for stabilize

Wrote a test program for testing the physical movement of the quadcopter, as
proof of concept for keeping the quadcopter balanced around one axis of
rotation, and also for radio communication of motion values.
Merge branch 'master' of https://github.com/quadcopter5/quadcopter