Eigentlich hätte es mit Wait auch gehen müssen. Kannst ruhig mal größeres Wait "Wait 3" (3 Sekunden) oder so nehmen.
Du kannst mal einen fertigen Code wie du ihn nu hast posten, damit man weiter sehen kann.
Die Anzeige im Timer könnte eventuell zu lange dauern. Dadurch werden dann Interrupts vom Tachogenerator übersehen.