RP6 Servo Ansteuerung

[Christian3]

Hey,
ich habe den RP6 bekommen und habe so die grundsachen schon kapirt aber weil nur rumfahren nen bissel langweilig is will ich jetzt einen servo ansteuern. ich habe schon foren darüber gesehen aber habs Leider nicht hinbekommen da wollte ich mal fragen ob ihr mir das mal für dummies erklären können^^
lg
Christian

[Dirk]

Hallo Christian,

das ist hier im Forum schon sooo oft und einfach erklärt worden, geh 'mal zuerst auf die Suche!

Ergebnisse z.B.:

Grundwissen zu Servos im Wiki:
https://www.roboternetz.de/wissen/index.php/Servos

Langer Thread zur Servoansteuerung mit dem RP6:
https://www.roboternetz.de/phpBB2/viewtopic.php?t=34407

RP6Base: Library für 8 Servos:
https://www.roboternetz.de/phpBB2/viewtopic.php?t=45180

RP6Control: Library für 8 Servos:
https://www.roboternetz.de/phpBB2/viewtopic.php?t=45223

Gruß Dirk

[.:Robin:.]

hatte vor kurzem das gleiche problem... wenn du den Servo an ADC0 oder ADC1 anschließen willst dann mach es so:

1 : Rotes Kabel (Spannungsversorgung+, VDD)

2 : Schwarzes Kabel (Spannungsversorgung-, GND)

3 : Weißes Kabel (Impuls)

und jetzt kannste z.B. des als Code verwenden:

is en leicht veränderter code von radbruch:

 // Servoansteuerung mit sleep(), Servoimpuls an ADC0, 2 Positionen 10.1.09 mic

#include "RP6RobotBaseLib.h"

uint8_t i;

int main(void)
{
   initRobotBase();   // initialisieren
   DDRA |= 1;         // Datenrichtung Port A Bit 0 (das ist ADC0) auf Ausgang

   while(true)
   {
      for(i=0;i<100; i++) // 100 mal Impuls für Position 1 senden
      {
         PORTA |= 1;
         sleep(2);
         PORTA &= ~1;
         sleep(200-2);
      }
	  for(i=0;i<100; i++) // 100 mal Impuls für Position 2 senden
      {
         PORTA |= 1;
         sleep(12);
         PORTA &= ~1;
         sleep(200-12);
      }
      for(i=0;i<100; i++) // 100 mal Impuls für Position 3 senden
      {
         PORTA |= 1;
         sleep(20);
         PORTA &= ~1;
         sleep(200-20);
      }
	  for(i=0;i<100; i++) // 100 mal Impuls für Position 4 senden
      {
         PORTA |= 1;
         sleep(12);
         PORTA &= ~1;
         sleep(200-12);
      }
   }
   return(0);
}

[petzi--]

Ich hätte da mal eine Frage ,
ich habe mir vor kurzem auch einen rp6 gekauft
das grundsätzliche hab ich auch schon verstanden ,
jetzt möchte ich aber einen externen Motor mit dem RP6 steuern ,
des wäre nett wenn mir einer erklären könnte wo ich die Kabel auf dem Mainboard anlöten muss und wie man das dann programmiert...

[Dirk]

Hier ging's vor 3 Jahren mal um Servos!

[Christian3]

cool danke muss ich muss doch die "RP6RobotBaseLib.h" datei ändern oder ?

[radbruch]

Nein, die Library muss nicht geändert werden. Es wird (blockierend) die Sleep()-Funktion verwendet.

[Christian3]

OK ich habs hinbekommen =D>
wäre aber cool wenn er von limks nach rechts dreht und dan wieder zurück macht er aber ihrgent wie ned

#include "RP6RobotBaseLib.h" // The RP6 Robot Base Library.
// Defines:
#define SERVO_OUT SDA // PINC1 XBUS Pin 12


// Servo movement limits (depending on servo type):
#define LEFT_TOUCH 10//550 // Left servo touch
#define RIGHT_TOUCH 10 // Right servo touch [max. 255]
#define PULSE_ADJUST 10
#define PULSE_REPETITION 18 // Pulse repetition frequency
//Variablen
int richtung=0; //0=rechts; 1=links
int speed=10;
/*****************************************************************************/
// Functions:

/**
* INIT SERVO
*
* Call this once before using the servo task.
*
*/
void initSERVO(void)
{
DDRC |= SERVO_OUT; // SERVO_OUT -> OUTPUT
PORTC &= ~SERVO_OUT; // SERVO_OUT -> LO
startStopwatch1(); // Needed for 20ms pulse repetition
}
void pulseSERVO(uint8_t position)
{
cli();
PORTC |= SERVO_OUT; // SERVO_OUT -> HI (pulse start)
delayCycles(LEFT_TOUCH);
while (position--) 
{
delayCycles(PULSE_ADJUST);
}
PORTC &= ~SERVO_OUT; // SERVO_OUT -> LO (pulse end)
sei();
}
void task_SERVO(void)
{static uint8_t pos;
if (getStopwatch1() > PULSE_REPETITION) { // Pulse every ~20ms
if(richtung==0) pos=pos+speed;
else pos=pos-speed;
if (pos > RIGHT_TOUCH) {richtung = 1;} //nach links drechen
if (pos < LEFT_TOUCH) {richtung = 0;} //nach rechts drehen

pulseSERVO(pos);
setStopwatch1(0);
}
}

/*****************************************************************************/
// Main function - The program starts here:

int main(void)
{
initRobotBase();
powerON();//anschalten
startStopwatch1();
setLEDs(0b111111); // Turn all LEDs on
mSleep(500); // delay 500ms
setLEDs(0b000000); // All LEDs off

initSERVO();

while(true)
{
task_SERVO();
task_RP6System();

}
return 0;
}

[Christian3]

schon gut fehler gerunden sry

[Christian3]

Hey eine frage hätte ich noch wie kann ich den servo in eine bestimte position stehlen? also z.b das wen ich den rp6 starte des der servo automatich in die mittel stellung fährt?