Improved robot model and refactored motor class.