#include "esp_arduino_version.h"
#include <FastLED.h>
#include "USB.h"
#include "USBMSC.h"
#include "SD_MMC.h"

USBMSC MSC;

static  uint32_t DISK_SECTOR_COUNT = 0;
static  uint16_t DISK_SECTOR_SIZE = 0;

bool isUSBActive() {
    return usbMassStorageActive;
}
static int32_t onWrite(uint32_t lba, uint32_t offset, uint8_t *buffer, uint32_t bufsize) {
    uint32_t secSize = SD_MMC.sectorSize();
    if (!secSize) {
        return 0;  // disk error
    }
    for (int x = 0; x < bufsize / secSize; x++) {
        uint8_t blkbuffer[secSize];
        memcpy(blkbuffer, (uint8_t *)buffer + secSize * x, secSize);
        if (!SD_MMC.writeRAW(blkbuffer, lba + x)) {
            return 0;
        }
    }
    return bufsize;
}

static int32_t onRead(uint32_t lba, uint32_t offset, void *buffer, uint32_t bufsize) {
    uint32_t secSize = SD_MMC.sectorSize();
    if (!secSize) {
        return false;  // disk error
    }
    for (int x = 0; x < bufsize / secSize; x++) {
        if (!SD_MMC.readRAW((uint8_t *)buffer + (x * secSize), lba + x)) {
            return 0;  // outside of volume boundary
        }
    }
    return bufsize;
}

static bool onStartStop(uint8_t power_condition, bool start, bool load_eject) {
    Serial.printf("MSC START/STOP: power: %u, start: %u, eject: %u\n", power_condition, start, load_eject);
    leds[0] = CRGB::Red;
    FastLED.show();
    return true;
}

static void usbEventCallback(void *arg, esp_event_base_t event_base, int32_t event_id, void *event_data) {
    if (event_base == ARDUINO_USB_EVENTS) {
        arduino_usb_event_data_t *data = (arduino_usb_event_data_t *)event_data;
        switch (event_id) {
        case ARDUINO_USB_STARTED_EVENT: Serial.println("USB PLUGGED"); break;
        case ARDUINO_USB_STOPPED_EVENT: Serial.println("USB UNPLUGGED"); break;
        case ARDUINO_USB_SUSPEND_EVENT: Serial.printf("USB SUSPENDED: remote_wakeup_en: %u\n", data->suspend.remote_wakeup_en); break;
        case ARDUINO_USB_RESUME_EVENT:  Serial.println("USB RESUMED"); break;
        default: break;
        }
    }
}

void Init_USB_Mass_Storage() {
    //Note:  Arduino IDE -> Tools -> USB Mode -> Select "USB-OTG (TinyUSB)" mode before using this sketch

    if (!sdEnable) {
        leds[0] = CRGB::Red;
        FastLED.show();
    } else {
        leds[0] = CRGB::Green;
        FastLED.show();  
    }


 if (sdEnable) {
    USB.onEvent(usbEventCallback);
    MSC.vendorID("ESP32");       //max 8 chars
    MSC.productID("USB_MSC");    //max 16 chars
    MSC.productRevision("1.0");  //max 4 chars
    MSC.onStartStop(onStartStop);
    MSC.onRead(onRead);
    MSC.onWrite(onWrite);

    MSC.mediaPresent(true);
    // MSC.isWritable(true);  // true if writable, false if read-only

    DISK_SECTOR_COUNT = SD_MMC.numSectors();
    DISK_SECTOR_SIZE =  SD_MMC.sectorSize();

    MSC.begin(DISK_SECTOR_COUNT, DISK_SECTOR_SIZE);
    USB.begin();
    }
} 
void Stop_USB_Mass_Storage() {
    if (usbMassStorageActive) {
        // В TinyUSB нет прямого метода остановки,
        // поэтому просто сбрасываем флаги и перемонтируем SD
        
        Serial.println("USB Mass Storage stopping...");
        Serial.println("Note: USB stack cannot be fully stopped, but SD will be remounted");
        
        usbMassStorageActive = false;
        
        // Небольшая задержка перед перемонтированием
        delay(500);
        
        // Перемонтируем SD для веб-сервера
        /*if (!SD_MMC.begin()) {
            Serial.println("SD Card remount failed");
            sdEnable = false;
        } else {*/
            sdEnable = true;
            sdMounted = true;
            Serial.println("SD Card remounted for web server");
        //}
        
        leds[0] = CRGB::Blue;
        FastLED.show();
    }
}

void ToggleUSBMassStorage() {
    if (!usbMassStorageActive) {
        // Включаем USB масс-сторадж
        if (sdEnable && sdMounted) {
            //SD_MMC.end(); // Размонтируем SD
            sdMounted = false;
            
            Init_USB_Mass_Storage(); // Запускаем USB
            usbMassStorageActive = true;
            
            Serial.println("USB Mass Storage activated");
            leds[0] = CRGB::Green;
            FastLED.show();
        }
    } else {
        Stop_USB_Mass_Storage();
    }
}

