Brauche hilfe bei odometrie.

[Sim Robot]

ICh möchte , dass der Asuro überprüft, ob sich die Raäder drehen. main Programm sieht bis jetzt so aus aber es funktioniert nicht. Dies hat mich zwar nicht überrascht, aber ich habe auch keine Ideen mehr wie ich es zum Laufen bekommen könte.
Mein Programm:

#include <asuro.h>
		  
int main(void){
Init();
while (1){
OdometrieData(Data);
			if(Data[0]>511){
					Sleep(255);
					Sleep(105);
					OdometrieData(Data);
					if(Data[0]>511){
							SerWrite("motor dreht sich  nicht",0,23)
							}
					}
			
		
			OdometrieData(Data);
			if(Data[1]>511){
					Sleep(255);
					Sleep(105);
					OdometrieData(Data);
					if(Data[0]>511){
							SerWrite("Motor dreht sich nicht",0,23)
							}
					}
			
		
	}

}
	return 0;
}

wie krige cih das Programm zum Laufen???