Jarda Sládek - čas zpoždění sepnutí vstupů

/*
    Test spínání vstupů 2 a 3 proti GND
    na konzoli vypíše který byl sepnut
    první a o kolik se zpozdil ten druhý
*/

long cas1=0;
long cas2=0;
uint8_t ok1=0;
uint8_t ok2=0;

void setup() {
    Serial.begin(9600);
    pinMode(2, INPUT_PULLUP);
    pinMode(3, INPUT_PULLUP);
    pinMode(13, OUTPUT);
    Serial.println("Start - muzes testovat...");

    while (!ok1 || !ok2)
    {
        if (digitalRead(2)==0 && ok1==0)
        {
            ok1=1;
            cas1=millis();
        }
        if (digitalRead(3)==0 && ok2==0)
        {
            ok2=1;
            cas2=millis();
        }
    }
    digitalWrite(13, HIGH);
    Serial.println("Hotovo...");
    if (cas1 < cas2)
    {
        Serial.println("Prvni byl vstup 1");
        Serial.print  ("Cas2 je opozden o ");
        Serial.print  (cas2-cas1);
        Serial.println(" ms");
    }
    else
    {
        Serial.println("Prvni byl vstup 2");
        Serial.print  ("Cas1 je opozden o ");
        Serial.print  (cas1-cas2);
        Serial.println(" ms");
    }
}

void loop() {
    // Lautr hovno zde potřeba...
}