Printing error message if not successful by now
Added initial bibtex file for used references
fixed freezing of arm
removed Fingercheck in isArmMoving