Servo 3 positionen anfahren lassen

[Christian3]

Hallo,
ich habe hier in RN folgenen code gefunden:

#include "RP6RobotBaseLib.h" 
uint16_t servopos = 20; 

void servotrim(void) 
{ 
   setLEDs(1); 
   sleep(servopos); 
   setLEDs(0); 
   sleep(200-servopos); 
} 

void servoposi(void) 
{ 
   if(servopos==10) 
   { 
      while(servopos != 20) 
      { 
         servopos++; 
         servotrim(); 
         mSleep(50); 
      } 
   } 
   else if(servopos==20) 
   { 
      while(servopos != 10) 
      { 
         servopos--; 
         servotrim(); 
         mSleep(50); 
      } 
   } 
} 

int main (void) 
{ 
   initRobotBase(); 
   while (true) 
   { 
      task_RP6System(); 
      servoposi(); 
   } 
   return 0; 
}

so jetzt wollte ich das der servo 3 positionen anfährt
das hab ich auch probiert selber hinzukrigen aber bei mir
hat der nur einmal alle 3 posi angefahren und dann wieder nur
2 posi könnt ihr mir fehlen? der servo soll posi 10 dan 15 und dann 20 anfahren.
LG
Christian