#include "9by04gk.h"

#define PIN_DIN    11
#define PIN_CLK    12
#define PIN_LE     10
#define PIN_STROBE 13

// Bufor wyświetlacza – 9 znaków
static uint32_t vfd_buf[9] = {0};
static uint8_t refresh_pos = 0;

void shift24(uint32_t value) {
  for (int i = 23; i >= 0; i--) {
    digitalWrite(PIN_CLK, LOW);
    digitalWrite(PIN_DIN, (value >> i) & 1);
    delayMicroseconds(1);
    
    digitalWrite(PIN_CLK, HIGH);
    delayMicroseconds(1);
  }
}

void vfd_send(uint32_t value) {
  static uint32_t last = 0xFFFFFFFF;
  
  if (value != last) {
    Serial.printf("VFD: 0x%08lX\n", value);
    last = value;
  }
  
  digitalWrite(PIN_LE, LOW);
  shift24(value);
  digitalWrite(PIN_LE, HIGH);
  delayMicroseconds(1);
  digitalWrite(PIN_LE, LOW);
  
  // STROBE LOW = aktywne wyjścia
  digitalWrite(PIN_STROBE, LOW);
}

void vfd_blank() {
  digitalWrite(PIN_STROBE, HIGH);
}

// Załaduj string do bufora (max 9 znaków)
void vfd_set(const char *str) {
  for (int i = 0; i < 9; i++) {
    uint8_t ch = (*str) ? ((uint8_t)*str++ & 0x7F) : ' ';
    vfd_buf[i] = font_9by04gk[ch];
    Serial.printf("vfd_buf[%d] = 0x%08lX (char: %c)\n", i, vfd_buf[i], ch);
  }
}

// Odświeżanie multipleksowane - wywołuj co 1-3ms
// UWAGA: SN75518N ma 32 wyjścia (Q1-Q32)
// Q1-Q15 = segmenty (15 bitów)
// Q16-Q24 = gridy (9 bitów)  
// Wysyłamy 24 bity: [grid_bits (9 bitów)] [segment_bits (15 bitów)]
void vfd_refresh() {
  // Pobierz maskę segmentów dla aktualnej cyfry
  uint32_t seg_mask = vfd_buf[refresh_pos] & 0x7FFF; // Tylko 15 bitów segmentów
  
  // Ustaw bit grid (aktywny grid ma 1, pozostałe 0)
  // Grid bity na pozycjach 23-15 (bo wysyłamy 24 bity)
  uint32_t grid_mask = (1UL << (refresh_pos + 15)); // Grid1 = bit15, Grid2 = bit16, ... Grid9 = bit23
  
  // Połącz grid i segmenty
  uint32_t data = grid_mask | seg_mask;
  
  vfd_send(data);
  
  refresh_pos = (refresh_pos + 1) % 9;
}

void setup() {
  Serial.begin(115200);
  
  pinMode(PIN_DIN,    OUTPUT);
  pinMode(PIN_CLK,    OUTPUT);
  pinMode(PIN_LE,     OUTPUT);
  pinMode(PIN_STROBE, OUTPUT);
  
  digitalWrite(PIN_STROBE, HIGH);
  digitalWrite(PIN_LE, LOW);
  
  // Test różnych znaków
  vfd_set("ABCDEFGHI");
  
  Serial.println("Gotowy - multipleksowanie SN75518N");
}

void loop() {
  // Odświeżaj wyświetlacz
  vfd_refresh();
  delayMicroseconds(3000); // 3ms na cyfrę
  
  // Zmieniaj tekst co 3 sekundy
  static unsigned long last_change = 0;
  static int test_idx = 0;
  
  if (millis() - last_change > 3000) {
    last_change = millis();
    
    const char *test_texts[] = {
      "HELLO    ",
      "WORLD    ",
      "123456789",
      "VFD TEST ",
      "9BY-04GK ",
      "ABCDEFGHI",
      "JKLMNOPQR"
    };
    
    vfd_set(test_texts[test_idx % 7]);
    test_idx++;
  }
}