X-Git-Url: http://git.linex4red.de/pub/USBasp.git/blobdiff_plain/35dac470f243d234d72f34cbaeb1d6c8a15bc435..d1608d4af321529f0ddef9defcd97669ae9018c3:/Projects/AVRISP/Lib/ISP/ISPProtocol.h

diff --git a/Projects/AVRISP/Lib/ISP/ISPProtocol.h b/Projects/AVRISP/Lib/ISP/ISPProtocol.h
index 43c25c4fa..abbbf569d 100644
--- a/Projects/AVRISP/Lib/ISP/ISPProtocol.h
+++ b/Projects/AVRISP/Lib/ISP/ISPProtocol.h
@@ -72,17 +72,20 @@
 		 */
 		static inline void ISPProtocol_DelayMS(uint8_t DelayMS)
 		{
-			TCNT0 = 0;
-			TIFR0 = (1 << OCF1A);
+			OCR2A  = ((F_CPU / 64) / 1000);
+			TCCR2A = (1 << WGM01);
+			TCCR2B = ((1 << CS01) | (1 << CS00));			
 
 			while (DelayMS)
 			{
-				if (TIFR0 & (1 << OCF1A))
+				if (TIFR2 & (1 << OCF2A))
 				{
-					TIFR0 = (1 << OCF1A);
+					TIFR2 = (1 << OCF2A);
 					DelayMS--;
 				}
 			}
+			
+			TCCR2B = 0;			
 		}
 
 	/* Function Prototypes: */