das problem liegt an dem ganzen zeugs was bei der if abfrage ausgeführt wirdl.
probier mal obs geht, wenn du erst noch encoderset(0,0) aufurfst.

wenn nich könntest du doch auch einfach go unt turn hernehmen.