Rp6 - Fährt nicht ?!?

[Dirk]

@Philip:

... der Servo bewegt sich nicht

Das liegt daran, dass die move-Funktion die while(true)-Schleife so lange blockiert, bis die Bewegung abgeschlossen ist.
Die task_SERVO() braucht aber eine while(true)-Schleife, die permanent durchläuft und nur wenige ms dauert.

Eine Lösung wäre, die move-Funktion nicht BLOCKING zu machen (also: move(60, FWD, DIST_CM(30), NON_BLOCKING) ) und direkt hinter der move-Funktion einzufügen:

 while(!isMovementComplete()) 
 {
  task_checkINT0();
  task_I2CTWI();
  task_SERVO();
 }

Damit wird in der Schleife auch gewartet, bis die Bewegung beendet ist, aber trotzdem werden die 3 wichtigen Tasks aufgerufen.
Nicht getestet! Schlag mich nicht, wenn's nicht geht!

[AsuroPhilip]

Funktioniert aber (siehe code):

	while(true) 
	{ 
		
			    servo1_position = 40;
				move(60, FWD, DIST_CM(30), NON_BLOCKING); //wenn der Rp6 30cm gefahren soll der servo1 auf 150
				 while(!isMovementComplete()) 
 {
  task_checkINT0();
  task_I2CTWI();
  task_SERVO();
 }
	   	}
	return 0;
}

Kannst du mir auch sagen wie das geht?


mfG
Philip

[Dirk]

@Philip:

Kannst du mir auch sagen wie das geht?

Mit dem while-Block mache ich genau das Selbe, was in der Funktion move mit Parameter BLOCKING gemacht würde.

Sieh dir die Funktion move oder rotate in der RP6Control_I2CMasterLib.c an!
Am Ende dieser Funktionen findest du einen ganz ähnlichen while-Block, der nur dann aktiv ist, wenn man den BLOCKING Parameter benutzt hat. Er bewirkt, dass während die Funktion auf das Ende der Bewegung wartet, die wichtigen Tasks abgearbeitet werden.

Genau das mache ich dann in deinem Hauptprogramm und habe noch die task_SERVO() in den while-Block aufgenommen.