Hallo David,

in die while(true) Schleife müßtest du noch die task_SERVO aufnehmen und sagen, wie sich das Servo bewegen soll:

Code:
	startStopwatch2();					// Used for the demo
	
	while(true)  
	{
// ---------------------------------------------------------------------
// The demo code for positioning servo 1:
		if (getStopwatch2() > 48) {	// Change position every ~50ms
			servo1_position = pos;		// Position of servo 1
			pos++;						// Next position to the right
			if (pos > RIGHT_TOUCH) {pos = 0;} // pos: 0..RIGHT_TOUCH
			setStopwatch2(0);
		}
// ---------------------------------------------------------------------

		task_SERVO();			      
		deccelerate();			      
		task_RP6System();			      
	}
Gruß Dirk