Interpolator fix
Merge branch 'stabilize' of https://github.com/KITrokopter/Control-Application into stabilize