94 lines
2.6 KiB
C++
94 lines
2.6 KiB
C++
#ifndef ARDUINO_USB_MODE
|
|
#error This ESP32 SoC has no Native USB interface
|
|
#elif ARDUINO_USB_MODE == 1
|
|
#warning This sketch should be used when USB is in OTG mode
|
|
void setup() {}
|
|
void loop() {}
|
|
#else
|
|
#include "USB.h"
|
|
#include "USBMSC.h"
|
|
|
|
USBMSC MSC;
|
|
|
|
static int32_t onWrite(uint32_t lba, uint32_t offset, uint8_t *buffer, uint32_t bufsize)
|
|
{
|
|
Serial.printf("MSC WRITE: lba: %lu, offset: %lu, bufsize: %lu\n", lba, offset, bufsize);
|
|
memcpy(msc_disk[lba] + offset, buffer, bufsize);
|
|
return bufsize;
|
|
}
|
|
|
|
static int32_t onRead(uint32_t lba, uint32_t offset, void *buffer, uint32_t bufsize) {
|
|
Serial.printf("MSC READ: lba: %lu, offset: %lu, bufsize: %lu\n", lba, offset, bufsize);
|
|
memcpy(buffer, msc_disk[lba] + offset, bufsize);
|
|
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);
|
|
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 setup() {
|
|
Serial.begin(115200);
|
|
Serial.setDebugOutput(true);
|
|
|
|
// Allocate each disk sector in PSRAM
|
|
for (uint x=0; x < DISK_SECTOR_COUNT; x++)
|
|
{
|
|
msc_disk[x] = (uint8_t*)ps_malloc(DISK_SECTOR_SIZE * sizeof(uint8_t));
|
|
|
|
if (!msc_disk[x])
|
|
{
|
|
Serial.println("Unable to allocate memory");
|
|
return;
|
|
}
|
|
}
|
|
|
|
memcpy(msc_disk[0], sector0, 512);
|
|
memcpy(msc_disk[1], sector1, 6);
|
|
memcpy(msc_disk[2], sector2, 512);
|
|
memcpy(msc_disk[3], README_CONTENTS, 512);
|
|
|
|
USB.onEvent(usbEventCallback);
|
|
MSC.vendorID("ACIT"); //max 8 chars
|
|
MSC.productID("NetFloppy"); //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
|
|
|
|
MSC.begin(DISK_SECTOR_COUNT, DISK_SECTOR_SIZE);
|
|
USB.begin();
|
|
|
|
Serial.print("Total PSRAM:");
|
|
Serial.println(ESP.getPsramSize());
|
|
Serial.print("Free PSRAM: ");
|
|
Serial.println(ESP.getFreePsram());
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
//
|
|
}
|
|
#endif /* ARDUINO_USB_MODE */
|