Timer ISR is working.
Motor speed is not updating correctly
Minh's working code
Delay is too long.