warum liest du den wert über den AD Wandler ein ?
Wenn es schön rechteckig ist und zwischen 0 und 5V toogelt reicht es aus wenn du abfragst ob der Pin High oder Low ist. Das dürfte um einiges schneller gehen.
Auserdem zählst du keine Variable hoch, sondern dein Programm liest die gerade am AD0 pin anliegende Spannung ein und die vergleichst dann ob die Spannung größer 400 oder kleiner 400 ist.