Simplifying code to use one timer for STEP