Go(); und Turn();

[damaltor]

tu mal hinter EncoderInit folgendes:

Encoder_Set(0,0);

und am besten auch vorjedes go und turn... damit wird der encoderzähler zurückgesetzt.