#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

// ===== OLED =====
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 32
#define OLED_ADDR 0x3C

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

// ===== PINS =====
#define BUTTON1 8
#define BUTTON2 7

#define LED1 3
#define LED2 6
#define LED3 9

// ===== LED sekvens =====
int step = 0;
unsigned long lastChange = 0;
const int interval = 500; // ms

void setup() {
  Serial.begin(115200);

  // Knappar
  pinMode(BUTTON1, INPUT_PULLUP);
  pinMode(BUTTON2, INPUT_PULLUP);

  // LEDs
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
  pinMode(LED3, OUTPUT);

  // I2C (DINA PINS – oförändrade)
  Wire.setSDA(20);
  Wire.setSCL(21);
  Wire.begin();

  // Display
  if (!display.begin(SSD1306_SWITCHCAPVCC, OLED_ADDR)) {
    Serial.println("OLED fel!");
  }

  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);
}

void loop() {
  // ===== Läs knappar =====
  bool b1 = (digitalRead(BUTTON1) == LOW);
  bool b2 = (digitalRead(BUTTON2) == LOW);

  // ===== LED sekvens =====
  if (millis() - lastChange > interval) {
    lastChange = millis();
    step++;
    if (step > 6) step = 0;
  }

  // Släck alla först
  digitalWrite(LED1, LOW);
  digitalWrite(LED2, LOW);
  digitalWrite(LED3, LOW);

  // Tänd enligt steg
  switch (step) {
    case 0: digitalWrite(LED1, HIGH); break;
    case 1: digitalWrite(LED2, HIGH); break;
    case 2: digitalWrite(LED3, HIGH); break;
    case 3: digitalWrite(LED1, HIGH); digitalWrite(LED2, HIGH); break;
    case 4: digitalWrite(LED2, HIGH); digitalWrite(LED3, HIGH); break;
    case 5: digitalWrite(LED1, HIGH); digitalWrite(LED3, HIGH); break;
    case 6: digitalWrite(LED1, HIGH); digitalWrite(LED2, HIGH); digitalWrite(LED3, HIGH); break;
  }

  // ===== Display =====
  display.clearDisplay();

  display.setCursor(0, 0);
  display.println("Raspberry Pi Pico Test");

  display.setCursor(0, 12);
  display.print("Button 1: ");
  display.println(b1 ? "Down" : "Up");

  display.setCursor(0, 22);
  display.print("Button 2: ");
  display.println(b2 ? "Down" : "Up");

  display.display();

  delay(50);
}