Int value servo control and program flow


nointerupts(0);

frequency = 60*50/(millis() - timeold)*freqcount;


timeold = millis();
freqcount = 0;



//Restart the interrupt processing
Interrupts(0)

Like that?