Der Code sieht soweit ganz gut aus. Wie gesagt Kommentare wären schön Bild  
Das 2x "Wait 100" würde ich noch zusammenfassen. Und die If-Abfragen ruhig mal beschriften damit man weiß was die machen.