Tachometer and interrupt, can I improve it?