Major refactoring
Finished refactoring
Moved Motor members to private
Merge pull request #1 from robotverkstan/master

Merge pull request #1 from antoneri/master
Merge pull request #2 from antoneri/master

Merge pull request #2 from antoneri/master