dobrý den, tak přesně jak píše kiRRow, úplně mi vypadlo to, že nemám v mode5 výpisy  

 , čučel jsem do toho asi dlouho. Takže,  mode5 se už zobrazuje a servo v něm se vrtí . Doplnil jsem ještě při stisknutí tlačítka Up / Down výpisy na lcd displej, tak nějaké výpisy na seriový monitor - např. stupně natočení serva. Když jsem napsal do mode5 podmínku
 
, stalo se, že jsem mohl při stisknutí tlačítka UP řídit servo nahoru a kdykoliv ho zastavit ? podobné u řízení serva dolů. Když tam podmínka nebyla servo jezdilo nahoru nebo dolů od např. 5 do 175 stupňů, protože nechtěl jsem jezdit na dorazy serva. Tady je kod, ve kterém je přidáno mode = 5 pro servo, které je řízeno tlačítkem nahoru UP a dolů Down s výpisy na lcd a seriový monitor. 
Kód: Vybrat vše
#define buttonSelectUp 2   // číslo pinu tlačítka SELECT pro výběr MODE nahoru
#define buttonStart 3   // číslo pinu tlačítka START/STOP - červené
#define buttonSelectDown 4   // číslo pinu tlačítka pro výběr MODE dolů
#define LED1  10    // číslo pinu LED1 zelená
#define LED2  11    // číslo pinu LED2 červená
#include <Wire.h>   // knihovny pro LCD přes I2C
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27, 20, 4);   // nastavení adresy I2C (0x27), počtu znaků, řádků LCD 20x4
#include <Servo.h>  // knihovna pro ovládání serva
Servo myservo;  // instance třídy servo viz. Objektově Orientované Programování
int pos = 0;  // proměnná úhlu natočení serva
boolean buttonStateUp = false;  // nejnovější hodnota načtená ze vstupního pinu 
boolean lastButtonStateUp = false;  // předchozí hodnota načtení ze vstupního pinu
boolean lastTrueButtonStateUp = false;  // předchozí hodnota ošetřeného tlačítka
boolean buttonStateStart = false;
boolean lastButtonStart = false;
boolean lastTrueButtonStart = false;
boolean buttonStateDown = false;  
boolean lastButtonStateDown = false;  
boolean lastTrueButtonStateDown = false;  
boolean mamBezet = false;
unsigned long lastDebounceTime = 0;  // čas posledního změny výstupního pinu
unsigned long lastDebounceTime2 = 0;
unsigned long lastDebounceTime3 = 0;
unsigned long debounceDelay = 50;  // čas debounce prodlevy 
byte mode = 0;    // 0 - Vypnuto, 1 - Zapnuto, 2 - Blikání rychlé, 3 - Blikání pomalé, 4 - Blikání střídavé
unsigned long aktualniMillis;   //aktualní čas
unsigned long predchoziMillis1;   // předchozí čas pro rychle blikání
unsigned long predchoziMillis2;   // předchozí čas pro pomalé blikání
unsigned long predchoziMillis3;   // předchozí čas pro střídavé blikání
unsigned long cas = 0;
long buttonTime;      //  čas začátku stisknutí tlačítka
boolean led1svetlo;   //  pomocná proměnná led1svetlo
boolean led2svetlo;   //  pomocná proměnná led2svetlo
 
void setup() {
  
  pinMode(LED1, OUTPUT);  // pin pro LED1 nastaven jako výstup
  pinMode(LED2, OUTPUT);  // pin pro LED2 nastaven jako výstup
  pinMode(buttonSelectUp, INPUT);  // pin pro tlačítko buttonSelect nastaveno jako vstup
  pinMode(buttonStart, INPUT);  // pin pro tlačítko buttonStart nastaveno jako vstup
  pinMode(buttonSelectDown, INPUT);  //pin pro tlačítko buttonSelectDown nastaveno jako vstup
  myservo.attach(9);  // pin pro servo
  lcd.begin();   // inicializace LCD
  lcd.backlight();   // zapnutí podsvícení
  Serial.begin(9600);   // konfigurace rychlosti seriového portu
  Serial.println("Seriovy port aktivni");  // První výpis na seriový port  
  
  lcd.setCursor( 2, 1);
  lcd.print("ready"); 
  delay(1000); 
}  
void loop(){
  
 //-------------- debounce pro tlačítko Select Up ----------
  buttonStateUp = digitalRead(buttonSelectUp);  // přečtení stavu tlačítka    
  if (buttonStateUp != lastButtonStateUp) { // kmita to, od minule se to zmenilo, zacnu debounce cas pocitat znovu (tedy od posledni zmeny, ktera je ted)
    lastDebounceTime = millis();
  }                            
  if ((millis() - lastDebounceTime) > debounceDelay) { // jo, uz se to dlouho nezmenilo, tak je to stabilni a spravna hodnota
    if (buttonStateUp != lastTrueButtonStateUp) {  // Pokud se stav tlačítka změnil tj. porovná se buttonState (stav tlačítka) s předchozím stavem             
  
     if(buttonStateUp == true) { 
                               // přidáním podmínky - začátek počítání vždy např. od 10s
      if(mamBezet == false) {  // a taky přepnutí mode jen tehdy, když jsou mode ve Stop 
        if(mode < 5) {  // když je hodnota mode menší než 5
         mode++; // přičte k mode hodnotu 1
        }          
       }   
     }
       lastTrueButtonStateUp = buttonStateUp;  // uložím si nový pravý ošetřený stav tlačítka           
    } 
  }     
  lastButtonStateUp = buttonStateUp; // tady si to ulozim, v dalsim pruchodu loop() to zase porovnam s novym stavem, zda se to mezi tim nezmenilo
  //---------------konec ošetření tlačítka Select Up -----------
 //-------------- debounce pro tlačítko Select Down ----------
  buttonStateDown = digitalRead(buttonSelectDown);  // přečtení stavu tlačítka    
  if (buttonStateDown != lastButtonStateDown) { // kmita to, od minule se to zmenilo, zacnu debounce cas pocitat znovu (tedy od posledni zmeny, ktera je ted)
    lastDebounceTime3 = millis();
  }                            
  if ((millis() - lastDebounceTime3) > debounceDelay) { // jo, uz se to dlouho nezmenilo, tak je to stabilni a spravna hodnota
    if (buttonStateDown != lastTrueButtonStateDown) {  // Pokud se stav tlačítka změnil tj. porovná se buttonState (stav tlačítka) s předchozím stavem             
  
     if(buttonStateDown == true) { 
                               // přidáním podmínky docílím vždy celého odpočtu času 10s !
      if(mamBezet == false) {  // a taky přepnutí mode jen tehdy, když jsou mode ve Stop 
        if(mode > 0) {  // když je mode větší než 0
         mode--; // odečte od mode hodnotu 1 
         }             
       }  
     }
       lastTrueButtonStateDown = buttonStateDown;  // uložím si nový pravý ošetřený stav tlačítka           
    } 
  }     
  lastButtonStateDown = buttonStateDown; // tady si to ulozim, v dalsim pruchodu loop() to zase porovnam s novym stavem, zda se to mezi tim nezmenilo
 //-------------- konec ořetření tlačítka Select Down ---------- 
  
  //-------------- debounce pro tlačítko START/STOP ----------  
    buttonStateStart = digitalRead(buttonStart);  // přečtení stavu tlačítka    
  if (buttonStateStart != lastButtonStart) { // kmita to, od minule se to zmenilo, zacnu debounce cas pocitat znovu (tedy od posledni zmeny, ktera je ted)
    lastDebounceTime2 = millis();
  }                            
  if ((millis() - lastDebounceTime2) > debounceDelay) { // jo, uz se to dlouho nezmenilo, tak je to stabilni a spravna hodnota
    if (buttonStateStart != lastTrueButtonStart) {  // Pokud se stav tlačítka změnil tj. porovná se buttonState (stav tlačítka) s předchozím stavem             
     if (buttonStateStart == true) {
         mamBezet = !mamBezet;          
         buttonTime = millis(); 
          Serial.println("START");  // výpis na seriový monitor                  
      }
        // TADY CHYBÍ CO SE MÁ PROVÉST PŘI STISKU TLAČÍTKA START ... U MODE SE PŘIČÍTÁ MODE ...
        // ...U STARTU BY SE MĚLA PŘEKLÁPĚT PROMĚNNÁ mamBezet - hoď si tu nějaký výpis do seriové linky a uvidíš že to funguje
      }             
      lastTrueButtonStart = buttonStateStart;  // uložím si nový pravý ošetřený stav tlačítka        
    }  
   
  lastButtonStart = buttonStateStart; // tady si to ulozim, v dalsim pruchodu loop() to zase porovnam s novym stavem, zda se to mezi tim nezmenilo
  //-------------- konec ořetření tlačítka Start/Stop ----------
   
                       
  if(mode == 0) {  // ******* LED1,LED2 vypnuto ******** 
     if(mamBezet == false){      
        led1svetlo = false;  // zhasni LED1              
        led2svetlo = false;  // zhasni LED2      
        lcd.setCursor( 12, 2 );
        lcd.print("STOP "); 
      } else {          
        lcd.setCursor( 12, 2 );
        lcd.print("START");
        }         
        lcd.setCursor( 2, 1 );
        lcd.print("Mode 0");            
   }
  
  if(mode == 1) {  // ******* LED1,LED2 zapnuto  ********    
       if(mamBezet == true){                                  
         led1svetlo = true;        
         led2svetlo = true;
         lcd.setCursor( 12, 2 );
         lcd.print("START");             
       } 
         else {       
          led1svetlo = false;         
          led2svetlo = false;
          lcd.setCursor( 12, 2 );
          lcd.print("STOP ");                       
          }
          lcd.setCursor( 0, 1 );
          lcd.print("  Mode 1");  
   }
                      
  if(mode == 2) {  // ******* LED1,LED2 blikání rychlé  *******     
          if(mamBezet == true) {   // ZRUŠENÁ PODMÍNKA mamBezet    - zmena true za false                          
           if(millis() - buttonTime > 10000){  // zjistím si jestli je čas něco provést, uběhlo už 10s od poslední akce?
             lcd.setCursor ( 10, 2 );
             lcd.print("  START   ");                         
             aktualniMillis = millis();  // podívám se na hodinky - aktuální čas                  
               if(aktualniMillis - predchoziMillis1 > 200) {  // nejprve si zjistím jestli je čas něco provést, uběhlo už 200ms od poslední akce?                  
                 if (led1svetlo) {                           
                   led1svetlo = false;  // zhasnu LED1
                   led2svetlo = false;  // zhasnu LED2                   
                  } else {                    
                    led1svetlo = true;  // rožnu LED1
                    led2svetlo = true;  // rožnu LED2                                
                   }                                   
                   predchoziMillis1 = aktualniMillis;   // v tento čas jsem provedl poslední akci  
             }                                                                         
            } else {  
              // vypis : "blikat začneme" - jestli chci vědět jak dlouho budu ještě čekat, tak vypíšu 10000 - (millis() - buttonTime        
              lcd.setCursor( 11, 2 );
              lcd.print(10000 - (millis() - buttonTime));   // zobrazí se odpočet do blikání led v ms 
              lcd.setCursor( 15, 2 );
              lcd.print(" ms");             
              }                  
              } else {                                          
                lcd.setCursor( 11, 2 );
                lcd.print(" STOP  ");
                led1svetlo = false;
                led2svetlo = false;            
                }                                     
                lcd.setCursor( 0, 1 );
                lcd.print("  Mode 2"); 
   }       
   
  if(mode == 3) {  // ******* LED1,LED2 blikání pomalé  *******  
     if(mamBezet == true){
        aktualniMillis = millis();  //podívám se na hodinky - aktuální čas  
       if(aktualniMillis - predchoziMillis2 > 500) {  // nejprve si zjistím jestli je čas něco provést, uběhlo už 500ms od poslední akce?  
         if (led2svetlo) {          
            led1svetlo = false;  // zhasnu LED1
            led2svetlo = false;  // zhasnu LED2
          } else {
            led1svetlo = true;  // rožnu LED1
            led2svetlo = true;  // rožnu LED2
             }
             predchoziMillis2 = aktualniMillis;   // v tento čas jsem provedl poslední akci 
        }             
       lcd.setCursor( 5, 2 );
       lcd.print("       START   ");
      } else  {
        led1svetlo = false;
        led2svetlo = false;
        lcd.setCursor( 12, 2);
        lcd.print("STOP ");   
      }
       lcd.setCursor( 0, 1 );
       lcd.print("  Mode 3");         
     } 
                
     if(mode == 4) {  // ******* LED1,LED2 blikání střídavé  *******     
      if(mamBezet == true){ 
        aktualniMillis = millis();  //podívám se na hodinky - aktuální čas     
       if(aktualniMillis - predchoziMillis3 > 300) { // nejprve si zjistím jestli je čas něco provést, uběhlo už 300ms ?
        led1svetlo = !led1svetlo; // do proměnné led1svetlo zapíšu její negovanou hodnotu, tj. svítila-li LED1 tak zhasne, byla-li zhaslá rožne se
        led2svetlo = !led1svetlo; // do proměnné led2svetlo zapíšu negovanou hodnotu led1svetlo, tj. pokud LED1 svítí chci LED2 zhaslou a naopak
        predchoziMillis3 = aktualniMillis;   // v tento čas jsem provedl poslední akci 
       } 
          lcd.setCursor( 12, 2 );
          lcd.print("START");   
      } else {              
           led1svetlo = false;
           led2svetlo = false;          
           lcd.setCursor( 12, 2 );
           lcd.print("STOP ");           
       }      
        lcd.setCursor( 0, 1 );
        lcd.print("  Mode 4");                  
      }
     if(mode == 5){  // ********** SERVO **********   
            if(mamBezet == true){  // program spuštěn 
                       
                    if(lastTrueButtonStateUp == true){  // stisknuto tlačítko selectUp 
                             // pokud můžu a nebourám servem do krajní pozice, měním pozici serva
                             if(pos <= 175){
                              pos +=1;
                              myservo.write(pos);
                             }
                              if(buttonStateUp == true){
                               lcd.setCursor( 12, 2 ); 
                                lcd.print(" UP "); 
                             }else{                     
                              lcd.setCursor( 12, 2);
                              lcd.print("STOP");
                             } 
                              Serial.print(pos);  // výpis odečtené hodnoty stupňů serva                                                        
                              Serial.println("° UP ↑");  // výpis na seriový monitor ... za hodnotu pos                                                       
                     }
                   
                     if(lastTrueButtonStateDown == true){  // stisknuto tlačítko selectDown 
                             // pokud můžu a nebourám servem do druhé krajní pozice, měním pozici serva druhým směrem 
                             if(pos >= 5){                              
                              pos -=1;
                              myservo.write(pos);
                             }
                              if(buttonStateDown == true){ 
                                lcd.setCursor( 12, 2 ); 
                                lcd.print("DOWN"); 
                             }else{
                              lcd.setCursor( 12, 2);
                              lcd.print("STOP"); 
                             } 
                              Serial.print(pos);                       
                              Serial.println("° DOWN ↓"); 
                                      
                     }
            }                                                    
           
        lcd.setCursor( 0, 1 );
        lcd.print("  Mode 5");                
     }         
    digitalWrite(LED1,led1svetlo);  // aktualizace stavu LED1, zápis proměnné led1svetlo na výstupní pin 10
    digitalWrite(LED2,led2svetlo);  // aktualizace stavu LED2, zápis proměnné led2svetlo na výstupní pin 11   
 }  
 
abych nezapoměl, nevím kam napsat, že  v mode5 je Start ? Stop mám, trošku to potom mýlí při přepínání mode  
 
 
za návrhy a změny budu jen vděčný, stále je co zlepšovat 

  děkuju