Added ISR handler for tacho motor on output port - needs work to make the IO access prettier