removing unused variables, restructuring code

removing id, adding Mutex, removing sendMovement.
mutex and stuff
cleaning header
moveUp
small fix
Merge branch 'master' of https://github.com/KITrokopter/Control-Application into daniela