Strecke abmessen

[damaltor]

void Go(int distance, int speed)
{
	int enc_count = 0;
	int tot_count = 0;
	int diff = 0;
	int l_speed = speed, r_speed = speed;
	enc_count=abs(distance);
	
//	enc_count=distance*10000;
//	enc_count/=12823;
	
	Encoder_Set(0,0);		// reset encoder

	MotorSpeed(l_speed,r_speed);
	if(distance<0) MotorDir(RWD,RWD);
	else MotorDir(FWD,FWD);

	while(tot_count<enc_count) {
		tot_count += encoder[LEFT];
		diff = encoder[LEFT] - encoder[RIGHT];
		if (diff > 0) { //Left faster than right
			if ((l_speed > speed) || (r_speed > 244)) l_speed -= 10;
			else r_speed += 10;
		}
		if (diff < 0) { //Right faster than left
			if ((r_speed > speed) || (l_speed > 244)) r_speed -= 10;
			else l_speed += 10;
		}
	Encoder_Set(0,0);		// reset encoder
	MotorSpeed(l_speed,r_speed);
	Msleep(1);
	}
	MotorDir(BREAK,BREAK);
	Msleep(200);
}

so hier ist die go funktion... sie nimmt offensichtlich die werte an als die gezählten tiks.

ich glaub ich werd mal nen programm schreiben was die werte einfach ausgibt... bis gleich.