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

[radbruch]

Hallo

Da hast du eine meiner Jugendsünden ausgegraben. Das waren meine ersten Versuche mit Servos :)

Vielleicht funktioniert es so, ich habe es nicht getestet:

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

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

void servoposi(uint8_t servosoll)
{
	uint8_t i;

	while(servopos != servosoll)
	{
		if(servopos<servosoll) servopos++; else servopos--;
      servotrim();
      // mSleep(50);
      // was das mSleep() hier soll weiß ich auch nicht mehr genau
      // richtiger wäre servotrim() mehrfach aufzurufen um dem
		// Servo genug Zeit zu geben die neue Position anzufahren:
      for(i=0; i<5; i++) servotrim();
	}
}

int main (void)
{
   initRobotBase();
   while (true)
   {
      //task_RP6System();
      servoposi(10);
      servoposi(15);
      servoposi(20);
   }
   return 0;
}

Gruß

mic

[Christian3]

werde es testen DANKE!
zu:
Da hast du eine meiner Jugendsünden ausgegraben
lol naja ich find das is die einfaste servo steuerung die ich bisjetzt gesehen hab
LG