+/* Battfs disk interface section */
+
+static size_t dataflash_disk_page_read(struct BattFsSuper *d, pgcnt_t page, pgaddr_t addr, void *buf, size_t len)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ dataflash_readBlock(fd, page, addr, buf, len);
+ return len;
+}
+
+static bool dataflash_disk_page_load(struct BattFsSuper *d, pgcnt_t page)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ dataflash_loadPage(fd, page);
+ return true;
+}
+
+static size_t dataflash_disk_buffer_write(struct BattFsSuper *d, pgaddr_t addr, const void *buf, size_t len)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ dataflash_writeBlock(fd, addr, buf, len);
+ return len;
+}
+
+static size_t dataflash_disk_buffer_read(struct BattFsSuper *d, pgaddr_t addr, void *buf, size_t len)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ ASSERT(addr + len <= mem_info[fd->dev].page_size);
+
+ CS_TOGGLE(fd);
+
+ kfile_putc(DFO_READ_BUFF1, fd->channel);
+
+ uint32_t byte_addr = addr;
+
+ kfile_putc((byte_addr >> 16) & 0xff, fd->channel);
+ kfile_putc((byte_addr >> 8) & 0xff, fd->channel);
+ kfile_putc(byte_addr & 0xff, fd->channel);
+
+ /* Send additional don't care byte to start read operation */
+ kfile_putc(0, fd->channel);
+
+ kfile_read(fd->channel, buf, len); //Read len bytes ad put in buffer.
+ kfile_flush(fd->channel); // Flush channel
+ fd->setCS(false);
+ return len;
+}
+
+static bool dataflash_disk_page_save(struct BattFsSuper *d, pgcnt_t page)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ dataflash_cmd(fd, page, 0x00, DFO_WRITE_BUFF1_TO_MEM);
+ return true;
+}
+
+static bool dataflash_disk_page_erase(struct BattFsSuper *d, pgcnt_t page)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ dataflash_cmd(fd, page, 0x00, DFO_ERASE_PAGE);
+ return true;
+}
+
+static int dataflash_close(struct KFile *_fd);
+
+static bool dataflash_disk_close(struct BattFsSuper *d)
+{
+ DataFlash *fd = DATAFLASH_CAST((KFile *)d->disk_ctx);
+ return dataflash_close(&fd->fd) == 0;
+}
+
+bool dataflash_diskInit(struct BattFsSuper *d, DataFlash *fd, pgcnt_t *page_array)
+{
+ ASSERT(d);
+ ASSERT(fd);
+ d->read = dataflash_disk_page_read;
+ d->load = dataflash_disk_page_load;
+ d->bufferWrite = dataflash_disk_buffer_write;
+ d->bufferRead = dataflash_disk_buffer_read;
+ d->save = dataflash_disk_page_save;
+ d->erase = dataflash_disk_page_erase;
+ d->close = dataflash_disk_close;
+ d->disk_ctx = fd;
+ d->page_size = mem_info[fd->dev].page_size;
+ d->page_count = mem_info[fd->dev].page_cnt;
+ ASSERT(page_array);
+ d->page_array = page_array;
+ return d->page_array && fd;
+}
+
+/* Kfile interface section */
+