PORTD.4=1; //Lenkung geht nach rechts

Du drehst da die Lenkung, aber sonst kommt portd.4 nirgends vor ?

Ausserdem mußt dun nach der while 200 Schleife "i" wieder auf Null setzen