diskio.c

Go to the documentation of this file.

#ifdef __cplusplus
extern "C" {
#endif


#include "compiler.h"
#include "diskio.h"
#include "ctrl_access.h"

#include <string.h>
#include <stdio.h>
#include <assert.h>

#if (SAM3S || SAM3U || SAM3N || SAM3XA || SAM4S || SAM4N)
# include <rtc.h>
#endif

#if (SAM0)
# include <rtc_calendar.h>
struct rtc_module rtc_instance;

static void configure_rtc_calendar(void)
{
        /* Initialize RTC in calendar mode. */
        struct rtc_calendar_config config_rtc_calendar;

        rtc_calendar_get_config_defaults(&config_rtc_calendar);

        struct rtc_calendar_time init_time;
        rtc_calendar_get_time_defaults(&init_time);
        init_time.year   = 2014;
        init_time.month  = 1;
        init_time.day    = 1;
        init_time.hour   = 0;
        init_time.minute = 0;
        init_time.second = 4;

        config_rtc_calendar.clock_24h     = true;
        config_rtc_calendar.alarm[0].time = init_time;
        config_rtc_calendar.alarm[0].mask = RTC_CALENDAR_ALARM_MASK_YEAR;

        rtc_calendar_init(&rtc_instance, RTC, &config_rtc_calendar);

        rtc_calendar_enable(&rtc_instance);
}
#endif

#define SECTOR_SIZE_DEFAULT 512

#define SECTOR_SIZE_512  1
#define SECTOR_SIZE_1024 2
#define SECTOR_SIZE_2048 4
#define SECTOR_SIZE_4096 8

DSTATUS disk_initialize(BYTE drv)
{
        int i;
        Ctrl_status mem_status;

#if (SAM3S || SAM3U || SAM3N || SAM3XA || SAM4S)
        /* Default RTC configuration, 24-hour mode */
        rtc_set_hour_mode(RTC, 0);
#endif

#if (SAMD20 || SAMD21 || SAMR21)
        configure_rtc_calendar();
#endif

#if LUN_USB
        /* USB disk with multiple LUNs */
        if (drv > LUN_ID_USB + Lun_usb_get_lun()) {
                return STA_NOINIT;
        }
#else
        if (drv > MAX_LUN) {
                /* At least one of the LUN should be defined */
                return STA_NOINIT;
        }
#endif
        /* Check LUN ready (USB disk report CTRL_BUSY then CTRL_GOOD) */
        for (i = 0; i < 2; i ++) {
                mem_status = mem_test_unit_ready(drv);
                if (CTRL_BUSY != mem_status) {
                        break;
                }
        }
        if (mem_status != CTRL_GOOD) {
                return STA_NOINIT;
        }

        /* Check Write Protection Status */
        if (mem_wr_protect(drv)) {
                return STA_PROTECT;
        }

        /* The memory should already be initialized */
        return 0;
}

DSTATUS disk_status(BYTE drv)
{
        switch (mem_test_unit_ready(drv)) {
        case CTRL_GOOD:
                return 0;
        case CTRL_NO_PRESENT:
                return STA_NOINIT | STA_NODISK;
        default:
                return STA_NOINIT;
        }
}

DRESULT disk_read(BYTE drv, BYTE *buff, DWORD sector, BYTE count)
{
#if ACCESS_MEM_TO_RAM
        uint8_t uc_sector_size = mem_sector_size(drv);
        uint32_t i;
        uint32_t ul_last_sector_num;

        if (uc_sector_size == 0) {
                return RES_ERROR;
        }

        /* Check valid address */
        mem_read_capacity(drv, &ul_last_sector_num);
        if ((sector + count * uc_sector_size) >
                        (ul_last_sector_num + 1) * uc_sector_size) {
                return RES_PARERR;
        }

        /* Read the data */
        for (i = 0; i < count; i++) {
                if (memory_2_ram(drv, sector + uc_sector_size * i,
                                buff + uc_sector_size * SECTOR_SIZE_DEFAULT * i) !=
                                CTRL_GOOD) {
                        return RES_ERROR;
                }
        }

        return RES_OK;

#else
        return RES_ERROR;
#endif
}

#if _READONLY == 0
DRESULT disk_write(BYTE drv, BYTE const *buff, DWORD sector, BYTE count)
{
#if ACCESS_MEM_TO_RAM
        uint8_t uc_sector_size = mem_sector_size(drv);
        uint32_t i;
        uint32_t ul_last_sector_num;

        if (uc_sector_size == 0) {
                return RES_ERROR;
        }

        /* Check valid address */
        mem_read_capacity(drv, &ul_last_sector_num);
        if ((sector + count * uc_sector_size) >
                        (ul_last_sector_num + 1) * uc_sector_size) {
                return RES_PARERR;
        }

        /* Write the data */
        for (i = 0; i < count; i++) {
                if (ram_2_memory(drv, sector + uc_sector_size * i,
                                buff + uc_sector_size * SECTOR_SIZE_DEFAULT * i) !=
                                CTRL_GOOD) {
                        return RES_ERROR;
                }
        }

        return RES_OK;

#else
        return RES_ERROR;
#endif
}

#endif /* _READONLY */

DRESULT disk_ioctl(BYTE drv, BYTE ctrl, void *buff)
{
        DRESULT res = RES_PARERR;

        switch (ctrl) {
        case GET_BLOCK_SIZE:
                *(DWORD *)buff = 1;
                res = RES_OK;
                break;

        /* Get the number of sectors on the disk (DWORD) */
        case GET_SECTOR_COUNT:
        {
                uint32_t ul_last_sector_num;

                /* Check valid address */
                mem_read_capacity(drv, &ul_last_sector_num);

                *(DWORD *)buff = ul_last_sector_num + 1;

                res = RES_OK;
        }
        break;

        /* Get sectors on the disk (WORD) */
        case GET_SECTOR_SIZE:
        {
                uint8_t uc_sector_size = mem_sector_size(drv);

                if ((uc_sector_size != SECTOR_SIZE_512) &&
                                (uc_sector_size != SECTOR_SIZE_1024) &&
                                (uc_sector_size != SECTOR_SIZE_2048) &&
                                (uc_sector_size != SECTOR_SIZE_4096)) {
                        /* The sector size is not supported by the FatFS */
                        return RES_ERROR;
                }

                *(U8 *)buff = uc_sector_size * SECTOR_SIZE_DEFAULT;

                res = RES_OK;
        }
        break;

        /* Make sure that data has been written */
        case CTRL_SYNC:
                if (mem_test_unit_ready(drv) == CTRL_GOOD) {
                        res = RES_OK;
                } else {
                        res = RES_NOTRDY;
                }
                break;

        default:
                res = RES_PARERR;
        }

        return res;
}



#ifdef __cplusplus
}
#endif

---

inertial_sense_ros
Author(s):
autogenerated on Sun Feb 28 2021 03:17:57