imx233: merge sd and mmc drivers, fix dma issues
Merge sd and mmc drivers into a single sdmmc driver. This allows some factoring of the code and simplify bug fixing. Also fix the dma/cache related issue by doing all transfers via a correctly aligned buffer. The current code is not smart enough to take advantage of large user buffers currently but at least it is safe! Change-Id: Ib0fd16dc7d52ef7bfe99fd586e03ecf08691edcd
This commit is contained in:
parent
4604e984e8
commit
4908b8eb1c
|
@ -511,11 +511,8 @@ target/arm/imx233/clkctrl-imx233.c
|
|||
target/arm/imx233/system-imx233.c
|
||||
target/arm/imx233/timrot-imx233.c
|
||||
target/arm/imx233/kernel-imx233.c
|
||||
# if (CONFIG_STORAGE & STORAGE_SD)
|
||||
target/arm/imx233/sd-imx233.c
|
||||
# endif
|
||||
# if (CONFIG_STORAGE & STORAGE_MMC)
|
||||
target/arm/imx233/mmc-imx233.c
|
||||
# if (CONFIG_STORAGE & (STORAGE_SD | STORAGE_MMC))
|
||||
target/arm/imx233/sdmmc-imx233.c
|
||||
# endif
|
||||
target/arm/imx233/partitions-imx233.c
|
||||
target/arm/imx233/ssp-imx233.c
|
||||
|
|
|
@ -39,13 +39,13 @@ typedef struct
|
|||
unsigned int r2w_factor;
|
||||
unsigned long numblocks; /* size in flash blocks */
|
||||
unsigned int blocksize; /* block size in bytes */
|
||||
unsigned long rca; /* RCA register */
|
||||
|
||||
#if (CONFIG_STORAGE & STORAGE_MMC)
|
||||
unsigned char bitrate_register;
|
||||
#endif
|
||||
|
||||
#if (CONFIG_STORAGE & STORAGE_SD)
|
||||
unsigned long rca; /* RCA register */
|
||||
unsigned int current_bank;
|
||||
#endif
|
||||
} tCardInfo;
|
||||
|
|
|
@ -1,302 +0,0 @@
|
|||
/***************************************************************************
|
||||
* __________ __ ___.
|
||||
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||||
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||||
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||||
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||||
* \/ \/ \/ \/ \/
|
||||
* $Id$
|
||||
*
|
||||
* Copyright (C) 2011 by Amaury Pouly
|
||||
*
|
||||
* This program 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||||
* KIND, either express or implied.
|
||||
*
|
||||
****************************************************************************/
|
||||
#include "config.h"
|
||||
#include "system.h"
|
||||
#include "mmc.h"
|
||||
#include "sdmmc.h"
|
||||
#include "storage.h"
|
||||
#include "ssp-imx233.h"
|
||||
#include "pinctrl-imx233.h"
|
||||
#include "partitions-imx233.h"
|
||||
|
||||
/**
|
||||
* This code assumes a single eMMC internal flash
|
||||
*/
|
||||
|
||||
#ifdef SANSA_FUZEPLUS
|
||||
#define MMC_SSP 2
|
||||
#else
|
||||
#error You need to configure the ssp to use
|
||||
#endif
|
||||
|
||||
#define MMC_RCA 1
|
||||
|
||||
/** When set, this values restrict the windows of the read and writes */
|
||||
static unsigned mmc_window_start;
|
||||
static unsigned mmc_window_end;
|
||||
static bool mmc_window_enable = true;
|
||||
static long mmc_last_activity = -1;
|
||||
static bool mmc_is_active = false;
|
||||
static unsigned mmc_size = 0;
|
||||
static int mmc_first_drive = 0;
|
||||
|
||||
static struct mutex mmc_mutex;
|
||||
|
||||
void imx233_mmc_disable_window(void)
|
||||
{
|
||||
mmc_window_enable = false;
|
||||
}
|
||||
|
||||
int mmc_init(void)
|
||||
{
|
||||
mutex_init(&mmc_mutex);
|
||||
|
||||
imx233_ssp_start(MMC_SSP);
|
||||
imx233_ssp_softreset(MMC_SSP);
|
||||
imx233_ssp_set_mode(MMC_SSP, HW_SSP_CTRL1__SSP_MODE__SD_MMC);
|
||||
#ifdef SANSA_FUZEPLUS
|
||||
/** Sansa Fuze+ has an internal eMMC 8-bit wide flash, power gate is pin PWM3
|
||||
* and power up time is 20ms */
|
||||
imx233_pinctrl_acquire_pin(1, 29, "emmc power");
|
||||
imx233_set_pin_function(1, 29, PINCTRL_FUNCTION_GPIO);
|
||||
imx233_enable_gpio_output(1, 29, true);
|
||||
imx233_set_gpio_output(1, 29, false);
|
||||
sleep(HZ / 5);
|
||||
|
||||
imx233_ssp_setup_ssp2_sd_mmc_pins(true, 8, PINCTRL_DRIVE_8mA);
|
||||
#endif
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96000 / 240 / 1 = 400kHz */
|
||||
imx233_ssp_set_timings(MMC_SSP, 240, 0, 0xffff);
|
||||
imx233_ssp_sd_mmc_power_up_sequence(MMC_SSP);
|
||||
imx233_ssp_set_bus_width(MMC_SSP, 1);
|
||||
imx233_ssp_set_block_size(MMC_SSP, 9);
|
||||
/* go to idle state */
|
||||
int ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 0, 0, SSP_NO_RESP, NULL, 0, false, false, NULL);
|
||||
if(ret != 0)
|
||||
return -1;
|
||||
/* send op cond until the card respond with busy bit set; it must complete within 1sec */
|
||||
unsigned timeout = current_tick + HZ;
|
||||
do
|
||||
{
|
||||
uint32_t ocr;
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 1, 0x40ff8000, SSP_SHORT_RESP, NULL, 0, false, false, &ocr);
|
||||
if(ret == 0 && ocr & (1 << 31))
|
||||
break;
|
||||
}while(!TIME_AFTER(current_tick, timeout));
|
||||
|
||||
if(ret != 0)
|
||||
return -2;
|
||||
/* get CID */
|
||||
uint32_t cid[4];
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 2, 0, SSP_LONG_RESP, NULL, 0, false, false, cid);
|
||||
if(ret != 0)
|
||||
return -3;
|
||||
/* Set RCA */
|
||||
uint32_t status;
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 3, MMC_RCA << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -4;
|
||||
/* Select card */
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 7, MMC_RCA << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -5;
|
||||
/* Check TRAN state */
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 13, MMC_RCA << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -6;
|
||||
if(((status >> 9) & 0xf) != 4)
|
||||
return -7;
|
||||
/* Switch to 8-bit bus */
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 6, 0x3b70200, SSP_SHORT_RESP, NULL, 0, true, false, &status);
|
||||
if(ret != 0)
|
||||
return -8;
|
||||
/* switch error ? */
|
||||
if(status & 0x80)
|
||||
return -9;
|
||||
imx233_ssp_set_bus_width(MMC_SSP, 8);
|
||||
/* Switch to high speed mode */
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 6, 0x3b90100, SSP_SHORT_RESP, NULL, 0, true, false, &status);
|
||||
if(ret != 0)
|
||||
return -10;
|
||||
/* switch error ?*/
|
||||
if(status & 0x80)
|
||||
return -11;
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96 / 2 / 1 = 48MHz */
|
||||
imx233_ssp_set_timings(MMC_SSP, 2, 0, 0xffff);
|
||||
|
||||
/* read extended CSD */
|
||||
{
|
||||
uint8_t ext_csd[512];
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 8, 0, SSP_SHORT_RESP, ext_csd, 1, true, true, &status);
|
||||
if(ret != 0)
|
||||
return -12;
|
||||
uint32_t *sec_count = (void *)&ext_csd[212];
|
||||
mmc_size = *sec_count;
|
||||
}
|
||||
|
||||
mmc_window_start = 0;
|
||||
mmc_window_end = INT_MAX;
|
||||
#ifdef SANSA_FUZEPLUS
|
||||
if(imx233_partitions_is_window_enabled())
|
||||
{
|
||||
/* WARNING: mmc_first_drive is not set yet at this point */
|
||||
uint8_t mbr[512];
|
||||
ret = mmc_read_sectors(IF_MD2(0,) 0, 1, mbr);
|
||||
if(ret)
|
||||
panicf("cannot read MBR: %d", ret);
|
||||
ret = imx233_partitions_compute_window(mbr, &mmc_window_start, &mmc_window_end);
|
||||
if(ret)
|
||||
panicf("cannot compute partitions window: %d", ret);
|
||||
mmc_size = mmc_window_end - mmc_window_start;
|
||||
}
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mmc_num_drives(int first_drive)
|
||||
{
|
||||
mmc_first_drive = first_drive;
|
||||
return 1;
|
||||
}
|
||||
|
||||
#ifdef STORAGE_GET_INFO
|
||||
void mmc_get_info(IF_MD2(int drive,) struct storage_info *info)
|
||||
{
|
||||
#ifdef HAVE_MULTIDRIVE
|
||||
(void) drive;
|
||||
#endif
|
||||
info->sector_size = 512;
|
||||
info->num_sectors = mmc_size;
|
||||
info->vendor = "Rockbox";
|
||||
info->product = "Internal Storage";
|
||||
info->revision = "0.00";
|
||||
}
|
||||
#endif
|
||||
|
||||
static int transfer_sectors(IF_MD2(int drive,) unsigned long start, int count, void *buf, bool read)
|
||||
{
|
||||
IF_MD((void) drive);
|
||||
/* check window */
|
||||
start += mmc_window_start;
|
||||
if((start + count) > mmc_window_end)
|
||||
return -201;
|
||||
/* get mutex (needed because we do multiple commands for count > 0) */
|
||||
mutex_lock(&mmc_mutex);
|
||||
int ret = 0;
|
||||
uint32_t resp;
|
||||
|
||||
mmc_last_activity = current_tick;
|
||||
mmc_is_active = true;
|
||||
|
||||
do
|
||||
{
|
||||
int this_count = MIN(count, IMX233_MAX_SSP_XFER_SIZE / 512);
|
||||
if(this_count == 1)
|
||||
{
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, read ? 17 : 24, start,
|
||||
SSP_SHORT_RESP, buf, this_count, false, read, &resp);
|
||||
}
|
||||
else
|
||||
{
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, 23, this_count, SSP_SHORT_RESP, NULL,
|
||||
0, false, false, &resp);
|
||||
if(ret == 0)
|
||||
ret = imx233_ssp_sd_mmc_transfer(MMC_SSP, read ? 18 : 25, start,
|
||||
SSP_SHORT_RESP, buf, this_count, false, read, &resp);
|
||||
}
|
||||
count -= this_count;
|
||||
start += this_count;
|
||||
buf += this_count * 512;
|
||||
}while(count != 0 && ret == SSP_SUCCESS);
|
||||
|
||||
mmc_is_active = false;
|
||||
|
||||
mutex_unlock(&mmc_mutex);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int mmc_read_sectors(IF_MD2(int drive,) unsigned long start, int count, void *buf)
|
||||
{
|
||||
return transfer_sectors(IF_MD2(drive,) start, count, buf, true);
|
||||
}
|
||||
|
||||
int mmc_write_sectors(IF_MD2(int drive,) unsigned long start, int count, const void* buf)
|
||||
{
|
||||
return transfer_sectors(IF_MD2(drive,) start, count, (void *)buf, false);
|
||||
}
|
||||
|
||||
bool mmc_present(IF_MD(int drive))
|
||||
{
|
||||
IF_MD((void) drive);
|
||||
return true;
|
||||
}
|
||||
|
||||
bool mmc_removable(IF_MD(int drive))
|
||||
{
|
||||
IF_MD((void) drive);
|
||||
return false;
|
||||
}
|
||||
|
||||
void mmc_sleep(void)
|
||||
{
|
||||
}
|
||||
|
||||
void mmc_sleepnow(void)
|
||||
{
|
||||
}
|
||||
|
||||
bool mmc_disk_is_active(void)
|
||||
{
|
||||
return mmc_is_active;
|
||||
}
|
||||
|
||||
bool mmc_usb_active(void)
|
||||
{
|
||||
return mmc_disk_is_active();
|
||||
}
|
||||
|
||||
int mmc_soft_reset(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mmc_flush(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mmc_spin(void)
|
||||
{
|
||||
}
|
||||
|
||||
void mmc_spindown(int seconds)
|
||||
{
|
||||
(void) seconds;
|
||||
}
|
||||
|
||||
long mmc_last_disk_activity(void)
|
||||
{
|
||||
return mmc_last_activity;
|
||||
}
|
||||
|
||||
int mmc_spinup_time(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mmc_enable(bool enable)
|
||||
{
|
||||
(void) enable;
|
||||
}
|
|
@ -1,515 +0,0 @@
|
|||
/***************************************************************************
|
||||
* __________ __ ___.
|
||||
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||||
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||||
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||||
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||||
* \/ \/ \/ \/ \/
|
||||
* $Id$
|
||||
*
|
||||
* Copyright (C) 2011 by Amaury Pouly
|
||||
*
|
||||
* This program 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||||
* KIND, either express or implied.
|
||||
*
|
||||
****************************************************************************/
|
||||
#include "config.h"
|
||||
#include "system.h"
|
||||
#include "sd.h"
|
||||
#include "sdmmc.h"
|
||||
#include "ssp-imx233.h"
|
||||
#include "pinctrl-imx233.h"
|
||||
#include "partitions-imx233.h"
|
||||
#include "button-target.h"
|
||||
#include "fat.h"
|
||||
#include "disk.h"
|
||||
#include "usb.h"
|
||||
#include "debug.h"
|
||||
|
||||
struct sd_config_t
|
||||
{
|
||||
const char *name; /* name(for debug) */
|
||||
int flags; /* flags */
|
||||
int power_pin; /* power pin */
|
||||
int power_delay; /* extra power up delay */
|
||||
int ssp; /* associated ssp block */
|
||||
};
|
||||
|
||||
/* flags */
|
||||
#define POWER_PIN (1 << 0)
|
||||
#define POWER_INVERTED (1 << 1)
|
||||
#define REMOVABLE (1 << 2)
|
||||
#define DETECT_INVERTED (1 << 3)
|
||||
#define POWER_DELAY (1 << 4)
|
||||
#define WINDOW (1 << 5)
|
||||
|
||||
#define PIN(bank,pin) ((bank) << 5 | (pin))
|
||||
#define PIN2BANK(v) ((v) >> 5)
|
||||
#define PIN2PIN(v) ((v) & 0x1f)
|
||||
|
||||
struct sd_config_t sd_config[] =
|
||||
{
|
||||
#ifdef SANSA_FUZEPLUS
|
||||
/* The Fuze+ uses pin #B0P8 for power */
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | POWER_INVERTED | REMOVABLE,
|
||||
.power_pin = PIN(0, 8),
|
||||
.ssp = 1
|
||||
},
|
||||
#elif defined(CREATIVE_ZENXFI2)
|
||||
/* The Zen X-Fi2 uses pin B1P29 for power*/
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | REMOVABLE | DETECT_INVERTED,
|
||||
.power_pin = PIN(1, 29),
|
||||
.ssp = 1,
|
||||
},
|
||||
#elif defined(CREATIVE_ZENXFI3)
|
||||
{
|
||||
.name = "internal/SD",
|
||||
.flags = WINDOW,
|
||||
.ssp = 2
|
||||
},
|
||||
/* The Zen X-Fi3 uses pin #B0P07 for power*/
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | POWER_INVERTED | REMOVABLE | POWER_DELAY,
|
||||
.power_pin = PIN(0, 7),
|
||||
.power_delay = HZ / 10, /* extra delay, to ramp up voltage? */
|
||||
.ssp = 1
|
||||
},
|
||||
#else
|
||||
#error You need to write the sd config!
|
||||
#endif
|
||||
};
|
||||
|
||||
#define SD_NUM_DRIVES (sizeof(sd_config) / sizeof(sd_config[0]))
|
||||
|
||||
#define SD_CONF(drive) sd_config[drive]
|
||||
#define SD_FLAGS(drive) SD_CONF(drive).flags
|
||||
#define SD_SSP(drive) SD_CONF(drive).ssp
|
||||
#define IF_FIRST_DRIVE(drive) if((drive) == 0)
|
||||
#define IF_SECOND_DRIVE(drive) if((drive) == 1)
|
||||
|
||||
static tCardInfo card_info[SD_NUM_DRIVES];
|
||||
static long sd_stack[(DEFAULT_STACK_SIZE*2 + 0x200)/sizeof(long)];
|
||||
static struct mutex sd_mutex;
|
||||
static const char sd_thread_name[] = "sd";
|
||||
static struct event_queue sd_queue;
|
||||
static int sd_first_drive;
|
||||
static int last_disk_activity;
|
||||
static unsigned sd_window_start[SD_NUM_DRIVES];
|
||||
static unsigned sd_window_end[SD_NUM_DRIVES];
|
||||
|
||||
static void sd_detect_callback(int ssp)
|
||||
{
|
||||
/* This is called only if the state was stable for 300ms - check state
|
||||
* and post appropriate event. */
|
||||
if(imx233_ssp_sdmmc_detect(ssp))
|
||||
queue_broadcast(SYS_HOTSWAP_INSERTED, 0);
|
||||
else
|
||||
queue_broadcast(SYS_HOTSWAP_EXTRACTED, 0);
|
||||
imx233_ssp_sdmmc_setup_detect(ssp, true, sd_detect_callback, false,
|
||||
imx233_ssp_sdmmc_is_detect_inverted(ssp));
|
||||
}
|
||||
|
||||
void sd_power(int drive, bool on)
|
||||
{
|
||||
/* power chip if needed */
|
||||
if(SD_FLAGS(drive) & POWER_PIN)
|
||||
{
|
||||
int bank = PIN2BANK(SD_CONF(drive).power_pin);
|
||||
int pin = PIN2PIN(SD_CONF(drive).power_pin);
|
||||
imx233_pinctrl_acquire_pin(bank, pin, "sd power");
|
||||
imx233_set_pin_function(bank, pin, PINCTRL_FUNCTION_GPIO);
|
||||
imx233_enable_gpio_output(bank, pin, true);
|
||||
if(SD_FLAGS(drive) & POWER_INVERTED)
|
||||
imx233_set_gpio_output(bank, pin, !on);
|
||||
else
|
||||
imx233_set_gpio_output(bank, pin, on);
|
||||
}
|
||||
if(SD_FLAGS(drive) & POWER_DELAY)
|
||||
sleep(SD_CONF(drive).power_delay);
|
||||
/* setup pins, never use alternatives pin on SSP1 because these are force
|
||||
* bus width >= 4 and SD cannot use more than 4 data lines. */
|
||||
if(SD_SSP(drive) == 1)
|
||||
imx233_ssp_setup_ssp1_sd_mmc_pins(on, 4, PINCTRL_DRIVE_4mA, false);
|
||||
else
|
||||
imx233_ssp_setup_ssp2_sd_mmc_pins(on, 4, PINCTRL_DRIVE_4mA);
|
||||
}
|
||||
|
||||
void sd_enable(bool on)
|
||||
{
|
||||
(void) on;
|
||||
}
|
||||
|
||||
#define MCI_NO_RESP 0
|
||||
#define MCI_RESP (1<<0)
|
||||
#define MCI_LONG_RESP (1<<1)
|
||||
#define MCI_ACMD (1<<2)
|
||||
#define MCI_NOCRC (1<<3)
|
||||
#define MCI_BUSY (1<<4)
|
||||
|
||||
static bool send_cmd(int drive, uint8_t cmd, uint32_t arg, uint32_t flags, uint32_t *resp)
|
||||
{
|
||||
if((flags & MCI_ACMD) && !send_cmd(drive, SD_APP_CMD, card_info[drive].rca, MCI_RESP, resp))
|
||||
return false;
|
||||
|
||||
enum imx233_ssp_resp_t resp_type = (flags & MCI_LONG_RESP) ? SSP_LONG_RESP :
|
||||
(flags & MCI_RESP) ? SSP_SHORT_RESP : SSP_NO_RESP;
|
||||
enum imx233_ssp_error_t ret = imx233_ssp_sd_mmc_transfer(SD_SSP(drive), cmd,
|
||||
arg, resp_type, NULL, 0, !!(flags & MCI_BUSY), false, resp);
|
||||
if(resp_type == SSP_LONG_RESP)
|
||||
{
|
||||
/* Our SD codes assume most significant word first, so reverse resp */
|
||||
uint32_t tmp = resp[0];
|
||||
resp[0] = resp[3];
|
||||
resp[3] = tmp;
|
||||
tmp = resp[1];
|
||||
resp[1] = resp[2];
|
||||
resp[2] = tmp;
|
||||
}
|
||||
return ret == SSP_SUCCESS;
|
||||
}
|
||||
|
||||
static int sd_wait_for_tran_state(int drive)
|
||||
{
|
||||
unsigned long response;
|
||||
unsigned int timeout = current_tick + 5*HZ;
|
||||
int cmd_retry = 10;
|
||||
|
||||
while (1)
|
||||
{
|
||||
while(!send_cmd(drive, SD_SEND_STATUS, card_info[drive].rca, MCI_RESP, &response) && cmd_retry > 0)
|
||||
cmd_retry--;
|
||||
|
||||
if(cmd_retry <= 0)
|
||||
return -1;
|
||||
|
||||
if(((response >> 9) & 0xf) == SD_TRAN)
|
||||
return 0;
|
||||
|
||||
if(TIME_AFTER(current_tick, timeout))
|
||||
return -10 * ((response >> 9) & 0xf);
|
||||
|
||||
last_disk_activity = current_tick;
|
||||
}
|
||||
}
|
||||
|
||||
static int sd_init_card(int drive)
|
||||
{
|
||||
/* sanity check against bad configuration of SD_NUM_DRIVES/NUM_DRIVES */
|
||||
if((unsigned)drive >= SD_NUM_DRIVES)
|
||||
panicf("drive >= SD_NUM_DRIVES in sd_init_card!");
|
||||
int ssp = SD_SSP(drive);
|
||||
sd_power(drive, false);
|
||||
sd_power(drive, true);
|
||||
imx233_ssp_start(ssp);
|
||||
imx233_ssp_softreset(ssp);
|
||||
imx233_ssp_set_mode(ssp, HW_SSP_CTRL1__SSP_MODE__SD_MMC);
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96000 / 240 / 1 = 400kHz */
|
||||
imx233_ssp_set_timings(ssp, 240, 0, 0xffff);
|
||||
|
||||
imx233_ssp_sd_mmc_power_up_sequence(ssp);
|
||||
imx233_ssp_set_bus_width(ssp, 1);
|
||||
imx233_ssp_set_block_size(ssp, 9);
|
||||
|
||||
card_info[drive].rca = 0;
|
||||
bool sd_v2 = false;
|
||||
uint32_t resp;
|
||||
long init_timeout;
|
||||
/* go to idle state */
|
||||
if(!send_cmd(drive, SD_GO_IDLE_STATE, 0, MCI_NO_RESP, NULL))
|
||||
return -1;
|
||||
/* CMD8 Check for v2 sd card. Must be sent before using ACMD41
|
||||
Non v2 cards will not respond to this command */
|
||||
if(send_cmd(drive, SD_SEND_IF_COND, 0x1AA, MCI_RESP, &resp))
|
||||
if((resp & 0xFFF) == 0x1AA)
|
||||
sd_v2 = true;
|
||||
/* timeout for initialization is 1sec, from SD Specification 2.00 */
|
||||
init_timeout = current_tick + HZ;
|
||||
do
|
||||
{
|
||||
/* this timeout is the only valid error for this loop*/
|
||||
if(TIME_AFTER(current_tick, init_timeout))
|
||||
return -2;
|
||||
|
||||
/* ACMD41 For v2 cards set HCS bit[30] & send host voltage range to all */
|
||||
if(!send_cmd(drive, SD_APP_OP_COND, (0x00FF8000 | (sd_v2 ? 1<<30 : 0)),
|
||||
MCI_ACMD|MCI_NOCRC|MCI_RESP, &card_info[drive].ocr))
|
||||
return -100;
|
||||
} while(!(card_info[drive].ocr & (1<<31)));
|
||||
|
||||
/* CMD2 send CID */
|
||||
if(!send_cmd(drive, SD_ALL_SEND_CID, 0, MCI_RESP|MCI_LONG_RESP, card_info[drive].cid))
|
||||
return -3;
|
||||
|
||||
/* CMD3 send RCA */
|
||||
if(!send_cmd(drive, SD_SEND_RELATIVE_ADDR, 0, MCI_RESP, &card_info[drive].rca))
|
||||
return -4;
|
||||
|
||||
/* Try to switch V2 cards to HS timings, non HS seem to ignore this */
|
||||
if(sd_v2)
|
||||
{
|
||||
/* CMD7 w/rca: Select card to put it in TRAN state */
|
||||
if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_RESP, NULL))
|
||||
return -5;
|
||||
|
||||
if(sd_wait_for_tran_state(drive))
|
||||
return -6;
|
||||
|
||||
/* CMD6 */
|
||||
if(!send_cmd(drive, SD_SWITCH_FUNC, 0x80fffff1, MCI_NO_RESP, NULL))
|
||||
return -7;
|
||||
sleep(HZ/10);
|
||||
|
||||
/* go back to STBY state so we can read csd */
|
||||
/* CMD7 w/rca=0: Deselect card to put it in STBY state */
|
||||
if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
|
||||
return -8;
|
||||
}
|
||||
|
||||
/* CMD9 send CSD */
|
||||
if(!send_cmd(drive, SD_SEND_CSD, card_info[drive].rca, MCI_RESP|MCI_LONG_RESP, card_info[drive].csd))
|
||||
return -9;
|
||||
|
||||
sd_parse_csd(&card_info[drive]);
|
||||
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96 / 4 / 1 = 24MHz */
|
||||
imx233_ssp_set_timings(ssp, 4, 0, 0xffff);
|
||||
|
||||
/* CMD7 w/rca: Select card to put it in TRAN state */
|
||||
if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_RESP, &resp))
|
||||
return -12;
|
||||
if(sd_wait_for_tran_state(drive) < 0)
|
||||
return -13;
|
||||
|
||||
/* ACMD6: set bus width to 4-bit */
|
||||
if(!send_cmd(drive, SD_SET_BUS_WIDTH, 2, MCI_RESP|MCI_ACMD, &resp))
|
||||
return -15;
|
||||
/* ACMD42: disconnect the pull-up resistor on CD/DAT3 */
|
||||
if(!send_cmd(drive, SD_SET_CLR_CARD_DETECT, 0, MCI_RESP|MCI_ACMD, &resp))
|
||||
return -17;
|
||||
|
||||
/* Switch to 4-bit */
|
||||
imx233_ssp_set_bus_width(ssp, 4);
|
||||
|
||||
card_info[drive].initialized = 1;
|
||||
|
||||
/* compute window */
|
||||
sd_window_start[drive] = 0;
|
||||
sd_window_end[drive] = card_info[drive].numblocks;
|
||||
if((SD_FLAGS(drive) & WINDOW) && imx233_partitions_is_window_enabled())
|
||||
{
|
||||
/* WARNING: sd_first_drive is not set at this point */
|
||||
uint8_t mbr[512];
|
||||
int ret = sd_read_sectors(IF_MD2(drive,) 0, 1, mbr);
|
||||
if(ret)
|
||||
panicf("Cannot read MBR: %d", ret);
|
||||
ret = imx233_partitions_compute_window(mbr, &sd_window_start[drive],
|
||||
&sd_window_end[drive]);
|
||||
if(ret)
|
||||
panicf("cannot compute partitions window: %d", ret);
|
||||
card_info[drive].numblocks = sd_window_end[drive] - sd_window_start[drive];
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void sd_thread(void) NORETURN_ATTR;
|
||||
static void sd_thread(void)
|
||||
{
|
||||
struct queue_event ev;
|
||||
|
||||
while (1)
|
||||
{
|
||||
queue_wait_w_tmo(&sd_queue, &ev, HZ);
|
||||
|
||||
switch(ev.id)
|
||||
{
|
||||
case SYS_HOTSWAP_INSERTED:
|
||||
case SYS_HOTSWAP_EXTRACTED:
|
||||
{
|
||||
int microsd_init = 1;
|
||||
/* lock-out FAT activity first -
|
||||
* prevent deadlocking via disk_mount that
|
||||
* would cause a reverse-order attempt with
|
||||
* another thread */
|
||||
fat_lock();
|
||||
/* lock-out card activity - direct calls
|
||||
* into driver that bypass the fat cache */
|
||||
mutex_lock(&sd_mutex);
|
||||
|
||||
/* We now have exclusive control of fat cache and sd.
|
||||
* Release "by force", ensure file
|
||||
* descriptors aren't leaked and any busy
|
||||
* ones are invalid if mounting. */
|
||||
for(unsigned drive = 0; drive < SD_NUM_DRIVES; drive++)
|
||||
{
|
||||
/* Skip non-removable drivers */
|
||||
if(!sd_removable(drive))
|
||||
continue;
|
||||
disk_unmount(sd_first_drive + drive);
|
||||
/* Force card init for new card, re-init for re-inserted one or
|
||||
* clear if the last attempt to init failed with an error. */
|
||||
card_info[drive].initialized = 0;
|
||||
|
||||
if(ev.id == SYS_HOTSWAP_INSERTED)
|
||||
{
|
||||
microsd_init = sd_init_card(drive);
|
||||
if(microsd_init < 0) /* initialisation failed */
|
||||
panicf("%s init failed : %d", SD_CONF(drive).name, microsd_init);
|
||||
|
||||
microsd_init = disk_mount(sd_first_drive + drive); /* 0 if fail */
|
||||
}
|
||||
/*
|
||||
* Mount succeeded, or this was an EXTRACTED event,
|
||||
* in both cases notify the system about the changed filesystems
|
||||
*/
|
||||
if(microsd_init)
|
||||
queue_broadcast(SYS_FS_CHANGED, 0);
|
||||
}
|
||||
/* Access is now safe */
|
||||
mutex_unlock(&sd_mutex);
|
||||
fat_unlock();
|
||||
break;
|
||||
}
|
||||
case SYS_TIMEOUT:
|
||||
if(!TIME_BEFORE(current_tick, last_disk_activity +3 * HZ))
|
||||
sd_enable(false);
|
||||
break;
|
||||
case SYS_USB_CONNECTED:
|
||||
usb_acknowledge(SYS_USB_CONNECTED_ACK);
|
||||
/* Wait until the USB cable is extracted again */
|
||||
usb_wait_for_disconnect(&sd_queue);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int sd_init(void)
|
||||
{
|
||||
mutex_init(&sd_mutex);
|
||||
queue_init(&sd_queue, true);
|
||||
create_thread(sd_thread, sd_stack, sizeof(sd_stack), 0,
|
||||
sd_thread_name IF_PRIO(, PRIORITY_USER_INTERFACE) IF_COP(, CPU));
|
||||
|
||||
for(unsigned drive = 0; drive < SD_NUM_DRIVES; drive++)
|
||||
{
|
||||
if(SD_FLAGS(drive) & REMOVABLE)
|
||||
imx233_ssp_sdmmc_setup_detect(SD_SSP(drive), true, sd_detect_callback,
|
||||
false, SD_FLAGS(drive) & DETECT_INVERTED);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int transfer_sectors(IF_MD2(int drive,) unsigned long start, int count, void *buf, bool read)
|
||||
{
|
||||
int ret = 0;
|
||||
uint32_t resp;
|
||||
|
||||
last_disk_activity = current_tick;
|
||||
|
||||
mutex_lock(&sd_mutex);
|
||||
|
||||
if(card_info[drive].initialized <= 0)
|
||||
{
|
||||
ret = sd_init_card(drive);
|
||||
if(card_info[drive].initialized <= 0)
|
||||
goto Lend;
|
||||
}
|
||||
|
||||
/* check window */
|
||||
start += sd_window_start[drive];
|
||||
if((start + count) >= sd_window_end[drive])
|
||||
{
|
||||
ret = -201;
|
||||
goto Lend;
|
||||
}
|
||||
|
||||
if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_NO_RESP, NULL))
|
||||
{
|
||||
ret = -20;
|
||||
goto Lend;
|
||||
}
|
||||
ret = sd_wait_for_tran_state(drive);
|
||||
if(ret < 0)
|
||||
goto Ldeselect;
|
||||
while(count != 0)
|
||||
{
|
||||
int this_count = MIN(count, IMX233_MAX_SSP_XFER_SIZE / 512);
|
||||
/* Set bank_start to the correct unit (blocks or bytes) */
|
||||
int bank_start = start;
|
||||
if(!(card_info[drive].ocr & (1<<30))) /* not SDHC */
|
||||
bank_start *= SD_BLOCK_SIZE;
|
||||
ret = imx233_ssp_sd_mmc_transfer(SD_SSP(drive),
|
||||
read ? SD_READ_MULTIPLE_BLOCK : SD_WRITE_MULTIPLE_BLOCK,
|
||||
bank_start, SSP_SHORT_RESP, buf, this_count, false, read, &resp);
|
||||
if(ret != SSP_SUCCESS)
|
||||
break;
|
||||
if(!send_cmd(drive, SD_STOP_TRANSMISSION, 0, MCI_RESP|MCI_BUSY, &resp))
|
||||
{
|
||||
ret = -15;
|
||||
break;
|
||||
}
|
||||
count -= this_count;
|
||||
start += this_count;
|
||||
buf += this_count * 512;
|
||||
}
|
||||
|
||||
Ldeselect:
|
||||
/* CMD7 w/rca =0 : deselects card & puts it in STBY state */
|
||||
if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
|
||||
ret = -23;
|
||||
Lend:
|
||||
mutex_unlock(&sd_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int sd_read_sectors(IF_MD2(int drive,) unsigned long start, int count, void* buf)
|
||||
{
|
||||
return transfer_sectors(IF_MD2(drive,) start, count, buf, true);
|
||||
}
|
||||
|
||||
int sd_write_sectors(IF_MD2(int drive,) unsigned long start, int count, const void* buf)
|
||||
{
|
||||
return transfer_sectors(IF_MD2(drive,) start, count, (void *)buf, false);
|
||||
}
|
||||
|
||||
tCardInfo *card_get_info_target(int card_no)
|
||||
{
|
||||
return &card_info[card_no];
|
||||
}
|
||||
|
||||
int sd_num_drives(int first_drive)
|
||||
{
|
||||
sd_first_drive = first_drive;
|
||||
return SD_NUM_DRIVES;
|
||||
}
|
||||
|
||||
bool sd_present(IF_MV_NONVOID(int drive))
|
||||
{
|
||||
if(SD_FLAGS(drive) & REMOVABLE)
|
||||
return imx233_ssp_sdmmc_detect(SD_SSP(drive));
|
||||
else
|
||||
return true;
|
||||
}
|
||||
|
||||
bool sd_removable(IF_MV_NONVOID(int drive))
|
||||
{
|
||||
return SD_FLAGS(drive) & REMOVABLE;
|
||||
}
|
||||
|
||||
long sd_last_disk_activity(void)
|
||||
{
|
||||
return last_disk_activity;
|
||||
}
|
|
@ -0,0 +1,874 @@
|
|||
/***************************************************************************
|
||||
* __________ __ ___.
|
||||
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||||
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||||
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||||
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||||
* \/ \/ \/ \/ \/
|
||||
* $Id$
|
||||
*
|
||||
* Copyright (C) 2011 by Amaury Pouly
|
||||
*
|
||||
* This program 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||||
* KIND, either express or implied.
|
||||
*
|
||||
****************************************************************************/
|
||||
#include "config.h"
|
||||
#include "system.h"
|
||||
#include "sd.h"
|
||||
#include "sdmmc.h"
|
||||
#include "ssp-imx233.h"
|
||||
#include "pinctrl-imx233.h"
|
||||
#include "partitions-imx233.h"
|
||||
#include "button-target.h"
|
||||
#include "fat.h"
|
||||
#include "disk.h"
|
||||
#include "usb.h"
|
||||
#include "debug.h"
|
||||
#include "string.h"
|
||||
|
||||
struct sdmmc_config_t
|
||||
{
|
||||
const char *name; /* name(for debug) */
|
||||
int flags; /* flags */
|
||||
int power_pin; /* power pin */
|
||||
int power_delay; /* extra power up delay */
|
||||
int ssp; /* associated ssp block */
|
||||
int mode; /* mode (SD vs MMC) */
|
||||
};
|
||||
|
||||
/* flags */
|
||||
#define POWER_PIN (1 << 0)
|
||||
#define POWER_INVERTED (1 << 1)
|
||||
#define REMOVABLE (1 << 2)
|
||||
#define DETECT_INVERTED (1 << 3)
|
||||
#define POWER_DELAY (1 << 4)
|
||||
#define WINDOW (1 << 5)
|
||||
|
||||
/* modes */
|
||||
#define SD_MODE 0
|
||||
#define MMC_MODE 1
|
||||
|
||||
#define PIN(bank,pin) ((bank) << 5 | (pin))
|
||||
#define PIN2BANK(v) ((v) >> 5)
|
||||
#define PIN2PIN(v) ((v) & 0x1f)
|
||||
|
||||
struct sdmmc_config_t sdmmc_config[] =
|
||||
{
|
||||
#ifdef SANSA_FUZEPLUS
|
||||
/* The Fuze+ uses pin #B0P8 for power */
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | POWER_INVERTED | REMOVABLE,
|
||||
.power_pin = PIN(0, 8),
|
||||
.ssp = 1,
|
||||
.mode = SD_MODE,
|
||||
},
|
||||
/* The Fuze+ uses pin #B1P29 for power */
|
||||
{
|
||||
.name = "eMMC",
|
||||
.flags = POWER_PIN | POWER_INVERTED | WINDOW | POWER_DELAY,
|
||||
.power_pin = PIN(1, 29),
|
||||
.power_delay = HZ / 5, /* extra delay, to ramp up voltage? */
|
||||
.ssp = 2,
|
||||
.mode = MMC_MODE,
|
||||
},
|
||||
#elif defined(CREATIVE_ZENXFI2)
|
||||
/* The Zen X-Fi2 uses pin B1P29 for power*/
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | REMOVABLE | DETECT_INVERTED,
|
||||
.power_pin = PIN(1, 29),
|
||||
.ssp = 1,
|
||||
.mode = SD_MODE,
|
||||
},
|
||||
#elif defined(CREATIVE_ZENXFI3)
|
||||
{
|
||||
.name = "internal/SD",
|
||||
.flags = WINDOW,
|
||||
.ssp = 2,
|
||||
.mode = SD_MODE,
|
||||
},
|
||||
/* The Zen X-Fi3 uses pin #B0P07 for power*/
|
||||
{
|
||||
.name = "microSD",
|
||||
.flags = POWER_PIN | POWER_INVERTED | REMOVABLE | POWER_DELAY,
|
||||
.power_pin = PIN(0, 7),
|
||||
.power_delay = HZ / 10, /* extra delay, to ramp up voltage? */
|
||||
.ssp = 1,
|
||||
.mode = SD_MODE,
|
||||
},
|
||||
#else
|
||||
#error You need to write the sd/mmc config!
|
||||
#endif
|
||||
};
|
||||
|
||||
#define SDMMC_NUM_DRIVES (sizeof(sdmmc_config) / sizeof(sdmmc_config[0]))
|
||||
|
||||
#define SDMMC_CONF(drive) sdmmc_config[drive]
|
||||
#define SDMMC_FLAGS(drive) SDMMC_CONF(drive).flags
|
||||
#define SDMMC_SSP(drive) SDMMC_CONF(drive).ssp
|
||||
#define SDMMC_MODE(drive) SDMMC_CONF(drive).mode
|
||||
|
||||
/* common */
|
||||
static unsigned window_start[SDMMC_NUM_DRIVES];
|
||||
static unsigned window_end[SDMMC_NUM_DRIVES];
|
||||
static uint8_t aligned_buffer[SDMMC_NUM_DRIVES][512] CACHEALIGN_ATTR;
|
||||
static tCardInfo sdmmc_card_info[SDMMC_NUM_DRIVES];
|
||||
|
||||
#define SDMMC_INFO(drive) sdmmc_card_info[drive]
|
||||
#define SDMMC_RCA(drive) SDMMC_INFO(drive).rca
|
||||
|
||||
/* sd only */
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
static long sd_stack[(DEFAULT_STACK_SIZE*2 + 0x200)/sizeof(long)];
|
||||
static struct mutex sd_mutex;
|
||||
static const char sd_thread_name[] = "sd";
|
||||
static struct event_queue sd_queue;
|
||||
static int sd_first_drive;
|
||||
static unsigned _sd_num_drives;
|
||||
static int _sd_last_disk_activity;
|
||||
static int sd_map[SDMMC_NUM_DRIVES]; /* sd->sdmmc map */
|
||||
#endif
|
||||
/* mmc only */
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
static int mmc_first_drive;
|
||||
static unsigned _mmc_num_drives;
|
||||
static int _mmc_last_disk_activity;
|
||||
static int mmc_map[SDMMC_NUM_DRIVES]; /* mmc->sdmmc map */
|
||||
#endif
|
||||
|
||||
/* WARNING NOTE BUG FIXME
|
||||
* There are three numbering schemes involved in the driver:
|
||||
* - the sdmmc indexes into sdmmc_config[]
|
||||
* - the sd drive indexes
|
||||
* - the mmc drive indexes
|
||||
* By convention, [drive] refers to a sdmmc index whereas sd_drive/mmc_drive
|
||||
* refer to sd/mmc drive indexes. We keep two maps sd->sdmmc and mmc->sdmmc
|
||||
* to find the sdmmc index from the sd or mmc one */
|
||||
|
||||
static void sdmmc_detect_callback(int ssp)
|
||||
{
|
||||
/* This is called only if the state was stable for 300ms - check state
|
||||
* and post appropriate event. */
|
||||
if(imx233_ssp_sdmmc_detect(ssp))
|
||||
queue_broadcast(SYS_HOTSWAP_INSERTED, 0);
|
||||
else
|
||||
queue_broadcast(SYS_HOTSWAP_EXTRACTED, 0);
|
||||
imx233_ssp_sdmmc_setup_detect(ssp, true, sdmmc_detect_callback, false,
|
||||
imx233_ssp_sdmmc_is_detect_inverted(ssp));
|
||||
}
|
||||
|
||||
static void sdmmc_power(int drive, bool on)
|
||||
{
|
||||
/* power chip if needed */
|
||||
if(SDMMC_FLAGS(drive) & POWER_PIN)
|
||||
{
|
||||
int bank = PIN2BANK(SDMMC_CONF(drive).power_pin);
|
||||
int pin = PIN2PIN(SDMMC_CONF(drive).power_pin);
|
||||
imx233_pinctrl_acquire_pin(bank, pin, "sd/mmc power");
|
||||
imx233_set_pin_function(bank, pin, PINCTRL_FUNCTION_GPIO);
|
||||
imx233_enable_gpio_output(bank, pin, true);
|
||||
if(SDMMC_FLAGS(drive) & POWER_INVERTED)
|
||||
imx233_set_gpio_output(bank, pin, !on);
|
||||
else
|
||||
imx233_set_gpio_output(bank, pin, on);
|
||||
}
|
||||
if(SDMMC_FLAGS(drive) & POWER_DELAY)
|
||||
sleep(SDMMC_CONF(drive).power_delay);
|
||||
/* setup pins, never use alternatives pin on SSP1 because no device use it
|
||||
* but this could be made a flag */
|
||||
int bus_width = SDMMC_MODE(drive) == MMC_MODE ? 8 : 4;
|
||||
if(SDMMC_SSP(drive) == 1)
|
||||
imx233_ssp_setup_ssp1_sd_mmc_pins(on, bus_width, PINCTRL_DRIVE_4mA, false);
|
||||
else
|
||||
imx233_ssp_setup_ssp2_sd_mmc_pins(on, bus_width, PINCTRL_DRIVE_4mA);
|
||||
}
|
||||
|
||||
#define MCI_NO_RESP 0
|
||||
#define MCI_RESP (1<<0)
|
||||
#define MCI_LONG_RESP (1<<1)
|
||||
#define MCI_ACMD (1<<2)
|
||||
#define MCI_NOCRC (1<<3)
|
||||
#define MCI_BUSY (1<<4)
|
||||
|
||||
static bool send_sd_cmd(int drive, uint8_t cmd, uint32_t arg, uint32_t flags, uint32_t *resp)
|
||||
{
|
||||
if((flags & MCI_ACMD) && !send_sd_cmd(drive, SD_APP_CMD, SDMMC_RCA(drive), MCI_RESP, resp))
|
||||
return false;
|
||||
|
||||
enum imx233_ssp_resp_t resp_type = (flags & MCI_LONG_RESP) ? SSP_LONG_RESP :
|
||||
(flags & MCI_RESP) ? SSP_SHORT_RESP : SSP_NO_RESP;
|
||||
enum imx233_ssp_error_t ret = imx233_ssp_sd_mmc_transfer(SDMMC_SSP(drive), cmd,
|
||||
arg, resp_type, NULL, 0, !!(flags & MCI_BUSY), false, resp);
|
||||
if(resp_type == SSP_LONG_RESP)
|
||||
{
|
||||
/* Our SD codes assume most significant word first, so reverse resp */
|
||||
uint32_t tmp = resp[0];
|
||||
resp[0] = resp[3];
|
||||
resp[3] = tmp;
|
||||
tmp = resp[1];
|
||||
resp[1] = resp[2];
|
||||
resp[2] = tmp;
|
||||
}
|
||||
return ret == SSP_SUCCESS;
|
||||
}
|
||||
|
||||
static int wait_for_sd_tran_state(int drive)
|
||||
{
|
||||
unsigned long response;
|
||||
unsigned int timeout = current_tick + 5*HZ;
|
||||
int cmd_retry = 10;
|
||||
|
||||
while (1)
|
||||
{
|
||||
while(!send_sd_cmd(drive, SD_SEND_STATUS, SDMMC_RCA(drive), MCI_RESP, &response) && cmd_retry > 0)
|
||||
cmd_retry--;
|
||||
|
||||
if(cmd_retry <= 0)
|
||||
return -1;
|
||||
|
||||
if(((response >> 9) & 0xf) == SD_TRAN)
|
||||
return 0;
|
||||
|
||||
if(TIME_AFTER(current_tick, timeout))
|
||||
return -10 * ((response >> 9) & 0xf);
|
||||
|
||||
_sd_last_disk_activity = current_tick;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
static int sdmmc_init_sd_card(int drive)
|
||||
{
|
||||
int ssp = SDMMC_SSP(drive);
|
||||
sdmmc_power(drive, false);
|
||||
sdmmc_power(drive, true);
|
||||
imx233_ssp_start(ssp);
|
||||
imx233_ssp_softreset(ssp);
|
||||
imx233_ssp_set_mode(ssp, HW_SSP_CTRL1__SSP_MODE__SD_MMC);
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96000 / 240 / 1 = 400kHz */
|
||||
imx233_ssp_set_timings(ssp, 240, 0, 0xffff);
|
||||
|
||||
imx233_ssp_sd_mmc_power_up_sequence(ssp);
|
||||
imx233_ssp_set_bus_width(ssp, 1);
|
||||
imx233_ssp_set_block_size(ssp, 9);
|
||||
|
||||
SDMMC_RCA(drive) = 0;
|
||||
bool sd_v2 = false;
|
||||
uint32_t resp;
|
||||
long init_timeout;
|
||||
/* go to idle state */
|
||||
if(!send_sd_cmd(drive, SD_GO_IDLE_STATE, 0, MCI_NO_RESP, NULL))
|
||||
return -1;
|
||||
/* CMD8 Check for v2 sd card. Must be sent before using ACMD41
|
||||
Non v2 cards will not respond to this command */
|
||||
if(send_sd_cmd(drive, SD_SEND_IF_COND, 0x1AA, MCI_RESP, &resp))
|
||||
if((resp & 0xFFF) == 0x1AA)
|
||||
sd_v2 = true;
|
||||
/* timeout for initialization is 1sec, from SD Specification 2.00 */
|
||||
init_timeout = current_tick + HZ;
|
||||
do
|
||||
{
|
||||
/* this timeout is the only valid error for this loop*/
|
||||
if(TIME_AFTER(current_tick, init_timeout))
|
||||
return -2;
|
||||
|
||||
/* ACMD41 For v2 cards set HCS bit[30] & send host voltage range to all */
|
||||
if(!send_sd_cmd(drive, SD_APP_OP_COND, (0x00FF8000 | (sd_v2 ? 1<<30 : 0)),
|
||||
MCI_ACMD|MCI_NOCRC|MCI_RESP, &SDMMC_INFO(drive).ocr))
|
||||
return -100;
|
||||
} while(!(SDMMC_INFO(drive).ocr & (1<<31)));
|
||||
|
||||
/* CMD2 send CID */
|
||||
if(!send_sd_cmd(drive, SD_ALL_SEND_CID, 0, MCI_RESP|MCI_LONG_RESP, SDMMC_INFO(drive).cid))
|
||||
return -3;
|
||||
|
||||
/* CMD3 send RCA */
|
||||
if(!send_sd_cmd(drive, SD_SEND_RELATIVE_ADDR, 0, MCI_RESP, &SDMMC_INFO(drive).rca))
|
||||
return -4;
|
||||
|
||||
/* Try to switch V2 cards to HS timings, non HS seem to ignore this */
|
||||
if(sd_v2)
|
||||
{
|
||||
/* CMD7 w/rca: Select card to put it in TRAN state */
|
||||
if(!send_sd_cmd(drive, SD_SELECT_CARD, SDMMC_RCA(drive), MCI_RESP, NULL))
|
||||
return -5;
|
||||
|
||||
if(wait_for_sd_tran_state(drive))
|
||||
return -6;
|
||||
|
||||
/* CMD6 */
|
||||
if(!send_sd_cmd(drive, SD_SWITCH_FUNC, 0x80fffff1, MCI_NO_RESP, NULL))
|
||||
return -7;
|
||||
sleep(HZ/10);
|
||||
|
||||
/* go back to STBY state so we can read csd */
|
||||
/* CMD7 w/rca=0: Deselect card to put it in STBY state */
|
||||
if(!send_sd_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
|
||||
return -8;
|
||||
}
|
||||
|
||||
/* CMD9 send CSD */
|
||||
if(!send_sd_cmd(drive, SD_SEND_CSD, SDMMC_RCA(drive), MCI_RESP|MCI_LONG_RESP,
|
||||
SDMMC_INFO(drive).csd))
|
||||
return -9;
|
||||
|
||||
sd_parse_csd(&SDMMC_INFO(drive));
|
||||
window_start[drive] = 0;
|
||||
window_end[drive] = SDMMC_INFO(drive).numblocks;
|
||||
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96 / 4 / 1 = 24MHz */
|
||||
imx233_ssp_set_timings(ssp, 4, 0, 0xffff);
|
||||
|
||||
/* CMD7 w/rca: Select card to put it in TRAN state */
|
||||
if(!send_sd_cmd(drive, SD_SELECT_CARD, SDMMC_RCA(drive), MCI_RESP, &resp))
|
||||
return -12;
|
||||
if(wait_for_sd_tran_state(drive) < 0)
|
||||
return -13;
|
||||
|
||||
/* ACMD6: set bus width to 4-bit */
|
||||
if(!send_sd_cmd(drive, SD_SET_BUS_WIDTH, 2, MCI_RESP|MCI_ACMD, &resp))
|
||||
return -15;
|
||||
/* ACMD42: disconnect the pull-up resistor on CD/DAT3 */
|
||||
if(!send_sd_cmd(drive, SD_SET_CLR_CARD_DETECT, 0, MCI_RESP|MCI_ACMD, &resp))
|
||||
return -17;
|
||||
|
||||
/* Switch to 4-bit */
|
||||
imx233_ssp_set_bus_width(ssp, 4);
|
||||
|
||||
SDMMC_INFO(drive).initialized = 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int transfer_sd_sectors(int drive, unsigned long start, int count, void *buf, bool read)
|
||||
{
|
||||
int ret = 0;
|
||||
uint32_t resp;
|
||||
|
||||
_sd_last_disk_activity = current_tick;
|
||||
|
||||
mutex_lock(&sd_mutex);
|
||||
|
||||
if(SDMMC_INFO(drive).initialized <= 0)
|
||||
{
|
||||
ret = sdmmc_init_sd_card(drive);
|
||||
if(SDMMC_INFO(drive).initialized <= 0)
|
||||
goto Lend;
|
||||
}
|
||||
|
||||
/* check window */
|
||||
start += window_start[drive];
|
||||
if((start + count) > window_end[drive])
|
||||
{
|
||||
ret = -201;
|
||||
goto Lend;
|
||||
}
|
||||
|
||||
if(!send_sd_cmd(drive, SD_SELECT_CARD, SDMMC_RCA(drive), MCI_NO_RESP, NULL))
|
||||
{
|
||||
ret = -20;
|
||||
goto Lend;
|
||||
}
|
||||
ret = wait_for_sd_tran_state(drive);
|
||||
if(ret < 0)
|
||||
goto Ldeselect;
|
||||
while(count != 0)
|
||||
{
|
||||
/* FIXME implement this_count > 1 by using a sub-buffer of [sub] that is
|
||||
* cache-aligned and then moving the data when possible. This way we could
|
||||
* transfer much greater amount of data at once */
|
||||
int this_count = 1;
|
||||
/* Set bank_start to the correct unit (blocks or bytes) */
|
||||
int bank_start = start;
|
||||
if(!(SDMMC_INFO(drive).ocr & (1<<30))) /* not SDHC */
|
||||
bank_start *= SD_BLOCK_SIZE;
|
||||
if(!read)
|
||||
memcpy(aligned_buffer[drive], buf, 512);
|
||||
ret = imx233_ssp_sd_mmc_transfer(SDMMC_SSP(drive),
|
||||
read ? SD_READ_MULTIPLE_BLOCK : SD_WRITE_MULTIPLE_BLOCK,
|
||||
bank_start, SSP_SHORT_RESP, aligned_buffer[drive], this_count, false, read, &resp);
|
||||
if(ret != SSP_SUCCESS)
|
||||
break;
|
||||
if(!send_sd_cmd(drive, SD_STOP_TRANSMISSION, 0, MCI_RESP|MCI_BUSY, &resp))
|
||||
{
|
||||
ret = -15;
|
||||
break;
|
||||
}
|
||||
if(read)
|
||||
memcpy(buf, aligned_buffer[drive], 512);
|
||||
count -= this_count;
|
||||
start += this_count;
|
||||
buf += this_count * 512;
|
||||
}
|
||||
|
||||
Ldeselect:
|
||||
/* CMD7 w/rca =0 : deselects card & puts it in STBY state */
|
||||
if(!send_sd_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
|
||||
ret = -23;
|
||||
Lend:
|
||||
mutex_unlock(&sd_mutex);
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
static int transfer_mmc_sectors(int drive, unsigned long start, int count, void *buf, bool read)
|
||||
{
|
||||
/* check window */
|
||||
start += window_start[drive];
|
||||
if((start + count) > window_end[drive])
|
||||
return -201;
|
||||
int ret = 0;
|
||||
uint32_t resp;
|
||||
|
||||
_mmc_last_disk_activity = current_tick;
|
||||
|
||||
do
|
||||
{
|
||||
/* FIXME implement this_count > 1 by using a sub-buffer of [sub] that is
|
||||
* cache-aligned and then moving the data when possible. This way we could
|
||||
* transfer much greater amount of data at once */
|
||||
int this_count = 1;
|
||||
if(!read)
|
||||
memcpy(aligned_buffer[drive], buf, 512);
|
||||
ret = imx233_ssp_sd_mmc_transfer(SDMMC_SSP(drive), read ? 17 : 24, start,
|
||||
SSP_SHORT_RESP, aligned_buffer[drive], this_count, false, read, &resp);
|
||||
if(read)
|
||||
memcpy(buf, aligned_buffer[drive], 512);
|
||||
count -= this_count;
|
||||
start += this_count;
|
||||
buf += this_count * 512;
|
||||
}while(count != 0 && ret == SSP_SUCCESS);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int sdmmc_init_mmc_drive(int drive)
|
||||
{
|
||||
int ssp = SDMMC_SSP(drive);
|
||||
// we can choose the RCA of mmc cards: pick drive
|
||||
SDMMC_RCA(drive) = drive;
|
||||
|
||||
sdmmc_power(drive, false);
|
||||
sdmmc_power(drive, true);
|
||||
imx233_ssp_start(ssp);
|
||||
imx233_ssp_softreset(ssp);
|
||||
imx233_ssp_set_mode(ssp, HW_SSP_CTRL1__SSP_MODE__SD_MMC);
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96000 / 240 / 1 = 400kHz */
|
||||
imx233_ssp_set_timings(ssp, 240, 0, 0xffff);
|
||||
imx233_ssp_sd_mmc_power_up_sequence(ssp);
|
||||
imx233_ssp_set_bus_width(ssp, 1);
|
||||
imx233_ssp_set_block_size(ssp, 9);
|
||||
/* go to idle state */
|
||||
int ret = imx233_ssp_sd_mmc_transfer(ssp, 0, 0, SSP_NO_RESP, NULL, 0, false, false, NULL);
|
||||
if(ret != 0)
|
||||
return -1;
|
||||
/* send op cond until the card respond with busy bit set; it must complete within 1sec */
|
||||
unsigned timeout = current_tick + HZ;
|
||||
do
|
||||
{
|
||||
uint32_t ocr;
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 1, 0x40ff8000, SSP_SHORT_RESP, NULL, 0, false, false, &ocr);
|
||||
if(ret == 0 && ocr & (1 << 31))
|
||||
break;
|
||||
}while(!TIME_AFTER(current_tick, timeout));
|
||||
|
||||
if(ret != 0)
|
||||
return -2;
|
||||
/* get CID */
|
||||
uint32_t cid[4];
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 2, 0, SSP_LONG_RESP, NULL, 0, false, false, cid);
|
||||
if(ret != 0)
|
||||
return -3;
|
||||
/* Set RCA */
|
||||
uint32_t status;
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 3, SDMMC_RCA(drive) << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -4;
|
||||
/* Select card */
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 7, SDMMC_RCA(drive) << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -5;
|
||||
/* Check TRAN state */
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 13, SDMMC_RCA(drive) << 16, SSP_SHORT_RESP, NULL, 0, false, false, &status);
|
||||
if(ret != 0)
|
||||
return -6;
|
||||
if(((status >> 9) & 0xf) != 4)
|
||||
return -7;
|
||||
/* Switch to 8-bit bus */
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 6, 0x3b70200, SSP_SHORT_RESP, NULL, 0, true, false, &status);
|
||||
if(ret != 0)
|
||||
return -8;
|
||||
/* switch error ? */
|
||||
if(status & 0x80)
|
||||
return -9;
|
||||
imx233_ssp_set_bus_width(ssp, 8);
|
||||
/* Switch to high speed mode */
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 6, 0x3b90100, SSP_SHORT_RESP, NULL, 0, true, false, &status);
|
||||
if(ret != 0)
|
||||
return -10;
|
||||
/* switch error ?*/
|
||||
if(status & 0x80)
|
||||
return -11;
|
||||
/* SSPCLK @ 96MHz
|
||||
* gives bitrate of 96 / 2 / 1 = 48MHz */
|
||||
imx233_ssp_set_timings(ssp, 2, 0, 0xffff);
|
||||
|
||||
/* read extended CSD */
|
||||
{
|
||||
uint8_t ext_csd[512];
|
||||
ret = imx233_ssp_sd_mmc_transfer(ssp, 8, 0, SSP_SHORT_RESP, aligned_buffer[drive], 1, true, true, &status);
|
||||
if(ret != 0)
|
||||
return -12;
|
||||
memcpy(ext_csd, aligned_buffer[drive], 512);
|
||||
uint32_t *sec_count = (void *)&ext_csd[212];
|
||||
window_start[drive] = 0;
|
||||
window_end[drive] = *sec_count;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
static int sdmmc_read_sectors(int drive, unsigned long start, int count, void* buf)
|
||||
{
|
||||
switch(SDMMC_MODE(drive))
|
||||
{
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
case SD_MODE: return transfer_sd_sectors(drive, start, count, buf, true);
|
||||
#endif
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
case MMC_MODE: return transfer_mmc_sectors(drive, start, count, buf, true);
|
||||
#endif
|
||||
default: return -1;
|
||||
}
|
||||
}
|
||||
|
||||
static int sdmmc_write_sectors(int drive, unsigned long start, int count, const void* buf)
|
||||
{
|
||||
switch(SDMMC_MODE(drive))
|
||||
{
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
case SD_MODE: return transfer_sd_sectors(drive, start, count, (void *)buf, false);
|
||||
#endif
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
case MMC_MODE: return transfer_mmc_sectors(drive, start, count, (void *)buf, false);
|
||||
#endif
|
||||
default: return -1;
|
||||
}
|
||||
}
|
||||
|
||||
static int sdmmc_init_drive(int drive)
|
||||
{
|
||||
int ret;
|
||||
switch(SDMMC_MODE(drive))
|
||||
{
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
case SD_MODE: ret = sdmmc_init_sd_card(drive); break;
|
||||
#endif
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
case MMC_MODE: ret = sdmmc_init_mmc_drive(drive); break;
|
||||
#endif
|
||||
default: ret = 0;
|
||||
}
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
/* compute window */
|
||||
if((SDMMC_FLAGS(drive) & WINDOW) && imx233_partitions_is_window_enabled())
|
||||
{
|
||||
uint8_t mbr[512];
|
||||
int ret = sdmmc_read_sectors(IF_MD2(drive,) 0, 1, mbr);
|
||||
if(ret)
|
||||
panicf("Cannot read MBR: %d", ret);
|
||||
ret = imx233_partitions_compute_window(mbr, &window_start[drive],
|
||||
&window_end[drive]);
|
||||
if(ret)
|
||||
panicf("cannot compute partitions window: %d", ret);
|
||||
if(SDMMC_MODE(drive) == SD_MODE)
|
||||
SDMMC_INFO(drive).numblocks = window_end[drive] - window_start[drive];
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void sd_thread(void) NORETURN_ATTR;
|
||||
static void sd_thread(void)
|
||||
{
|
||||
struct queue_event ev;
|
||||
|
||||
while (1)
|
||||
{
|
||||
queue_wait_w_tmo(&sd_queue, &ev, HZ);
|
||||
|
||||
switch(ev.id)
|
||||
{
|
||||
case SYS_HOTSWAP_INSERTED:
|
||||
case SYS_HOTSWAP_EXTRACTED:
|
||||
{
|
||||
int microsd_init = 1;
|
||||
/* lock-out FAT activity first -
|
||||
* prevent deadlocking via disk_mount that
|
||||
* would cause a reverse-order attempt with
|
||||
* another thread */
|
||||
fat_lock();
|
||||
/* lock-out card activity - direct calls
|
||||
* into driver that bypass the fat cache */
|
||||
mutex_lock(&sd_mutex);
|
||||
|
||||
/* We now have exclusive control of fat cache and sd.
|
||||
* Release "by force", ensure file
|
||||
* descriptors aren't leaked and any busy
|
||||
* ones are invalid if mounting. */
|
||||
for(unsigned sd_drive = 0; sd_drive < _sd_num_drives; sd_drive++)
|
||||
{
|
||||
/* Skip non-removable drivers */
|
||||
if(!sd_removable(sd_drive))
|
||||
continue;
|
||||
disk_unmount(sd_first_drive + sd_drive);
|
||||
/* Force card init for new card, re-init for re-inserted one or
|
||||
* clear if the last attempt to init failed with an error. */
|
||||
SDMMC_INFO(sd_map[sd_drive]).initialized = 0;
|
||||
|
||||
if(ev.id == SYS_HOTSWAP_INSERTED)
|
||||
{
|
||||
microsd_init = sdmmc_init_drive(sd_map[sd_drive]);
|
||||
if(microsd_init < 0) /* initialisation failed */
|
||||
panicf("%s init failed : %d", SDMMC_CONF(sd_map[sd_drive]).name, microsd_init);
|
||||
|
||||
microsd_init = disk_mount(sd_first_drive + sd_drive); /* 0 if fail */
|
||||
}
|
||||
/*
|
||||
* Mount succeeded, or this was an EXTRACTED event,
|
||||
* in both cases notify the system about the changed filesystems
|
||||
*/
|
||||
if(microsd_init)
|
||||
queue_broadcast(SYS_FS_CHANGED, 0);
|
||||
}
|
||||
/* Access is now safe */
|
||||
mutex_unlock(&sd_mutex);
|
||||
fat_unlock();
|
||||
break;
|
||||
}
|
||||
case SYS_TIMEOUT:
|
||||
if(!TIME_BEFORE(current_tick, _sd_last_disk_activity + 3 * HZ))
|
||||
sd_enable(false);
|
||||
break;
|
||||
case SYS_USB_CONNECTED:
|
||||
usb_acknowledge(SYS_USB_CONNECTED_ACK);
|
||||
/* Wait until the USB cable is extracted again */
|
||||
usb_wait_for_disconnect(&sd_queue);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int sdmmc_init(void)
|
||||
{
|
||||
static int is_initialized = false;
|
||||
if(is_initialized)
|
||||
return 0;
|
||||
is_initialized = true;
|
||||
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
mutex_init(&sd_mutex);
|
||||
queue_init(&sd_queue, true);
|
||||
create_thread(sd_thread, sd_stack, sizeof(sd_stack), 0,
|
||||
sd_thread_name IF_PRIO(, PRIORITY_USER_INTERFACE) IF_COP(, CPU));
|
||||
#endif
|
||||
|
||||
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
|
||||
{
|
||||
if(SDMMC_FLAGS(drive) & REMOVABLE)
|
||||
imx233_ssp_sdmmc_setup_detect(SDMMC_SSP(drive), true, sdmmc_detect_callback,
|
||||
false, SDMMC_FLAGS(drive) & DETECT_INVERTED);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int sdmmc_present(int drive)
|
||||
{
|
||||
if(SDMMC_FLAGS(drive) & REMOVABLE)
|
||||
return imx233_ssp_sdmmc_detect(SDMMC_SSP(drive));
|
||||
else
|
||||
return true;
|
||||
}
|
||||
|
||||
static inline int sdmmc_removable(int drive)
|
||||
{
|
||||
return SDMMC_FLAGS(drive) & REMOVABLE;
|
||||
}
|
||||
|
||||
#if CONFIG_STORAGE & STORAGE_SD
|
||||
int sd_init(void)
|
||||
{
|
||||
int ret = sdmmc_init();
|
||||
if(ret < 0) return ret;
|
||||
|
||||
_sd_num_drives = 0;
|
||||
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
|
||||
if(SDMMC_MODE(drive) == SD_MODE)
|
||||
sd_map[_sd_num_drives++] = drive;
|
||||
return 0;
|
||||
}
|
||||
|
||||
tCardInfo *card_get_info_target(int sd_card_no)
|
||||
{
|
||||
return &SDMMC_INFO(sd_map[sd_card_no]);
|
||||
}
|
||||
|
||||
int sd_num_drives(int first_drive)
|
||||
{
|
||||
sd_first_drive = first_drive;
|
||||
return _sd_num_drives;
|
||||
}
|
||||
|
||||
bool sd_present(IF_MV_NONVOID(int sd_drive))
|
||||
{
|
||||
return sdmmc_present(sd_map[sd_drive]);
|
||||
}
|
||||
|
||||
bool sd_removable(IF_MV_NONVOID(int sd_drive))
|
||||
{
|
||||
return sdmmc_removable(sd_map[sd_drive]);
|
||||
}
|
||||
|
||||
long sd_last_disk_activity(void)
|
||||
{
|
||||
return _sd_last_disk_activity;
|
||||
}
|
||||
|
||||
void sd_enable(bool on)
|
||||
{
|
||||
(void) on;
|
||||
}
|
||||
|
||||
int sd_read_sectors(IF_MD2(int sd_drive,) unsigned long start, int count, void *buf)
|
||||
{
|
||||
return sdmmc_read_sectors(sd_map[sd_drive], start, count, buf);
|
||||
}
|
||||
|
||||
int sd_write_sectors(IF_MD2(int sd_drive,) unsigned long start, int count, const void* buf)
|
||||
{
|
||||
return sdmmc_write_sectors(sd_map[sd_drive], start, count, buf);
|
||||
}
|
||||
#endif
|
||||
|
||||
#if CONFIG_STORAGE & STORAGE_MMC
|
||||
int mmc_init(void)
|
||||
{
|
||||
int ret = sdmmc_init();
|
||||
if(ret < 0) return ret;
|
||||
|
||||
_sd_num_drives = 0;
|
||||
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
|
||||
if(SDMMC_MODE(drive) == MMC_MODE)
|
||||
{
|
||||
mmc_map[_mmc_num_drives++] = drive;
|
||||
sdmmc_init_drive(drive);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mmc_get_info(IF_MD2(int mmc_drive,) struct storage_info *info)
|
||||
{
|
||||
int drive = mmc_map[mmc_drive];
|
||||
info->sector_size = 512;
|
||||
info->num_sectors = window_end[drive] - window_start[drive];
|
||||
info->vendor = "Rockbox";
|
||||
info->product = "Internal Storage";
|
||||
info->revision = "0.00";
|
||||
}
|
||||
|
||||
int mmc_num_drives(int first_drive)
|
||||
{
|
||||
mmc_first_drive = first_drive;
|
||||
return _mmc_num_drives;
|
||||
}
|
||||
|
||||
bool mmc_present(IF_MV_NONVOID(int mmc_drive))
|
||||
{
|
||||
return sdmmc_present(mmc_map[mmc_drive]);
|
||||
}
|
||||
|
||||
bool mmc_removable(IF_MV_NONVOID(int mmc_drive))
|
||||
{
|
||||
return sdmmc_removable(mmc_map[mmc_drive]);
|
||||
}
|
||||
|
||||
long mmc_last_disk_activity(void)
|
||||
{
|
||||
return _mmc_last_disk_activity;
|
||||
}
|
||||
|
||||
void mmc_enable(bool on)
|
||||
{
|
||||
(void) on;
|
||||
}
|
||||
|
||||
void mmc_sleep(void)
|
||||
{
|
||||
}
|
||||
|
||||
void mmc_sleepnow(void)
|
||||
{
|
||||
}
|
||||
|
||||
bool mmc_disk_is_active(void)
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
bool mmc_usb_active(void)
|
||||
{
|
||||
return mmc_disk_is_active();
|
||||
}
|
||||
|
||||
int mmc_soft_reset(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mmc_flush(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mmc_spin(void)
|
||||
{
|
||||
}
|
||||
|
||||
void mmc_spindown(int seconds)
|
||||
{
|
||||
(void) seconds;
|
||||
}
|
||||
|
||||
int mmc_spinup_time(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mmc_read_sectors(IF_MD2(int mmc_drive,) unsigned long start, int count, void *buf)
|
||||
{
|
||||
return sdmmc_read_sectors(mmc_map[mmc_drive], start, count, buf);
|
||||
}
|
||||
|
||||
int mmc_write_sectors(IF_MD2(int mmc_drive,) unsigned long start, int count, const void* buf)
|
||||
{
|
||||
return sdmmc_write_sectors(mmc_map[mmc_drive], start, count, buf);
|
||||
}
|
||||
|
||||
#endif
|
Loading…
Reference in New Issue