Probier es doch mal mit diesem minimal Programm:
Code:
Init(); 
Encoder_Init(); 
MotorDir(FWD,FWD); 
MotorSpeed(175,175); 
while(1){ 
	diff=encoder[RIGHT]-encoder[LEFT]; 
	MotorSpeed(175+diff,175-diff);
}