Working

bertos/emul/diskio_emul.c

@@ -0,0 +1,219 @@
+/**
+ * \file
+ * <!--
+ * This file is part of BeRTOS.
+ *
+ * Bertos is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ * As a special exception, you may use this file as part of a free software
+ * library without restriction.  Specifically, if other files instantiate
+ * templates or use macros or inline functions from this file, or you compile
+ * this file and link it with other files to produce an executable, this
+ * file does not by itself cause the resulting executable to be covered by
+ * the GNU General Public License.  This exception does not however
+ * invalidate any other reasons why the executable file might be covered by
+ * the GNU General Public License.
+ *
+ * Copyright 2009 Develer S.r.l. (http://www.develer.com/)
+ *
+ * -->
+ *
+ * \brief Low level disk access for FatFs emulated.
+ *
+ * \author Luca Ottaviano <lottaviano@develer.com>
+ */
+
+/*-----------------------------------------------------------------------*/
+/* Low level disk I/O module skeleton for FatFs     (C)ChaN, 2007        */
+/*-----------------------------------------------------------------------*/
+
+#include <fs/fatfs/diskio.h>
+#include <stdio.h>
+#include <errno.h>
+#include <time.h>
+
+#define SECTOR_SIZE 512
+
+static volatile DSTATUS Stat = STA_NOINIT;
+
+/**
+ * This is an example implementation, used to simulate the the calls to normal filesystem calls
+ * It only works for drive 0.
+ */
+
+
+/*-----------------------------------------------------------------------*/
+/* Inidialize a Drive                                                    */
+
+static FILE *fake_disk = 0;
+
+DSTATUS disk_initialize (
+	BYTE drv				/* Physical drive nmuber (0..) */
+)
+{
+	if (drv)
+		return STA_NOINIT; /* Support only drive 0 */
+	// XXX: pay attention here: some functions call disk_initialize *after* it has
+	//  been initialized for the first time.
+	//  Here we just return the status (that should always be ~STA_NOINIT after the first
+	//  call)
+	if (fake_disk)
+		return Stat;
+
+	const char *path = "emuldisk.dsk";
+	fake_disk = fopen(path, "w+");
+	int err = errno;
+	if (!fake_disk)
+	{
+		switch (err)
+		{
+		case EINVAL:
+			fprintf(stderr, "invalid mode\n");
+		default:
+			return STA_NOINIT;
+		}
+	}
+	Stat &= ~STA_NOINIT;
+	return Stat;
+}
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Return Disk Status                                                    */
+
+DSTATUS disk_status (
+	BYTE drv		/* Physical drive nmuber (0..) */
+)
+{
+	if (drv)
+		return STA_NOINIT; /* Support only drive 0 */
+	return Stat;
+}
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Read Sector(s)                                                        */
+
+DRESULT disk_read (
+	BYTE drv,		/* Physical drive nmuber (0..) */
+	BYTE *buff,		/* Data buffer to store read data */
+	DWORD sector,	/* Sector address (LBA) */
+	BYTE count		/* Number of sectors to read (1..255) */
+)
+{
+	if (drv || !count) return RES_PARERR;
+	if (Stat & STA_NOINIT) return RES_NOTRDY;
+
+	fseek(fake_disk, sector * SECTOR_SIZE, SEEK_SET);
+	size_t read_items = fread(buff, SECTOR_SIZE, count, fake_disk);
+	if (read_items == count)
+		return RES_OK;
+	else
+	{
+		if (feof(fake_disk))
+			fprintf(stderr, "end-of-file\n");
+		if (ferror(fake_disk))
+			fprintf(stderr, "error\n");
+		return RES_ERROR;
+	}
+}
+
+
+/*-----------------------------------------------------------------------*/
+/* Write Sector(s)                                                       */
+
+#if _READONLY == 0
+DRESULT disk_write (
+	BYTE drv,			/* Physical drive nmuber (0..) */
+	const BYTE *buff,	/* Data to be written */
+	DWORD sector,		/* Sector address (LBA) */
+	BYTE count			/* Number of sectors to write (1..255) */
+)
+{
+	if (drv || !count) return RES_PARERR;
+	if (Stat & STA_NOINIT) return RES_NOTRDY;
+	if (Stat & STA_PROTECT) return RES_WRPRT;
+
+	fseek(fake_disk, sector * SECTOR_SIZE, SEEK_SET);
+	size_t write_items = fwrite(buff, SECTOR_SIZE, count, fake_disk);
+	if (write_items == count)
+		return RES_OK;
+	else
+	{
+		if (feof(fake_disk))
+			fprintf(stderr, "end-of-file\n");
+		if (ferror(fake_disk))
+			fprintf(stderr, "error\n");
+		return RES_ERROR;
+	}
+}
+#endif /* _READONLY */
+
+
+
+/*-----------------------------------------------------------------------*/
+/* Miscellaneous Functions                                               */
+
+DRESULT disk_ioctl (
+	BYTE drv,		/* Physical drive nmuber (0..) */
+	BYTE ctrl,		/* Control code */
+	void *buff		/* Buffer to send/receive control data */
+)
+{
+	if (drv) return RES_PARERR;
+	if (Stat & STA_NOINIT) return RES_NOTRDY;
+
+	switch (ctrl)
+	{
+	case GET_SECTOR_SIZE:
+		*(WORD*)buff = SECTOR_SIZE;
+		break;
+	case GET_SECTOR_COUNT:
+		*(DWORD*)buff = 65536;
+		break;
+	case GET_BLOCK_SIZE:
+		*(DWORD*)buff = 1;
+		break;
+	case CTRL_SYNC:
+		fflush(fake_disk);
+		break;
+	default:
+		return RES_PARERR;
+	}
+	return RES_OK;
+}
+
+DWORD get_fattime(void)
+{
+	time_t tmp = time(0);
+	struct tm *t = localtime(&tmp);
+	DWORD tim = 0;
+	// seconds
+	tim |= (t->tm_sec / 2);
+	// min
+	tim |= (t->tm_min << 5);
+	// hour
+	tim |= (t->tm_hour << 11);
+	// month day (1..31)
+	tim |= (t->tm_mday << 16);
+	// month (1..12)
+	tim |= ((t->tm_mon + 1) << 21);
+	// year (0..127)
+	tim |= ((t->tm_year - 80) << 25);
+	return tim;
+}
+