Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/target/arm/imx233/sdmmc-imx233.c
Amaury Pouly 633c8edf47 imx233: two minor fixes for sd/mmc 
Always enable support for SET_BLOCK_COUNT on mmc: it is mandatory. For some
reason (probably a mistake) it was disabled unconditionaly on mmc.
Also deselect sd card after init. Although it is unlikely to make a difference,
it is already done for mmc so stay consistent.

Change-Id: I276f0d95f5bb6a0bf431c2fff4589d3dfb15f8c7
2016-05-29 16:08:42 +01:00

1134 lines
34 KiB
C
Raw Blame History

/***************************************************************************
* __________ __ ___.
* 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 "mmc.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"
#include "ata_idle_notify.h"
#include "led.h"
#include "regs/ssp.h"
/** NOTE For convenience, this drivers relies on the many similar commands
* between SD and MMC. The following assumptions are made:
* - SD_SEND_STATUS = MMC_SEND_STATUS
* - SD_SELECT_CARD = MMC_SELECT_CARD
* - SD_TRAN = MMC_TRAN
* - MMC_WRITE_MULTIPLE_BLOCK = SD_WRITE_MULTIPLE_BLOCK
* - MMC_READ_MULTIPLE_BLOCK = SD_READ_MULTIPLE_BLOCK
* - SD_STOP_TRANSMISSION = MMC_STOP_TRANSMISSION
* - SD_DESELECT_CARD = MMC_DESELECT_CARD
*/
#if SD_SEND_STATUS != MMC_SEND_STATUS || SD_SELECT_CARD != MMC_SELECT_CARD || \
SD_TRAN != MMC_TRAN || MMC_WRITE_MULTIPLE_BLOCK != SD_WRITE_MULTIPLE_BLOCK || \
MMC_READ_MULTIPLE_BLOCK != SD_READ_MULTIPLE_BLOCK || \
SD_STOP_TRANSMISSION != MMC_STOP_TRANSMISSION || \
SD_DESELECT_CARD != MMC_DESELECT_CARD
#error SD/MMC mismatch
#endif
/* static configuration */
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 wp_pin; /* write protect pin */
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)
#define WP_PIN (1 << 6)
#define WP_INVERTED (1 << 7)
#define PROBE (1 << 8)
/* 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)
const 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)
{
.name = "internal/SD",
.flags = WINDOW | PROBE,
.ssp = 2,
.mode = SD_MODE,
},
/* 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,
},
#elif defined(CREATIVE_ZENXFI) || defined(CREATIVE_ZEN)
{
.name = "internal/SD",
.flags = WINDOW,
.ssp = 2,
.mode = SD_MODE,
},
/* The Zen X-Fi uses pin #B0P10 for power*/
{
.name = "SD",
.flags = POWER_PIN | REMOVABLE | DETECT_INVERTED | POWER_DELAY | WP_PIN,
.power_pin = PIN(0, 10),
.wp_pin = PIN(0, 11),
.power_delay = HZ / 10, /* extra delay, to ramp up voltage? */
.ssp = 1,
.mode = SD_MODE,
},
#elif defined(CREATIVE_ZENMOZAIC)
{
.name = "internal/SD",
.flags = WINDOW,
.ssp = 2,
.mode = SD_MODE,
}
#elif defined(CREATIVE_ZENXFISTYLE)
{
.name = "internal/SD",
.flags = WINDOW,
.ssp = 2,
.mode = SD_MODE
},
#elif defined(SONY_NWZE370) || defined(SONY_NWZE360)
/* The Sony NWZ-E370 uses #B1P29 for power */
{
.name = "internal/SD",
.flags = POWER_PIN | POWER_INVERTED | WINDOW,
.power_pin = PIN(1, 29),
.ssp = 2,
.mode = MMC_MODE
},
#else
#error You need to write the sd/mmc config!
#endif
};
/* drive status */
struct sdmmc_status_t
{
int bus_width; /* bus width (1, 4 or 8) */
bool hs_capable; /* HS capable device */
bool hs_enabled; /* HS enabled */
bool has_sbc; /* support SET_BLOCK_COUNT */
};
#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
/** WARNING
* to be consistent with all our SD drivers, the .rca field of sdmmc_card_info
* in reality holds (rca << 16) because all command arguments actually require
* the RCA is the 16-bit msb. Be careful that this is not the actuall RCA ! */
/* 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];
static struct mutex mutex[SDMMC_NUM_DRIVES];
static int disk_last_activity[SDMMC_NUM_DRIVES];
static struct sdmmc_status_t sdmmc_status[SDMMC_NUM_DRIVES];
#define MIN_YIELD_PERIOD 5
#define SDMMC_INFO(drive) sdmmc_card_info[drive]
#define SDMMC_RCA(drive) SDMMC_INFO(drive).rca
#define SDMMC_STATUS(drive) sdmmc_status[drive]
/* sd only */
static long sdmmc_stack[(DEFAULT_STACK_SIZE*2 + 0x200)/sizeof(long)];
static const char sdmmc_thread_name[] = "sdmmc";
static struct event_queue sdmmc_queue;
#if CONFIG_STORAGE & STORAGE_SD
static int sd_first_drive;
static unsigned _sd_num_drives;
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_map[SDMMC_NUM_DRIVES]; /* mmc->sdmmc map */
#endif
static int init_drive(int drive);
/* 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 inline int sdmmc_removable(int drive)
{
return SDMMC_FLAGS(drive) & REMOVABLE;
}
static int sdmmc_present(int drive)
{
if(sdmmc_removable(drive))
return imx233_ssp_sdmmc_detect(SDMMC_SSP(drive));
else
return true;
}
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_enable_pullups(int drive, bool pullup)
{
/* 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(pullup, bus_width, false);
else
imx233_ssp_setup_ssp2_sd_mmc_pins(pullup, bus_width);
}
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(bank, pin, "sdmmc_power");
imx233_pinctrl_set_function(bank, pin, PINCTRL_FUNCTION_GPIO);
imx233_pinctrl_enable_gpio(bank, pin, true);
if(SDMMC_FLAGS(drive) & POWER_INVERTED)
imx233_pinctrl_set_gpio(bank, pin, !on);
else
imx233_pinctrl_set_gpio(bank, pin, on);
}
if(SDMMC_FLAGS(drive) & POWER_DELAY)
sleep(SDMMC_CONF(drive).power_delay);
/* enable pullups for identification */
sdmmc_enable_pullups(drive, true);
}
#define MCI_NO_RESP 0
#define MCI_RESP (1<<0)
#define MCI_LONG_RESP (1<<1)
#define MCI_ACMD (1<<2) /* sd only */
#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, 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_state(int drive, unsigned state)
{
unsigned long response;
unsigned int timeout = current_tick + 5*HZ;
int cmd_retry = 10;
int next_yield = current_tick + MIN_YIELD_PERIOD;
while (1)
{
/* NOTE: rely on SD_SEND_STATUS=MMC_SEND_STATUS */
while(!send_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) == state)
return 0;
if(TIME_AFTER(current_tick, timeout))
return -10 * ((response >> 9) & 0xf);
if(TIME_AFTER(current_tick, next_yield))
{
yield();
next_yield = current_tick + MIN_YIELD_PERIOD;
}
}
return 0;
}
#if CONFIG_STORAGE & STORAGE_SD
static int 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, BV_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, sd_hs = 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, &SDMMC_INFO(drive).ocr))
return -100;
} while(!(SDMMC_INFO(drive).ocr & (1<<31)));
/* CMD2 send CID */
if(!send_cmd(drive, SD_ALL_SEND_CID, 0, MCI_RESP|MCI_LONG_RESP, SDMMC_INFO(drive).cid))
return -3;
/* CMD3 send RCA */
if(!send_cmd(drive, SD_SEND_RELATIVE_ADDR, 0, MCI_RESP, &SDMMC_INFO(drive).rca))
return -4;
/* CMD9 send CSD */
if(!send_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;
/* CMD7 w/rca: Select card to put it in TRAN state */
if(!send_cmd(drive, SD_SELECT_CARD, SDMMC_RCA(drive), MCI_RESP, &resp))
return -12;
if(wait_for_state(drive, SD_TRAN))
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);
SDMMC_STATUS(drive).bus_width = 4;
/* Try to switch V2 cards to HS timings, non HS seem to ignore this */
if(sd_v2)
{
/* only transfer 64 bytes */
imx233_ssp_set_block_size(ssp, /*log2(64)*/6);
/* CMD6 switch to HS */
if(imx233_ssp_sd_mmc_transfer(ssp, SD_SWITCH_FUNC, 0x80fffff1,
SSP_SHORT_RESP, aligned_buffer[drive], 1, true, true, NULL))
return -12;
imx233_ssp_set_block_size(ssp, /*log2(512)*/9);
if((aligned_buffer[drive][16] & 0xf) == 1)
sd_hs = true;
}
/* probe for CMD23 support */
SDMMC_STATUS(drive).has_sbc = false;
/* ACMD51, only transfer 8 bytes */
imx233_ssp_set_block_size(ssp, /*log2(8)*/3);
if(send_cmd(drive, SD_APP_CMD, SDMMC_RCA(drive), MCI_RESP, &resp))
{
if(imx233_ssp_sd_mmc_transfer(ssp, SD_SEND_SCR, 0, SSP_SHORT_RESP,
aligned_buffer[drive], 1, true, true, NULL) == SSP_SUCCESS)
{
if(aligned_buffer[drive][3] & 2)
SDMMC_STATUS(drive).has_sbc = true;
}
}
imx233_ssp_set_block_size(ssp, /*log2(512)*/9);
/* SSPCLK @ 96MHz
* gives bitrate of 96 / 4 / 1 = 24MHz
* gives bitrate of 96 / 2 / 1 = 48MHz */
SDMMC_STATUS(drive).hs_capable = sd_hs;
SDMMC_STATUS(drive).hs_enabled = false;
if(/*sd_hs*/false)
imx233_ssp_set_timings(ssp, 2, 0, 0xffff);
else
imx233_ssp_set_timings(ssp, 4, 0, 0xffff);
/* deselect card */
if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
return -13;
/* successfully initialised */
SDMMC_INFO(drive).initialized = 1;
return 0;
}
#endif
#if CONFIG_STORAGE & STORAGE_MMC
static int init_mmc_drive(int drive)
{
int ssp = SDMMC_SSP(drive);
/* we can choose the RCA of mmc cards: pick drive. Following our convention,
* .rca is actually RCA << 16 */
SDMMC_RCA(drive) = drive << 16;
sdmmc_power(drive, false);
sdmmc_power(drive, true);
imx233_ssp_start(ssp);
imx233_ssp_softreset(ssp);
imx233_ssp_set_mode(ssp, BV_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 */
if(!send_cmd(drive, MMC_GO_IDLE_STATE, 0, MCI_NO_RESP, NULL))
return -1;
/* send op cond until the card respond with busy bit set; it must complete within 1sec */
unsigned timeout = current_tick + HZ;
bool ret = false;
do
{
uint32_t ocr;
ret = send_cmd(drive, MMC_SEND_OP_COND, 0x40ff8000, MCI_RESP, &ocr);
if(ret && ocr & (1 << 31))
break;
}while(!TIME_AFTER(current_tick, timeout));
if(!ret)
return -2;
/* get CID */
uint32_t cid[4];
if(!send_cmd(drive, MMC_ALL_SEND_CID, 0, MCI_LONG_RESP, cid))
return -3;
/* Set RCA */
uint32_t status;
if(!send_cmd(drive, MMC_SET_RELATIVE_ADDR, SDMMC_RCA(drive), MCI_RESP, &status))
return -4;
/* Select card */
if(!send_cmd(drive, MMC_SELECT_CARD, SDMMC_RCA(drive), MCI_RESP, &status))
return -5;
/* Check TRAN state */
if(wait_for_state(drive, MMC_TRAN))
return -6;
/* Switch to 8-bit bus */
if(!send_cmd(drive, MMC_SWITCH, 0x3b70200, MCI_RESP|MCI_BUSY, &status))
return -8;
/* switch error ? */
if(status & 0x80)
return -9;
imx233_ssp_set_bus_width(ssp, 8);
/* Switch to high speed mode */
if(!send_cmd(drive, MMC_SWITCH, 0x3b90100, MCI_RESP|MCI_BUSY, &status))
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);
SDMMC_STATUS(drive).bus_width = 8;
SDMMC_STATUS(drive).hs_capable = true;
SDMMC_STATUS(drive).hs_enabled = true;
/* read extended CSD */
{
uint8_t *ext_csd = aligned_buffer[drive];
if(imx233_ssp_sd_mmc_transfer(ssp, 8, 0, SSP_SHORT_RESP, aligned_buffer[drive], 1, true, true, &status))
return -12;
uint32_t *sec_count = (void *)&ext_csd[212];
window_start[drive] = 0;
window_end[drive] = *sec_count;
}
/* deselect card */
if(!send_cmd(drive, MMC_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
return -13;
/* MMC always support CMD23 */
SDMMC_STATUS(drive).has_sbc = true;
SDMMC_INFO(drive).initialized = 1;
return 0;
}
#endif
/* low-level function, don't call directly! */
static int __xfer_sectors(int drive, unsigned long start, int count, void *buf, bool read)
{
uint32_t resp;
int ret = 0;
while(count != 0)
{
int this_count = MIN(count, IMX233_MAX_SINGLE_DMA_XFER_SIZE / 512);
bool need_stop = true;
if(SDMMC_STATUS(drive).has_sbc && send_cmd(drive, 23, this_count, MCI_RESP, &resp))
need_stop = false;
/* Set bank_start to the correct unit (blocks or bytes).
* MMC drives use block addressing, SD cards bytes or blocks */
int bank_start = start;
if(SDMMC_MODE(drive) == SD_MODE && !(SDMMC_INFO(drive).ocr & (1<<30))) /* not SDHC */
bank_start *= SD_BLOCK_SIZE;
/* issue read/write
* NOTE: rely on SD_{READ,WRITE}_MULTIPLE_BLOCK=MMC_{READ,WRITE}_MULTIPLE_BLOCK */
ret = imx233_ssp_sd_mmc_transfer(SDMMC_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)
need_stop = true;
/* stop transmission
* NOTE: rely on SD_STOP_TRANSMISSION=MMC_STOP_TRANSMISSION */
if(need_stop && !send_cmd(drive, SD_STOP_TRANSMISSION, 0, MCI_RESP|MCI_BUSY, &resp))
{
ret = -15;
break;
}
if(ret != 0)
return ret;
count -= this_count;
start += this_count;
buf += this_count * 512;
}
return ret;
}
static int transfer_sectors(int drive, unsigned long start, int count, void *buf, bool read)
{
int ret = 0;
/* the function doesn't work when count is 0 */
if(count == 0)
return ret;
/* update disk activity */
disk_last_activity[drive] = current_tick;
/* lock per-drive mutex */
mutex_lock(&mutex[drive]);
/* update led status */
led(true);
/* for SD cards, init if necessary */
#if CONFIG_STORAGE & STORAGE_SD
if(SDMMC_MODE(drive) == SD_MODE && SDMMC_INFO(drive).initialized <= 0)
{
ret = init_drive(drive);
if(SDMMC_INFO(drive).initialized <= 0)
goto Lend;
}
#endif
/* check window */
start += window_start[drive];
if((start + count) > window_end[drive])
{
ret = -201;
goto Lend;
}
/* select card.
* NOTE: rely on SD_SELECT_CARD=MMC_SELECT_CARD */
if(!send_cmd(drive, SD_SELECT_CARD, SDMMC_RCA(drive), MCI_NO_RESP, NULL))
{
ret = -20;
goto Lend;
}
/* wait for TRAN state */
/* NOTE: rely on SD_TRAN=MMC_TRAN */
ret = wait_for_state(drive, SD_TRAN);
if(ret < 0)
goto Ldeselect;
/**
* NOTE: we need to make sure dma transfers are aligned. This is handled
* differently for read and write transfers. We do not repeat it each
* time but it should be noted that all transfers are limited by
* IMX233_MAX_SINGLE_DMA_XFER_SIZE and thus need to be split if needed.
*
* Read transfers:
* If the buffer is already aligned, transfer everything at once.
* Otherwise, transfer all sectors but one to the sub-buffer starting
* on the next cache line and then move the data. Then transfer the
* last sector to the aligned_buffer and then copy to the buffer.
*
* Write transfers:
* If the buffer is already aligned, transfer everything at once.
* Otherwise, copy the first sector to the aligned_buffer and transfer.
* Then move all other sectors within the buffer to make it cache
* aligned and transfer it. Then move data to pretend the buffer was
* never modified.
*/
if(read)
{
void *ptr = CACHEALIGN_UP(buf);
if(buf != ptr)
{
/* copy count-1 sector and then move within the buffer */
ret = __xfer_sectors(drive, start, count - 1, ptr, read);
memmove(buf, ptr, 512 * (count - 1));
if(ret >= 0)
{
/* transfer the last sector the aligned_buffer and copy */
ret = __xfer_sectors(drive, start + count - 1, 1,
aligned_buffer[drive], read);
memcpy(buf + 512 * (count - 1), aligned_buffer[drive], 512);
}
}
else
ret = __xfer_sectors(drive, start, count, buf, read);
}
else
{
void *ptr = CACHEALIGN_UP(buf);
if(buf != ptr)
{
/* transfer the first sector to aligned_buffer and copy */
memcpy(aligned_buffer[drive], buf, 512);
ret = __xfer_sectors(drive, start, 1, aligned_buffer[drive], read);
if(ret >= 0)
{
/* move within the buffer and transfer */
memmove(ptr, buf + 512, 512 * (count - 1));
ret = __xfer_sectors(drive, start + 1, count - 1, ptr, read);
/* move back */
memmove(buf + 512, ptr, 512 * (count - 1));
memcpy(buf, aligned_buffer[drive], 512);
}
}
else
ret = __xfer_sectors(drive, start, count, buf, read);
}
/* deselect card */
Ldeselect:
/* CMD7 w/rca =0 : deselects card & puts it in STBY state
* NOTE: rely on SD_DESELECT_CARD=MMC_DESELECT_CARD */
if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL))
ret = -23;
Lend:
/* update led status */
led(false);
/* release per-drive mutex */
mutex_unlock(&mutex[drive]);
return ret;
}
/* user specifies the sdmmc drive */
static int part_read_fn(intptr_t user, unsigned long start, int count, void* buf)
{
return transfer_sectors(user, start, count, buf, true);
}
static int init_drive(int drive)
{
int ret;
switch(SDMMC_MODE(drive))
{
#if CONFIG_STORAGE & STORAGE_SD
case SD_MODE: ret = init_sd_card(drive); break;
#endif
#if CONFIG_STORAGE & STORAGE_MMC
case MMC_MODE: ret = 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())
{
/* NOTE: at this point the window shows the whole disk so raw disk
* accesses can be made to lookup partitions */
ret = imx233_partitions_compute_window(IF_MD_DRV(drive), part_read_fn,
IMX233_PART_USER, &window_start[drive], &window_end[drive]);
if(ret)
panicf("cannot compute partitions window: %d", ret);
SDMMC_INFO(drive).numblocks = window_end[drive] - window_start[drive];
}
return 0;
}
static void sdmmc_thread(void) NORETURN_ATTR;
static void sdmmc_thread(void)
{
struct queue_event ev;
bool idle_notified = false;
int timeout = 0;
while (1)
{
queue_wait_w_tmo(&sdmmc_queue, &ev, HZ);
switch(ev.id)
{
#if CONFIG_STORAGE & STORAGE_SD
case SYS_HOTSWAP_INSERTED:
case SYS_HOTSWAP_EXTRACTED:
{
int microsd_init = ev.id == SYS_HOTSWAP_INSERTED ? 0 : 1;
/* 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++)
{
int drive = sd_map[sd_drive];
/* Skip non-removable drivers */
if(!sdmmc_removable(drive))
continue;
disk_unmount(sd_first_drive + sd_drive);
mutex_lock(&mutex[drive]); /* lock-out card activity */
/* 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;
int rc = -1;
if(ev.id == SYS_HOTSWAP_INSERTED)
{
rc = init_drive(drive);
if(rc < 0) /* initialisation failed */
panicf("%s init failed : %d", SDMMC_CONF(sd_map[sd_drive]).name, rc);
}
/* unlock card */
mutex_unlock(&mutex[drive]);
if (rc >= 0)
microsd_init += disk_mount(sd_first_drive + sd_drive); /* 0 if fail */
}
/* Access is now safe */
/*
* One or more mounts 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);
break;
}
#endif
case SYS_TIMEOUT:
#if CONFIG_STORAGE & STORAGE_SD
timeout = MAX(timeout, sd_last_disk_activity()+(3*HZ));
#endif
#if CONFIG_STORAGE & STORAGE_MMC
timeout = MAX(timeout, mmc_last_disk_activity()+(3*HZ));
#endif
if(TIME_BEFORE(current_tick, timeout))
{
idle_notified = false;
}
else
{
if(!idle_notified)
{
call_storage_idle_notifys(false);
idle_notified = true;
}
}
break;
case SYS_USB_CONNECTED:
usb_acknowledge(SYS_USB_CONNECTED_ACK);
/* Wait until the USB cable is extracted again */
usb_wait_for_disconnect(&sdmmc_queue);
break;
}
}
}
static int sdmmc_init(void)
{
static int is_initialized = false;
if(is_initialized)
return 0;
is_initialized = true;
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
mutex_init(&mutex[drive]);
queue_init(&sdmmc_queue, true);
create_thread(sdmmc_thread, sdmmc_stack, sizeof(sdmmc_stack), 0,
sdmmc_thread_name IF_PRIO(, PRIORITY_USER_INTERFACE) IF_COP(, CPU));
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
{
if(sdmmc_removable(drive))
imx233_ssp_sdmmc_setup_detect(SDMMC_SSP(drive), true, sdmmc_detect_callback,
false, SDMMC_FLAGS(drive) & DETECT_INVERTED);
}
return 0;
}
#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)
{
/* if asked to probe, try to init it and ignore it if it fails */
if(SDMMC_FLAGS(drive) & PROBE)
{
int ret = init_drive(drive);
if(ret < 0)
continue;
}
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_MD_NONVOID(int sd_drive))
{
return sdmmc_present(sd_map[IF_MD_DRV(sd_drive)]);
}
bool sd_removable(IF_MD_NONVOID(int sd_drive))
{
return sdmmc_removable(sd_map[IF_MD_DRV(sd_drive)]);
}
long sd_last_disk_activity(void)
{
long last = 0;
for(unsigned i = 0; i < _sd_num_drives; i++)
last = MAX(last, disk_last_activity[sd_map[i]]);
return last;
}
void sd_enable(bool on)
{
(void) on;
}
int sd_read_sectors(IF_MD(int sd_drive,) unsigned long start, int count, void *buf)
{
#ifndef HAVE_MULTIDRIVE
int sd_drive = 0;
#endif
return transfer_sectors(sd_map[sd_drive], start, count, buf, true);
}
int sd_write_sectors(IF_MD(int sd_drive,) unsigned long start, int count, const void* buf)
{
#ifndef HAVE_MULTIDRIVE
int sd_drive = 0;
#endif
return transfer_sectors(sd_map[sd_drive], start, count, (void *)buf, false);
}
#endif
#if CONFIG_STORAGE & STORAGE_MMC
int mmc_init(void)
{
int ret = sdmmc_init();
if(ret < 0) return ret;
_mmc_num_drives = 0;
for(unsigned drive = 0; drive < SDMMC_NUM_DRIVES; drive++)
if(SDMMC_MODE(drive) == MMC_MODE)
{
/* try to init drive, panic on failure or skip if probing */
int ret = init_drive(drive);
if(ret < 0)
{
if(SDMMC_FLAGS(drive) & PROBE)
continue;
else
panicf("init_drive(%d) failed: %d (mmc)", drive, ret);
}
mmc_map[_mmc_num_drives++] = drive;
}
return 0;
}
void mmc_get_info(IF_MD(int mmc_drive,) struct storage_info *info)
{
#ifndef HAVE_MULTIDRIVE
int mmc_drive = 0;
#endif
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_MD_NONVOID(int mmc_drive))
{
return sdmmc_present(mmc_map[IF_MD_DRV(mmc_drive)]);
}
bool mmc_removable(IF_MD_NONVOID(int mmc_drive))
{
return sdmmc_removable(mmc_map[IF_MD_DRV(mmc_drive)]);
}
long mmc_last_disk_activity(void)
{
long last = 0;
for(unsigned i = 0; i < _mmc_num_drives; i++)
last = MAX(last, disk_last_activity[mmc_map[i]]);
return last;
}
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(int delayticks)
{
(void) delayticks;
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_MD(int mmc_drive,) unsigned long start, int count, void *buf)
{
#ifndef HAVE_MULTIDRIVE
int mmc_drive = 0;
#endif
return transfer_sectors(mmc_map[mmc_drive], start, count, buf, true);
}
int mmc_write_sectors(IF_MD(int mmc_drive,) unsigned long start, int count, const void* buf)
{
#ifndef HAVE_MULTIDRIVE
int mmc_drive = 0;
#endif
return transfer_sectors(mmc_map[mmc_drive], start, count, (void *)buf, false);
}
tCardInfo *mmc_card_info(int card_no)
{
return &SDMMC_INFO(mmc_map[card_no]);
}
#endif
/** Information about SD/MMC slot */
struct sdmmc_info_t
{
int drive; /* drive number (for queries like storage_removable(drive) */
const char *slot_name; /* name of the slot: 'internal' or 'microsd' */
bool window; /* is window enabled for this slot? */
int bus_width; /* current bus width */
bool hs_capable; /* is device high-speed capable? */
bool hs_enabled; /* is high-speed enabled? */
bool has_sbc; /* device support SET_BLOCK_COUNT */
};
struct sdmmc_info_t imx233_sdmmc_get_info(int drive, int storage_drive)
{
struct sdmmc_info_t info;
memset(&info, 0, sizeof(info));
info.drive = storage_drive;
info.slot_name = SDMMC_CONF(drive).name;
info.window = !!(SDMMC_CONF(drive).flags & WINDOW);
info.bus_width = SDMMC_STATUS(drive).bus_width;
info.hs_capable = SDMMC_STATUS(drive).hs_capable;
info.hs_enabled = SDMMC_STATUS(drive).hs_enabled;
info.has_sbc = SDMMC_STATUS(drive).has_sbc;
return info;
}
#if CONFIG_STORAGE & STORAGE_SD
/* return information about a particular sd device (use regular drive number) */
struct sdmmc_info_t imx233_sd_get_info(int card_no)
{
return imx233_sdmmc_get_info(sd_map[card_no], sd_first_drive + card_no);
}
#endif
#if CONFIG_STORAGE & STORAGE_MMC
/* return information about a particular mmc device (use regular drive number) */
struct sdmmc_info_t imx233_mmc_get_info(int card_no)
{
return imx233_sdmmc_get_info(mmc_map[card_no], mmc_first_drive + card_no);
}
#endif
Reference in a new issue View git blame Copy permalink