1 files changed, 129 insertions, 0 deletions
diff --git a/arduino/libraries/FileSystem/src/fatfs/source/diskio.c b/arduino/libraries/FileSystem/src/fatfs/source/diskio.c
new file mode 100755
index 0000000..2671042
--- /dev/null
+++ b/arduino/libraries/FileSystem/src/fatfs/source/diskio.c
@@ -0,0 +1,129 @@
+/*-----------------------------------------------------------------------*/
+/* Low level disk I/O module skeleton for FatFs     (C)ChaN, 2016        */
+/*-----------------------------------------------------------------------*/
+/* If a working storage control module is available, it should be        */
+/* attached to the FatFs via a glue function rather than modifying it.   */
+/* This is an example of glue functions to attach various exsisting      */
+/* storage control modules to the FatFs module with a defined API.       */
+/*-----------------------------------------------------------------------*/
+
+#ifdef NRF52840_XXAA
+
+#include "ff.h"			/* Obtains integer types */
+#include "diskio.h"		/* Declarations of disk functions */
+
+#include "flash/flash_qspi.h"
+
+
+/*-----------------------------------------------------------------------*/
+/* Get Drive Status                                                      */
+/*-----------------------------------------------------------------------*/
+
+DSTATUS disk_status (
+	BYTE pdrv		/* Physical drive nmuber to identify the drive */
+)
+{
+  (void) pdrv;
+  return 0;
+}
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Inidialize a Drive                                                    */
+/*-----------------------------------------------------------------------*/
+
+DSTATUS disk_initialize (
+	BYTE pdrv				/* Physical drive nmuber to identify the drive */
+)
+{
+  (void) pdrv;
+  return 0;
+}
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Read Sector(s)                                                        */
+/*-----------------------------------------------------------------------*/
+
+DRESULT disk_read (
+	BYTE pdrv,		/* Physical drive nmuber to identify the drive */
+	BYTE *buff,		/* Data buffer to store read data */
+	DWORD sector,	/* Start sector in LBA */
+	UINT count		/* Number of sectors to read */
+)
+{
+  (void) pdrv;
+
+  uint32_t const len = count * FF_MIN_SS;
+  return (len == flash_qspi_read(buff, sector * FF_MIN_SS, len)) ? RES_OK : RES_ERROR;
+}
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Write Sector(s)                                                       */
+/*-----------------------------------------------------------------------*/
+
+#if FF_FS_READONLY == 0
+
+DRESULT disk_write (
+	BYTE pdrv,			/* Physical drive nmuber to identify the drive */
+	const BYTE *buff,	/* Data to be written */
+	DWORD sector,		/* Start sector in LBA */
+	UINT count			/* Number of sectors to write */
+)
+{
+  (void) pdrv;
+
+  uint32_t const len = count * FF_MIN_SS;
+  return (len == flash_qspi_write(sector * FF_MIN_SS, buff, len)) ? RES_OK : RES_ERROR;
+}
+
+#endif
+
+
+/*-----------------------------------------------------------------------*/
+/* Miscellaneous Functions                                               */
+/*-----------------------------------------------------------------------*/
+
+DRESULT disk_ioctl (
+	BYTE pdrv,		/* Physical drive nmuber (0..) */
+	BYTE cmd,		/* Control code */
+	void *buff		/* Buffer to send/receive control data */
+)
+{
+  (void) pdrv;
+
+  switch ( cmd )
+  {
+    case GET_SECTOR_COUNT:
+      *((DWORD*) buff) = (flash_qspi_size() / FF_MIN_SS);
+    break;
+
+    case GET_SECTOR_SIZE:
+      *((WORD*) buff) = FF_MIN_SS;
+    break;
+
+    case GET_BLOCK_SIZE:
+      *((DWORD*) buff) = (FLASH_QSPI_PAGE_SIZE / FF_MIN_SS);
+    break;
+
+    case CTRL_SYNC:
+      flash_qspi_flush();
+    break;
+
+    case CTRL_TRIM:
+      // not support trim
+    break;
+
+    default:
+      return RES_ERROR;
+  }
+
+  return RES_OK;
+}
+
+#endif
+