This is my first draft of work on flight control. More to come.

Please dont merge yet.