Timer4 on Leonardo

Have you considered just using the MsTimer2 library which already handles Timer4 on Leonardo?

http://playground.arduino.cc/Main/MsTimer2

That is, using it on the Leonardo works fine, as it substitutes Timer4 for Timer2