added stop command + original firmware motion commands
added javadoc
added javadoc
smaller refactorings + java doc