--- /dev/null
+/**
+ * \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.
+ *
+ * \version $Id$
+ * \author Luca Ottaviano <lottaviano@develer.com>
+ */
+
+/*-----------------------------------------------------------------------*/
+/* Low level disk I/O module skeleton for FatFs (C)ChaN, 2007 */
+/*-----------------------------------------------------------------------*/
+
+#include <fs/fatfs/src/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;
+}
+
projects / bertos.git / commitdiff