more safer and full speed step (remove sleep)

added a volatile for thread-safe and remove sleep(20)