Erste Idee für das Programm

Veröffentlicht von

Hier mal die Erste idee, wie die Servo’s nach und nach angesteuert werden können.

Servo servo_1;
Servo servo_2;
Servo servo_3;

// das ist noch nicht eingebaut, kommt im nächsten Schritt
// int aktuellePosServo_1 = 20;
// int aktuellePosServo_2 = 180;
// int aktuellePosServo_3 = 20;
 
void setup() {
    Serial.begin(9600);
    servo_1.attach(9);
    servo_2.attach(9);
    servo_3.attach(9);
}
 
void loop() {
   // das "millis()" zählt die Laufzeit des Arduino's, in millisekunden

   delay(15); // das ist damit der Servo Zeit hat, um seine Position anzufahren
   
   // Erste Bewegungs-Gruppe
   if (millis() <= 1000) {
      int startPosServo_1 = 20;
      int startPosServo_2 = 180;

      Serial.println("1");
      if(startPosServo_1 <= 180){
        servo_1.write(startPosServo_1);  
      }
      
      if(startPosServo_2 >= 20){
        servo_2.write(startPosServo_2);  
      }
      
      startPosServo_1++;
      startPosServo_2++;       
   }

   // zweite Bewegungs-Gruppe
   if (millis() >= 500 && millis() <= 1500 ) {
      int startPosServo_3 = 20;

      if(startPosServo_3 <= 180){
        servo_1.write(startPosServo_3);  
      }

      startPosServo_3++;     
   }

   // dritte Bewegungs-Gruppe
   if (millis() >= 1001 && millis() <= 2000 ) {
      int startPosServo_1 = 20;
      int startPosServo_2 = 180;

      Serial.println("1");
      if(startPosServo_1 <= 180){
        servo_1.write(startPosServo_1);  
      }
      
      if(startPosServo_2 >= 20){
        servo_2.write(startPosServo_2);  
      }
      
      startPosServo_1++;
      startPosServo_2++;       
   }
}