add blocking function for smoother arm motion
+ some refactor stuff
+ added test-folders
Merge branch 'master' of https://github.com/kinectNao/rednao