Lots of changed. See extended.

Typedefs added containing state of quad. Motor control properly
implemented with ESC calibration. Arming / disarming.