Arduino pin low süresi okuma ve dallanma?

volatile unsigned int sayac = 0;
const uint8_t kirmizi = PD2,sari = PD3, yesil = PD4,mavi = PD5,sensor = PD7;

const int kirmizi_alt_limit = 100,kirmizi_ust_limit = 130;
const int sari_alt_limit = 130,sari_ust_limit = 150;
//Alt limit ve üst limitler buraya eklenecek

void setup() {
  DDRD = (1<<kirmizi)|(1<<sari)|(1<<yesil)|(1<<mavi);
  TCCR1A = 0;    
  TCCR1B = 0x0C;
  TCNT1 = 0;    
  OCR1A = 625;  
  TIMSK1 = 0x02;
  sei();          
}

void loop() {

}

ISR(TIMER1_COMPA_vect){
  //digitalWrite fonksiyonu çok fazla işlemci cycle i tükettiği içi
  // doğrudan portd registerina yazmak gerekli
  //timer kesmeleri mümkün olduğunca kısa olmalıdır

  if(PIND & (1<<sensor)){
    sayac++;
    if(sayac >= kirmizi_alt_limit && sayac <= kirmizi_ust_limit)
      PORTD = (1<<kirmizi);
    if(sayac >= sari_alt_limit && sayac <= sari_ust_limit)
      PORTD = (1<<sari);
    //Diğer ledler için aynıları eklenecek
  }
  else{
    PORTD = 0;
    sayac = 0;
  }
}

unsigned long zamanBas = 0;
unsigned long zamanSon= 0;
unsigned long sure = 0;
int inputpin= 3;// sensör çıkış,engel yoksa sıfır.
int Kirmizi= 4;
int Yesil= 5;

void setup() {
    pinMode(inputpin,INPUT);
    pinMode(Kirmizi,OUTPUT);
    pinMode(Yesil,OUTPUT);
    zamanBas=0;
    zamanSon=0;
    sure=0;
  }
void loop()
{
kontrol:
  
    if (digitalRead(inputpin)==1)
    goto basla;
    goto kontrol;

basla:
    zamanSon = millis();
    sure = (zamanSon-zamanBas);
    zamanBas = zamanSon;

//***********1. kontrol
    if (sure<3000){
        digitalWrite(Kirmizi, 1);
        goto altprog;
    }
    else
    {
        digitalWrite(Kirmizi, 0);
    }
    
//**********2. kontrol
    if (sure<10000){
        digitalWrite(Yesil, 1);
        goto altprog;
    }
        else
    {
        digitalWrite(Yesil, 0);
    }
altprog:
  
    if (digitalRead(inputpin) == 0)
    {
        goto kontrol;
    }
        goto altprog;
}