Update Motor.h
Fix bug with referencing wrong number of motors (should be
kNumbOfTotalMotors)
Add a getMaxDrivePower fn
Add casts to tMotor