Problema con mia creazione Robot

e questo

tempoMot=millis();//azzera il cronometro

lo aggiorni solo nel caso in cui sia maggiore di 1500
quindi il primo if lavora su un tempo totale di 1800 ( 300 per arrivare a 1500 + altri 1200)