[ WIP ] Accidentally lost functions: setPitch & setRoll. Replace them.
Dont forget about elevon mixing.