#include
Encoder enkoder(2, 3);
long enkoderWartoscStara = 0;
long enkoderWartoscNowa = 0;
const byte przyciskPrawo = 9;       // Pin "W prawo"
const byte przyciskLewo = 10;       // Pin "W lewo"
const byte przyciskGora = 11;       // Pin "W górę"
const byte przyciskMenu = 12;       // Pin "Menu"
const byte przyciskZrodlo = 13;     // Pin "Źródło"
const byte przyciskKontrast = 4;    // Pin kontrast
const byte przyciskJasnosc = 8;     // Pin jasność
const byte przyciskNasycenie = 7;   // Pin nasycenie
const byte przyciskBlending = 6;    // Pin blending
const byte przyciskOdszumiacz = 5;  // Pin stopień odszumienia obrazu
// Najkrótszy czas, przy którym za każdym razem wartość się zmienia
const byte pauzaKrotka = 3;
// Najkrótszy czas, przy którym system interpretuje osobne wciśnięcia
const byte pauzaSrednia = 20;
// Najkrótszy czas, przy którym system nie zawiesza się przy niektórych działaniach w menu
const byte pauzaDluga = 250;

void setup() {
  pinMode(przyciskPrawo, OUTPUT);
  pinMode(przyciskLewo, OUTPUT);
  pinMode(przyciskGora, OUTPUT);
  pinMode(przyciskMenu, OUTPUT);
  pinMode(przyciskZrodlo, OUTPUT);
  pinMode(przyciskKontrast, INPUT_PULLUP);
  pinMode(przyciskJasnosc, INPUT_PULLUP);
  pinMode(przyciskNasycenie, INPUT_PULLUP);
  pinMode(przyciskBlending, INPUT_PULLUP);
  pinMode(przyciskOdszumiacz, INPUT_PULLUP);
  reset();
}
void loop() {
  // Obsługa zmiany kontrastu
  if (digitalRead(przyciskKontrast) == HIGH) {
    reset();
    delay(pauzaDluga);
    wcisnijGora();
    wcisnijMenu();
    wcisnijGora();
    wcisnijGora();
    wcisnijGora();
    wcisnijGora();
  }
  // Obsługa zmiany jasności
  if (digitalRead(przyciskJasnosc) == HIGH) {
    reset();
    delay(pauzaDluga);
    wcisnijGora();
    wcisnijMenu();
    wcisnijGora();
    wcisnijGora();
    wcisnijGora();
  }
  // Obsługa zmiany nasycenia
  if (digitalRead(przyciskNasycenie) == HIGH) {
    reset();
    delay(pauzaDluga);
    wcisnijGora();
    wcisnijMenu();
    wcisnijGora();
    wcisnijGora();
  }
  // Załaduj warość wirtualnej pozycji enkodera
  enkoderWartoscNowa = enkoder.read();
  // Jeśli enkoder obrócono w prawo...
  if (enkoderWartoscNowa > enkoderWartoscStara) {
    // Zapamiętaj bieżacą wartość dla późniejszych porównań
    enkoderWartoscStara = enkoderWartoscNowa;
    // Wciśnij przycisk "W prawo"
    wcisnijPrawo();
  }
  // Jeśli enkoder obrócono w lewo...
  if (enkoderWartoscNowa < enkoderWartoscStara) {
    // Zapamiętaj bieżacą wartość dla późniejszych porównań
    enkoderWartoscStara = enkoderWartoscNowa;
    // Wciśnij przycisk "W lewo"
    wcisnijLewo();
  }
  // Obsługa wyboru stopnia odszumienia obrazu
  if (digitalRead(przyciskOdszumiacz) == HIGH) {
    reset();
    delay(pauzaDluga);
    wcisnijGora();
    delay(pauzaDluga);
    wcisnijGora();
    delay(pauzaDluga);
    wcisnijGora();
    delay(pauzaSrednia);
    wcisnijMenu();
    delay(pauzaSrednia);
    wcisnijGora();
    delay(pauzaSrednia);
  }
  // Obsługa wyboru wartości blendingu
  if (digitalRead(przyciskBlending) == HIGH) {
    reset();
    delay(pauzaDluga);
    wcisnijPrawo();
    delay(pauzaDluga);
    wcisnijPrawo();
    delay(pauzaSrednia);
    wcisnijPrawo();
    delay(pauzaSrednia);
    wcisnijPrawo();
    delay(pauzaSrednia);
    wcisnijGora();
    wcisnijGora();
    wcisnijGora();
    wcisnijGora();
    wcisnijMenu();
  }
}
void wcisnijPrawo() {                 // Wciśnięcie przycisku "W prawo".
  digitalWrite(przyciskPrawo, HIGH);  // Wciśnij przycisk.
  delay(pauzaKrotka);                 // Zaczekaj.
  digitalWrite(przyciskPrawo, LOW);   // Puść przycisk.
  delay(pauzaSrednia);                // Zaczekaj.
}
void wcisnijLewo() {
  digitalWrite(przyciskLewo, HIGH);
  delay(pauzaKrotka);
  digitalWrite(przyciskLewo, LOW);
  delay(pauzaSrednia);
}
void wcisnijGora() {
  digitalWrite(przyciskGora, HIGH);
  delay(pauzaKrotka);
  digitalWrite(przyciskGora, LOW);
  delay(pauzaSrednia);
}
void wcisnijZrodlo() {
  digitalWrite(przyciskZrodlo, HIGH);
  delay(pauzaKrotka);
  digitalWrite(przyciskZrodlo, LOW);
  delay(pauzaDluga);
}
void wcisnijMenu() {
  digitalWrite(przyciskMenu, HIGH);
  delay(pauzaKrotka);
  digitalWrite(przyciskMenu, LOW);
  delay(pauzaDluga);
}
// Makro sekwencji startowej
void reset() {
  wcisnijZrodlo();
  wcisnijMenu();
  wcisnijMenu();
}

1/*#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Fonts/FreeSansBold9pt7b.h>
#include <Fonts/Picopixel.h>

#define ENCODER_CLK 2
#define ENCODER_DT  3
#define ENCODER_SW  4

uint8_t volume = 50;
uint8_t bass = 25;
uint8_t treble = 66;

typedef enum {
  SET_VOLUME,
  SET_BASS,
  SET_TREBLE,
} Mode;

Mode mode = SET_VOLUME;

Adafruit_SSD1306 display(128, 64, &Wire, -1);

void nextMode() {
  switch (mode) {
    case SET_VOLUME:
      mode = SET_BASS;
      break;

    case SET_BASS:
      mode = SET_TREBLE;
      break;

    case SET_TREBLE:
      mode = SET_VOLUME;
      break;
  }
}

void updateValue(int delta) {
  switch (mode) {
    case SET_VOLUME:
      volume = constrain(volume + delta, 0, 100);
      break;

    case SET_BASS:
      bass = constrain(bass + delta, 0, 100);
      break;

    case SET_TREBLE:
      treble = constrain(treble + delta, 0, 100);
      break;
  }
}

void updateDisplay() {
  display.clearDisplay();
  display.setFont();
  display.setTextColor(1);

  display.setCursor(42, 2);
  display.print("Volume");
  display.drawRoundRect(10, 12, 102, 9, 2, WHITE);
  display.fillRect(11, 13, volume, 7, WHITE);
  if (mode == SET_VOLUME) {
    display.setCursor(32, 2);
    display.print(">");
  }

  display.setCursor(48, 22);
  display.print("Bass");
  display.drawRoundRect(10, 32, 102, 9, 2, WHITE);
  display.fillRect(11, 33, bass, 7, WHITE);
  if (mode == SET_BASS) {
    display.setCursor(38, 22);
    display.print(">");
  }

  display.setCursor(42, 42);
  display.print("Treble");
  display.drawRoundRect(10, 52, 102, 9, 2, WHITE);
  display.fillRect(11, 53, treble, 7, WHITE);
  if (mode == SET_TREBLE) {
    display.setCursor(32, 42);
    display.print(">");
  }

  display.display();
}

void setup() {
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  pinMode(ENCODER_CLK, INPUT);
  pinMode(ENCODER_DT, INPUT);
  pinMode(ENCODER_SW, INPUT_PULLUP);
  updateDisplay();
}

long int modeLastChanged = 0;
int prevClk = HIGH;
void loop() {
  if (digitalRead(ENCODER_SW) == LOW && millis() - modeLastChanged > 300) {
    modeLastChanged = millis();
    nextMode();
    updateDisplay();
  }

  int clk = digitalRead(ENCODER_CLK);
  if (clk != prevClk && clk == LOW) {
    int dt = digitalRead(ENCODER_DT);
    int delta = dt == HIGH ? 5 : -5;
    updateValue(delta);
    updateDisplay();
  }
  prevClk = clk;
}
*/