As it turns out, manual control is /really hard/. Rough implementation is here; needs constants to make controls less impossible. I'm going to jump right into sensor messages coming back from the quad to work on fly-by-wire controller.