Add TimerIntRegister to Servo library

Timer ISR registered through TimerIntRegister rather
than hardcoded in the vector table