Программирование Arduino с несколькими циклами

Я пытался запрограммировать Arduino (вместе с подключенным контроллером двигателя) для переключения с цикла на цикл с помощью этой программы. Однако это не работает. Там все еще много места для хранения и динамической памяти, так что это не проблема. Это программа:

int EnablePin1 = 8;
int duty;
int period;
int cycle;

int PWMPinA1 = 11;  
int PWMPinB1 = 3;
int PWMPinA3 = 6;  
int PWMPinB3 = 5;

const byte CPin1 = A0;  

int CRaw1;      
void setup() {

    Serial.begin(9600);

    pinMode(EnablePin1, OUTPUT);

    pinMode(PWMPinA1, OUTPUT);
    pinMode(PWMPinB1, OUTPUT);
    pinMode(PWMPinA3, OUTPUT);
    pinMode(PWMPinB3, OUTPUT);

}

void loop() {
    digitalWrite(EnablePin1, HIGH); //включаем плату
    for (duty = 0; duty <= 255; duty += 15) 
    {

        analogWrite(PWMPinB1, 0); //Установить контакт B в 0, когда скорость записывается на контакт A

        analogWrite(PWMPinA1, 255);
        delay(850);
        if (PWMPinA1 == 11)
        {
            PWMPinA1 = 3;
            PWMPinB1 = 11;
        }
        else
        {
            PWMPinA1 = 11;
            PWMPinB1 = 3;
        }
   }
   analogWrite(PWMPinA1,0);//конец на максимальной скорости
   analogWrite(PWMPinB1,0);
   CRaw1 = analogRead(CPin1);

   Serial.println("Feedback");

   Serial.print(CRaw1);


   delay(2000);
   // аналоговая запись (PWMPinB3, 0);
   for (duty = 255; duty >= 0; duty -= 51) // скорость замедления
   {
       //аналоговая запись(PWMPinA1, долг);
       analogWrite(PWMPinB3, 0);
       analogWrite(PWMPinA3, 255);
       delay(period);
       // задержка (цикл);
       if(PWMPinA3 == 6)
       {
           PWMPinA3 = 5;
           PWMPinB3 = 6;
           // период = 850;
       }
       else
       {
           PWMPinA3 = 6;
           PWMPinB3 = 5;
          //период = 2500;
       }
   }
   analogWrite(PWMPinA3, 0); // устанавливаем скорость 0
   analogWrite(PWMPinB3, 0);
   delay(2000);

   digitalWrite(EnablePin1, LOW);// Переключить, чтобы сбросить чипы питания, если у нас была ошибка перегрузки по току или перегреву

   for (cycle = 1000; cycle < 9000; cycle += 4000) 
   {
       //цикл=период;
       period=cycle;
   }

 /*for (cycle = 2000; cycle <= 3000; cycle += 1000) 
   {
       //цикл=период;
       period=10000;
   }*/
   for (cycle = 9000; cycle >= 1000; cycle -= 8000) 
   {
       period=0;
   }

   // задержка (2000); // Поменяйте контакты местами, чтобы заставить двигатель изменить направление

}//конец основного цикла

Я также пытался сделать так, чтобы циклы циклов были такими:

 for (cycle = 0; cycle < 9000; cycle += 3000) 
 {
     //cycle=period;
     period=cycle;
 }
 for (cycle = 9000; cycle >= 0; cycle -= 9000) 
 {
     //cycle=period/3;
     period=cycle;
 }

Но это ничего не дало (я вижу, что выводы ШИМ питаются от светодиодов, и при первой попытке светодиоды загорелись только на 1 секунду, а при второй вообще не загорелись.