Fix timer interrupt for 328