Hallo,
mein Vorschlag war die LED Blinkerei erstmal mit millis zu programmieren ohne das blockierende delay. Denn das delay ist immer noch drin. Dadurch kann deine Pulslängenermittlung nicht funktionieren. Das solltest du auch noch nicht einbauen. Das do while brauchste auch nicht.
Erst muss die Arbeitsweise mit millis verstanden sein. Was ist millis? Was kann man damit sinnvoll anstellen? Links habe ich gegeben. Das ist Grundlage für alles was du später im Zusammenhang mit irgendwelchen sich zeitlich wiederholenden Abläufen machst. Ohne das dein gesamtes Programm blockiert. Dann kann zum Bsp. eine LED im 10s Takt blinken und dennoch wird jederzeit auf ein Tastendruck reagiert. Wäre aktuell nicht möglich mit delay und while. Bei dem Thema muss jeder durch damit das Verständnis der Arbeitsweise klar wird.