Hallo die elegantere Lösung hat Dir schon der Sprinter genannt :

Du betreibst Timer1 besser in einem anderen Modus:
Clear Timer on Compare Match und bedienst nicht den Overflow-Interrupt, sondern den Compare Match Interrupt.

Dadurch übernimmt die Hardware das Neusetzen von Timer 1 und nicht wie in deinem Beispiel die Software.
Du verbrätst ja Zeit, bis du nach dem Interrupt wirklich dein Timer1-Wert neu schreibst.
Gruß Sebastian