Improve Motor.h
Replace motor assignments with for loop (should work, found examples online)
Replace kNumbOfTotalMotors with a macro (makes it easier to change in future)