Arduino - Verhalten bei Servoansteuerung

[Peter B. (Gast)]

Hallo zusammen.

ich beschäftige mich seit ein paar Tagen mit einem kleinen Roboter, der 
aus vier Modellbauservos zusammengebaut wurde.
Die einzelnen "Gelenke" (Servos) habe ich entsprechend der menschlichen 
Anatomie bezeichnet (siehe Code).
Da die mitgelieferte Lib des Arduino Uno keine Möglichkeit bietet, die 
Servos langsamer/schneller an die gewünschte Position zu fahren, habe 
ich eine Routine "moveServo" geschrieben.
Diese Routine verhält sich aber nicht so, wie sie soll.

Ersetze ich z.B. alle Routinenaufrufe mit dem von Arduino 
bereitgestellten "SERVO.write(x)", funktioniert alles bestens. Ersetze 
ich es durch meine Routine, reagiert nach dem Flashen kein einziges 
Servo.

Wo liegt bei mir das Problem im Code?

Wiegesagt, mit  .write() funktioniert alles.

Hier der Code:

#include <Servo.h>

Servo Drehservo, Hauptarm, Ellenbogen, Hand;


void setup() 
{
    Drehservo.attach(8);
    Hauptarm.attach(9);
    Ellenbogen.attach(10);
    Hand.attach(11);
}


void moveServo(int number, int degrees, int speed)
{
    switch (number)
    {
      case 0:
              for(int i = 0; i <= degrees; i++)
              {
                 Drehservo.write(i);
                 delay(speed);
                 break;
              }

      case 1:
              for(int i = 0; i <= degrees; i++)
              {
                 Hauptarm.write(i);
                 delay(speed);
                 break;
              }

      case 2:
              for(int i = 0; i <= degrees; i++)
              {
                 Ellenbogen.write(i);
                 delay(speed);
                 break;
              }

      case 3:
              for(int i = 0; i <= degrees; i++)
              {
                 Hand.write(i);
                 delay(speed);
                 break;
              }
       
    }
    delay(20);
}

void loop() 
{   
     moveServo(2,100,50);
     moveServo(3,25,20);
     delay(4000);
}

Vielen Dank!

[Matthias S. (Firma: matzetronics) (mschoeldgen)]

Peter B. schrieb:
> for(int i = 0; i <= degrees; i++)
>               {
>                  Drehservo.write(i);
>                  delay(speed);
>                  break;
>               }

Und nu? Das break; sorgt dafür, das du nach dem Schreiben von i=0 die 
Schleife verlässt. Lass das also mal weg.

Übrigens startet dein Servo so immer von 0. Besser wäre es vermutlich, 
einmal alle Servos definiert auf einen Wert zu fahren, und sich den 
letzten Wert zu merken. Deine 'for' Schleife startet dann mit diesem 
Wert und fährt vor oder zurück, je nachdem, ob der neue Wert grösser 
oder kleiner ist als die letzte Position.
Ist die Position erreicht, Wert merken und als Startpunkt für die 
nächste Bewegung benutzen.
Gleichzeitig können so allerdings die Servos nicht bedient werden, da 
immer nur eins in der for Schleife hängt.

[Peter B. (Gast)]

Ah, danke!
Das 'break' sollte natürlich außerhalb der for-Schleife stehen und sich 
auf die switch-case-Anweisung beziehen.

Ich teste es gleich mal..