Timer1Expired subroutine had bug computing next time value