Work in progress - change to using an ISR and Timer1