Hallo,

vielleicht so:

unsigned long startzeit, stopzeit;

startzeit=Gettime(); // aktuelle Zeit seit Systemstart in 1/1000 Sek
stopzeit=startzeit+1000; // eine Sek später

und dann anstelle von

for(i=0;i<=5000;i++)

ein

while (stopzeit > Gettime()) // Ausführen bis stopzeit erreicht

Gruß

mic