Changed back _delay_us to _delay_ms, as it does not wait long enough
else...