Update drive formulae and motor power behavior
Now drive formulae (and all other functions modifying desiredMotorVals) are expected to set power between 0 and motorGetMaxReferencePower)
Motor.h scales power in motorScalePower to whatever the range the motors are in
Also tweaked drive formulae so that rotation and drive are handled equally - should make it handle better