updatePositions - cleanup of lists todo
Merge branch 'stabilize' of https://github.com/KITrokopter/Control-Application into stabilize