fix delay/yield avr

Author: vbextreme

hardware/arduino/avr/cores/arduino/wiring.c

@@ -105,15 +105,15 @@ unsigned long micros() {
 
 void delay(unsigned long ms)
 {
-	uint16_t start = (uint16_t)micros();
-
-	while (ms > 0) {
-		yield();
-		if (((uint16_t)micros() - start) >= 1000) {
-			ms--;
-			start += 1000;
-		}
-	}
+        uint32_t start = (uint32_t)micros();
+
+        while (ms > 0) {
+            yield();
+            while ( ms > 0 && ((uint32_t)micros() - start) >= 1000) {
+                ms--;
+                start += 1000;
+            }
+        }
 }
 
 /* Delay for the given number of microseconds.  Assumes a 1, 8, 12, 16, 20 or 24 MHz clock. */