Merge pull request #38 from lomempow/onboardcom

Initial work on master and slave routines
Merge pull request #40 from lomempow/onboardcom

On motor code: OOP-style
Merge remote-tracking branch 'origin/onboardcom' into onboardcom
Speed control with timer interrupt fixed