Updated Motor functionality and small fixes.
Removed unneeded include.
Changed TimerInit to setup the timers to a slower frequency, it makes the motors run faster.
Also increased the resolution of the PWM and allowed setting motor speed using doubles.
Fixed Motor2Brake setting Motor1 OCR values.