Interpolator - code, pseudocode, TODOs
same
Merge branch 'stabilize' of https://github.com/KITrokopter/Control-Application into stabilize