Merge pull request #7 from RasmusB/SW_RevA1

Added license and refactored
Resolves issue #6

Signed-off-by: RasmusB <RasmusB@users.noreply.github.com>
Merge branch 'master' of github.com:RasmusB/rbServo