move msc function into its library

Author: hathach

cores/nRF5/usb/Adafruit_USBDev_CDC.h

@@ -25,8 +25,6 @@
 #ifndef ADAFRUIT_USBDEV_CDC_H_
 #define ADAFRUIT_USBDEV_CDC_H_
 
-#ifdef NRF52840_XXAA
-
 #include "Adafruit_USBDevice.h"
 #include "Stream.h"
 
@@ -58,9 +56,6 @@ class Adafruit_USBDev_CDC : public Stream, Adafruit_USBDev_Interface
 	size_t readBytes(uint8_t *buffer, size_t length) { return readBytes((char *)buffer, length); }
 };
 
-
 extern Adafruit_USBDev_CDC Serial;
 
-#endif
-
 #endif /* ADAFRUIT_USBDEV_CDC_H_ */

cores/nRF5/usb/usb_msc_flash.c

@@ -47,3 +47,108 @@ void Adafruit_USBDev_MSC::begin(void)
   USBDevice.addInterface(*this);
 }
 
+extern "C"
+{
+
+#include "nrf_gpio.h"
+#include "flash/flash_qspi.h"
+
+// Callback invoked when received an SCSI command not in built-in list below
+// - READ_CAPACITY10, READ_FORMAT_CAPACITY, INQUIRY, MODE_SENSE6, REQUEST_SENSE
+// - READ10 and WRITE10 has their own callbacks
+int32_t tud_msc_scsi_cb (uint8_t lun, const uint8_t scsi_cmd[16], void* buffer, uint16_t bufsize)
+{
+  const void* response = NULL;
+  uint16_t resplen = 0;
+
+  switch ( scsi_cmd[0] )
+  {
+    case SCSI_CMD_TEST_UNIT_READY:
+      // Command that host uses to check our readiness before sending other commands
+      resplen = 0;
+    break;
+
+    case SCSI_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL:
+      // Host is about to read/write etc ... better not to disconnect disk
+      resplen = 0;
+    break;
+
+    case SCSI_CMD_START_STOP_UNIT:
+      // Host try to eject/safe remove/poweroff us. We could safely disconnect with disk storage, or go into lower power
+      /* scsi_start_stop_unit_t const * start_stop = (scsi_start_stop_unit_t const *) scsi_cmd;
+       // Start bit = 0 : low power mode, if load_eject = 1 : unmount disk storage as well
+       // Start bit = 1 : Ready mode, if load_eject = 1 : mount disk storage
+       start_stop->start;
+       start_stop->load_eject;
+       */
+      resplen = 0;
+    break;
+
+    default:
+      // Set Sense = Invalid Command Operation
+      tud_msc_set_sense(lun, SCSI_SENSE_ILLEGAL_REQUEST, 0x20, 0x00);
+
+      // negative means error -> tinyusb could stall and/or response with failed status
+      resplen = -1;
+    break;
+  }
+
+  // return len must not larger than bufsize
+  if ( resplen > bufsize )
+  {
+    resplen = bufsize;
+  }
+
+  // copy response to stack's buffer if any
+  if ( response && resplen )
+  {
+    memcpy(buffer, response, resplen);
+  }
+
+  return resplen;
+}
+
+// Callback invoked when received READ10 command.
+// Copy disk's data to buffer (up to bufsize) and return number of copied bytes.
+int32_t tud_msc_read10_cb (uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
+{
+  (void) lun;
+
+  return flash_qspi_read(buffer, lba * CFG_TUD_MSC_BLOCK_SZ + offset, bufsize);
+}
+
+// Callback invoked when received WRITE10 command.
+// Process data in buffer to disk's storage and return number of written bytes
+int32_t tud_msc_write10_cb (uint8_t lun, uint32_t lba, uint32_t offset, uint8_t* buffer, uint32_t bufsize)
+{
+  (void) lun;
+
+  uint32_t wrcount = flash_qspi_write(lba * CFG_TUD_MSC_BLOCK_SZ + offset, buffer, bufsize);
+
+  // update fatfs's cache if address matches
+  extern void ExternalFS_usbmsc_write (uint32_t lba, void const* buffer, uint32_t bufsize);
+  if ( ExternalFS_usbmsc_write ) ExternalFS_usbmsc_write(lba, buffer, bufsize);
+
+  return wrcount;
+}
+
+// Callback invoked when WRITE10 command is completed (status received and accepted by host).
+// used to flush any pending cache.
+void tud_msc_write10_complete_cb (uint8_t lun)
+{
+  (void) lun;
+
+  // flush pending cache when write10 is complete
+  flash_qspi_flush();
+}
+
+void tud_msc_capacity_cb(uint8_t lun, uint32_t* block_count, uint16_t* block_size)
+{
+  (void) lun;
+
+  *block_count = flash_qspi_size() / CFG_TUD_MSC_BLOCK_SZ;
+  *block_size  = CFG_TUD_MSC_BUFSIZE;
+}
+
+}
+