Replacing delay in timer callback to manual millis call