soweit ich das etz sehe zählt der timer mit startwert 158 also bis 97 quasi.
4MHz/1024(prescale)=3906,25Hz das geteilt durch 97 und du bist bei deinen 40,27Hz. wenn er jetzt 4 mal so schnell taktet, ergibt sich 161,1Hz, das sind etwa 6,2ms. (anstelle der 25ms)

wenn du den timer doppelt so lange laufen lässt (also mit startwert 61), solltest du anstelle der 25ms auf etwa 12,5ms kommen.