calculate plane diff
stabilizie - calibration start
Merge branch 'stabilize' of https://github.com/KITrokopter/Control-Application into stabilize