bdk: sdmmc: homogenize return values

The actual target of this refactoring.
This commit is contained in:
CTCaer
2026-02-22 08:32:34 +02:00
parent 0b707ac1ae
commit 25fda88e46
9 changed files with 403 additions and 394 deletions

View File

@@ -79,7 +79,7 @@ int emmc_init_retry(bool power_cycle)
switch (emmc_mode) switch (emmc_mode)
{ {
case EMMC_INIT_FAIL: // Reset to max. case EMMC_INIT_FAIL: // Reset to max.
return 0; return 1;
case EMMC_1BIT_HS52: case EMMC_1BIT_HS52:
bus_width = SDMMC_BUS_WIDTH_1; bus_width = SDMMC_BUS_WIDTH_1;
type = SDHCI_TIMING_MMC_HS52; type = SDHCI_TIMING_MMC_HS52;
@@ -100,7 +100,7 @@ int emmc_init_retry(bool power_cycle)
return sdmmc_storage_init_mmc(&emmc_storage, &emmc_sdmmc, bus_width, type); return sdmmc_storage_init_mmc(&emmc_storage, &emmc_sdmmc, bus_width, type);
} }
bool emmc_initialize(bool power_cycle) int emmc_initialize(bool power_cycle)
{ {
// Reset mode in case of previous failure. // Reset mode in case of previous failure.
if (emmc_mode == EMMC_INIT_FAIL) if (emmc_mode == EMMC_INIT_FAIL)
@@ -109,12 +109,12 @@ bool emmc_initialize(bool power_cycle)
if (power_cycle) if (power_cycle)
emmc_end(); emmc_end();
int res = !emmc_init_retry(false); int res = emmc_init_retry(false);
while (true) while (true)
{ {
if (!res) if (!res)
return true; return 0;
else else
{ {
emmc_errors[EMMC_ERROR_INIT_FAIL]++; emmc_errors[EMMC_ERROR_INIT_FAIL]++;
@@ -122,13 +122,13 @@ bool emmc_initialize(bool power_cycle)
if (emmc_mode == EMMC_INIT_FAIL) if (emmc_mode == EMMC_INIT_FAIL)
break; break;
else else
res = !emmc_init_retry(true); res = emmc_init_retry(true);
} }
} }
emmc_end(); emmc_end();
return false; return 1;
} }
int emmc_set_partition(u32 partition) { return sdmmc_storage_set_mmc_partition(&emmc_storage, partition); } int emmc_set_partition(u32 partition) { return sdmmc_storage_set_mmc_partition(&emmc_storage, partition); }
@@ -190,7 +190,7 @@ int emmc_part_read(emmc_part_t *part, u32 sector_off, u32 num_sectors, void *buf
{ {
// The last LBA is inclusive. // The last LBA is inclusive.
if (part->lba_start + sector_off > part->lba_end) if (part->lba_start + sector_off > part->lba_end)
return 0; return 1;
#ifdef BDK_EMUMMC_ENABLE #ifdef BDK_EMUMMC_ENABLE
return emummc_storage_read(part->lba_start + sector_off, num_sectors, buf); return emummc_storage_read(part->lba_start + sector_off, num_sectors, buf);
@@ -203,7 +203,7 @@ int emmc_part_write(emmc_part_t *part, u32 sector_off, u32 num_sectors, void *bu
{ {
// The last LBA is inclusive. // The last LBA is inclusive.
if (part->lba_start + sector_off > part->lba_end) if (part->lba_start + sector_off > part->lba_end)
return 0; return 1;
#ifdef BDK_EMUMMC_ENABLE #ifdef BDK_EMUMMC_ENABLE
return emummc_storage_write(part->lba_start + sector_off, num_sectors, buf); return emummc_storage_write(part->lba_start + sector_off, num_sectors, buf);

View File

@@ -62,7 +62,7 @@ void emmc_error_count_increment(u8 type);
u16 *emmc_get_error_count(); u16 *emmc_get_error_count();
u32 emmc_get_mode(); u32 emmc_get_mode();
int emmc_init_retry(bool power_cycle); int emmc_init_retry(bool power_cycle);
bool emmc_initialize(bool power_cycle); int emmc_initialize(bool power_cycle);
int emmc_set_partition(u32 partition); int emmc_set_partition(u32 partition);
void emmc_end(); void emmc_end();

View File

@@ -99,7 +99,7 @@ static int nx_emmc_bis_write_block(u32 sector, u32 count, void *buff, bool flush
res = emmc_part_write(system_part, sector, count, bis_cache->dma_buff); res = emmc_part_write(system_part, sector, count, bis_cache->dma_buff);
else else
res = sdmmc_storage_write(&sd_storage, emu_offset + system_part->lba_start + sector, count, bis_cache->dma_buff); res = sdmmc_storage_write(&sd_storage, emu_offset + system_part->lba_start + sector, count, bis_cache->dma_buff);
if (!res) if (res)
return 1; // R/W error. return 1; // R/W error.
// Mark cache entry not dirty if write succeeds. // Mark cache entry not dirty if write succeeds.
@@ -159,7 +159,7 @@ static int nx_emmc_bis_read_block_normal(u32 sector, u32 count, void *buff)
res = emmc_part_read(system_part, sector, count, bis_cache->dma_buff); res = emmc_part_read(system_part, sector, count, bis_cache->dma_buff);
else else
res = sdmmc_storage_read(&sd_storage, emu_offset + system_part->lba_start + sector, count, bis_cache->dma_buff); res = sdmmc_storage_read(&sd_storage, emu_offset + system_part->lba_start + sector, count, bis_cache->dma_buff);
if (!res) if (res)
return 1; // R/W error. return 1; // R/W error.
if (prev_cluster != cluster) // Sector in different cluster than last read. if (prev_cluster != cluster) // Sector in different cluster than last read.
@@ -216,7 +216,7 @@ static int nx_emmc_bis_read_block_cached(u32 sector, u32 count, void *buff)
res = emmc_part_read(system_part, cluster_sector, BIS_CLUSTER_SECTORS, bis_cache->dma_buff); res = emmc_part_read(system_part, cluster_sector, BIS_CLUSTER_SECTORS, bis_cache->dma_buff);
else else
res = sdmmc_storage_read(&sd_storage, emu_offset + system_part->lba_start + cluster_sector, BIS_CLUSTER_SECTORS, bis_cache->dma_buff); res = sdmmc_storage_read(&sd_storage, emu_offset + system_part->lba_start + cluster_sector, BIS_CLUSTER_SECTORS, bis_cache->dma_buff);
if (!res) if (res)
return 1; // R/W error. return 1; // R/W error.
// Decrypt cluster. // Decrypt cluster.
@@ -258,14 +258,14 @@ int nx_emmc_bis_read(u32 sector, u32 count, void *buff)
u32 sct_cnt = MIN(count, cnt_max); // Only allow cluster sized access. u32 sct_cnt = MIN(count, cnt_max); // Only allow cluster sized access.
if (nx_emmc_bis_read_block(curr_sct, sct_cnt, buf)) if (nx_emmc_bis_read_block(curr_sct, sct_cnt, buf))
return 0; return 1;
count -= sct_cnt; count -= sct_cnt;
curr_sct += sct_cnt; curr_sct += sct_cnt;
buf += sct_cnt * EMMC_BLOCKSIZE; buf += sct_cnt * EMMC_BLOCKSIZE;
} }
return 1; return 0;
} }
int nx_emmc_bis_write(u32 sector, u32 count, void *buff) int nx_emmc_bis_write(u32 sector, u32 count, void *buff)
@@ -282,14 +282,14 @@ int nx_emmc_bis_write(u32 sector, u32 count, void *buff)
u32 sct_cnt = MIN(count, cnt_max); // Only allow cluster sized access. u32 sct_cnt = MIN(count, cnt_max); // Only allow cluster sized access.
if (nx_emmc_bis_write_block(curr_sct, sct_cnt, buf, false)) if (nx_emmc_bis_write_block(curr_sct, sct_cnt, buf, false))
return 0; return 1;
count -= sct_cnt; count -= sct_cnt;
curr_sct += sct_cnt; curr_sct += sct_cnt;
buf += sct_cnt * EMMC_BLOCKSIZE; buf += sct_cnt * EMMC_BLOCKSIZE;
} }
return 1; return 0;
} }
void nx_emmc_bis_init(emmc_part_t *part, bool enable_cache, u32 emummc_offset) void nx_emmc_bis_init(emmc_part_t *part, bool enable_cache, u32 emummc_offset)

View File

@@ -103,7 +103,7 @@ int sd_init_retry(bool power_cycle)
switch (sd_mode) switch (sd_mode)
{ {
case SD_INIT_FAIL: // Reset to max. case SD_INIT_FAIL: // Reset to max.
return 0; return 1;
case SD_1BIT_HS25: case SD_1BIT_HS25:
bus_width = SDMMC_BUS_WIDTH_1; bus_width = SDMMC_BUS_WIDTH_1;
@@ -134,7 +134,7 @@ int sd_init_retry(bool power_cycle)
} }
int res = sdmmc_storage_init_sd(&sd_storage, &sd_sdmmc, bus_width, type); int res = sdmmc_storage_init_sd(&sd_storage, &sd_sdmmc, bus_width, type);
if (res) if (!res)
{ {
sd_init_done = true; sd_init_done = true;
insertion_event = true; insertion_event = true;
@@ -145,17 +145,17 @@ int sd_init_retry(bool power_cycle)
return res; return res;
} }
bool sd_initialize(bool power_cycle) int sd_initialize(bool power_cycle)
{ {
if (power_cycle) if (power_cycle)
sdmmc_storage_end(&sd_storage); sdmmc_storage_end(&sd_storage);
int res = !sd_init_retry(false); int res = sd_init_retry(false);
while (true) while (true)
{ {
if (!res) if (!res)
return true; return 0;
else if (!sdmmc_get_sd_inserted()) // SD Card is not inserted. else if (!sdmmc_get_sd_inserted()) // SD Card is not inserted.
{ {
sd_mode = SD_DEFAULT_SPEED; sd_mode = SD_DEFAULT_SPEED;
@@ -168,24 +168,24 @@ bool sd_initialize(bool power_cycle)
if (sd_mode == SD_INIT_FAIL) if (sd_mode == SD_INIT_FAIL)
break; break;
else else
res = !sd_init_retry(true); res = sd_init_retry(true);
} }
} }
sdmmc_storage_end(&sd_storage); sdmmc_storage_end(&sd_storage);
return false; return 1;
} }
bool sd_mount() int sd_mount()
{ {
if (sd_init_done && sd_mounted) if (sd_init_done && sd_mounted)
return true; return 0;
int res = 0; int res = 0;
if (!sd_init_done) if (!sd_init_done)
res = !sd_initialize(false); res = sd_initialize(false);
if (res) if (res)
{ {
@@ -203,7 +203,7 @@ bool sd_mount()
if (res == FR_OK) if (res == FR_OK)
{ {
sd_mounted = true; sd_mounted = true;
return true; return 0;
} }
else else
{ {
@@ -212,7 +212,7 @@ bool sd_mount()
} }
} }
return false; return 1;
} }
static void _sd_deinit(bool deinit) static void _sd_deinit(bool deinit)

View File

@@ -55,8 +55,8 @@ bool sd_get_card_initialized();
bool sd_get_card_mounted(); bool sd_get_card_mounted();
u32 sd_get_mode(); u32 sd_get_mode();
int sd_init_retry(bool power_cycle); int sd_init_retry(bool power_cycle);
bool sd_initialize(bool power_cycle); int sd_initialize(bool power_cycle);
bool sd_mount(); int sd_mount();
void sd_unmount(); void sd_unmount();
void sd_end(); void sd_end();
bool sd_is_gpt(); bool sd_is_gpt();

File diff suppressed because it is too large Load Diff

View File

@@ -70,13 +70,13 @@ static int _sdmmc_set_io_power(sdmmc_t *sdmmc, u32 power)
break; break;
default: default:
return 0; return 1;
} }
if (power != SDMMC_POWER_OFF) if (power != SDMMC_POWER_OFF)
sdmmc->regs->pwrcon |= SDHCI_POWER_ON; sdmmc->regs->pwrcon |= SDHCI_POWER_ON;
return 1; return 0;
} }
u32 sdmmc_get_bus_width(sdmmc_t *sdmmc) u32 sdmmc_get_bus_width(sdmmc_t *sdmmc)
@@ -121,8 +121,9 @@ static int _sdmmc_config_tap_val(sdmmc_t *sdmmc, u32 type)
if (type == SDHCI_TIMING_MMC_HS400) if (type == SDHCI_TIMING_MMC_HS400)
{ {
// Tap is saved during HS200 switch.
if (!sdmmc->venclkctl_set) if (!sdmmc->venclkctl_set)
return 0; return 1;
tap_val = sdmmc->venclkctl_tap; tap_val = sdmmc->venclkctl_tap;
} }
@@ -131,7 +132,7 @@ static int _sdmmc_config_tap_val(sdmmc_t *sdmmc, u32 type)
sdmmc->regs->venclkctl = (sdmmc->regs->venclkctl & ~0xFF0000) | (tap_val << 16); sdmmc->regs->venclkctl = (sdmmc->regs->venclkctl & ~0xFF0000) | (tap_val << 16);
return 1; return 0;
} }
static void _sdmmc_commit_changes(sdmmc_t *sdmmc) static void _sdmmc_commit_changes(sdmmc_t *sdmmc)
@@ -236,7 +237,7 @@ static void _sdmmc_autocal_execute(sdmmc_t *sdmmc, u32 power)
static int _sdmmc_dll_cal_execute(sdmmc_t *sdmmc) static int _sdmmc_dll_cal_execute(sdmmc_t *sdmmc)
{ {
int result = 1, should_disable_sd_clock = 0; int res = 0, should_disable_sd_clock = 0;
if (!(sdmmc->regs->clkcon & SDHCI_CLOCK_CARD_EN)) if (!(sdmmc->regs->clkcon & SDHCI_CLOCK_CARD_EN))
{ {
@@ -256,7 +257,7 @@ static int _sdmmc_dll_cal_execute(sdmmc_t *sdmmc)
{ {
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
{ {
result = 0; res = 1;
goto out; goto out;
} }
} }
@@ -266,15 +267,16 @@ static int _sdmmc_dll_cal_execute(sdmmc_t *sdmmc)
{ {
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
{ {
result = 0; res = 1;
goto out; goto out;
} }
} }
out:; out:
if (should_disable_sd_clock) if (should_disable_sd_clock)
sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN; sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN;
return result;
return res;
} }
static void _sdmmc_reset_cmd_data(sdmmc_t *sdmmc) static void _sdmmc_reset_cmd_data(sdmmc_t *sdmmc)
@@ -389,7 +391,7 @@ int sdmmc_setup_clock(sdmmc_t *sdmmc, u32 type)
if (type == SDHCI_TIMING_MMC_HS400) if (type == SDHCI_TIMING_MMC_HS400)
return _sdmmc_dll_cal_execute(sdmmc); return _sdmmc_dll_cal_execute(sdmmc);
return 1; return 0;
} }
static void _sdmmc_card_clock_enable(sdmmc_t *sdmmc) static void _sdmmc_card_clock_enable(sdmmc_t *sdmmc)
@@ -455,16 +457,16 @@ static int _sdmmc_cache_rsp(sdmmc_t *sdmmc, u32 *rsp, u32 type)
break; break;
default: default:
return 0; return 1;
} }
return 1; return 0;
} }
int sdmmc_get_cached_rsp(sdmmc_t *sdmmc, u32 *rsp, u32 type) int sdmmc_get_cached_rsp(sdmmc_t *sdmmc, u32 *rsp, u32 type)
{ {
if (!rsp || sdmmc->expected_rsp_type != type) if (sdmmc->expected_rsp_type != type)
return 0; return 1;
switch (type) switch (type)
{ {
@@ -481,10 +483,10 @@ int sdmmc_get_cached_rsp(sdmmc_t *sdmmc, u32 *rsp, u32 type)
break; break;
default: default:
return 0; return 1;
} }
return 1; return 0;
} }
static int _sdmmc_wait_cmd_data_inhibit(sdmmc_t *sdmmc, bool wait_dat) static int _sdmmc_wait_cmd_data_inhibit(sdmmc_t *sdmmc, bool wait_dat)
@@ -496,7 +498,7 @@ static int _sdmmc_wait_cmd_data_inhibit(sdmmc_t *sdmmc, bool wait_dat)
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
{ {
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
if (wait_dat) if (wait_dat)
@@ -506,11 +508,11 @@ static int _sdmmc_wait_cmd_data_inhibit(sdmmc_t *sdmmc, bool wait_dat)
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
{ {
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
} }
return 1; return 0;
} }
static int _sdmmc_wait_card_busy(sdmmc_t *sdmmc) static int _sdmmc_wait_card_busy(sdmmc_t *sdmmc)
@@ -522,10 +524,10 @@ static int _sdmmc_wait_card_busy(sdmmc_t *sdmmc)
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
{ {
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
return 1; return 0;
} }
static int _sdmmc_setup_read_small_block(sdmmc_t *sdmmc) static int _sdmmc_setup_read_small_block(sdmmc_t *sdmmc)
@@ -533,7 +535,7 @@ static int _sdmmc_setup_read_small_block(sdmmc_t *sdmmc)
switch (sdmmc_get_bus_width(sdmmc)) switch (sdmmc_get_bus_width(sdmmc))
{ {
case SDMMC_BUS_WIDTH_1: case SDMMC_BUS_WIDTH_1:
return 0; return 1;
case SDMMC_BUS_WIDTH_4: case SDMMC_BUS_WIDTH_4:
sdmmc->regs->blksize = 64; sdmmc->regs->blksize = 64;
@@ -547,7 +549,7 @@ static int _sdmmc_setup_read_small_block(sdmmc_t *sdmmc)
sdmmc->regs->blkcnt = 1; sdmmc->regs->blkcnt = 1;
sdmmc->regs->trnmod = SDHCI_TRNS_READ; sdmmc->regs->trnmod = SDHCI_TRNS_READ;
return 1; return 0;
} }
static int _sdmmc_send_cmd(sdmmc_t *sdmmc, const sdmmc_cmd_t *cmd, bool is_data_present) static int _sdmmc_send_cmd(sdmmc_t *sdmmc, const sdmmc_cmd_t *cmd, bool is_data_present)
@@ -577,7 +579,7 @@ static int _sdmmc_send_cmd(sdmmc_t *sdmmc, const sdmmc_cmd_t *cmd, bool is_data_
break; break;
default: default:
return 0; return 1;
} }
if (is_data_present) if (is_data_present)
@@ -586,7 +588,7 @@ static int _sdmmc_send_cmd(sdmmc_t *sdmmc, const sdmmc_cmd_t *cmd, bool is_data_
sdmmc->regs->argument = cmd->arg; sdmmc->regs->argument = cmd->arg;
sdmmc->regs->cmdreg = SDHCI_CMD_IDX(cmd->cmd) | cmdflags; sdmmc->regs->cmdreg = SDHCI_CMD_IDX(cmd->cmd) | cmdflags;
return 1; return 0;
} }
static void _sdmmc_send_tuning_cmd(sdmmc_t *sdmmc, u32 cmd) static void _sdmmc_send_tuning_cmd(sdmmc_t *sdmmc, u32 cmd)
@@ -601,8 +603,8 @@ static void _sdmmc_send_tuning_cmd(sdmmc_t *sdmmc, u32 cmd)
static int _sdmmc_tuning_execute_once(sdmmc_t *sdmmc, u32 cmd, u32 tap) static int _sdmmc_tuning_execute_once(sdmmc_t *sdmmc, u32 cmd, u32 tap)
{ {
if (!_sdmmc_wait_cmd_data_inhibit(sdmmc, true)) if (_sdmmc_wait_cmd_data_inhibit(sdmmc, true))
return 0; return 1;
_sdmmc_setup_read_small_block(sdmmc); _sdmmc_setup_read_small_block(sdmmc);
@@ -632,13 +634,15 @@ static int _sdmmc_tuning_execute_once(sdmmc_t *sdmmc, u32 cmd, u32 tap)
u32 timeout = get_tmr_us() + 5000; u32 timeout = get_tmr_us() + 5000;
while (get_tmr_us() < timeout) while (get_tmr_us() < timeout)
{ {
// Check if we got valid data.
if (sdmmc->regs->norintsts & SDHCI_INT_DATA_AVAIL) if (sdmmc->regs->norintsts & SDHCI_INT_DATA_AVAIL)
{ {
sdmmc->regs->norintsts = SDHCI_INT_DATA_AVAIL; sdmmc->regs->norintsts = SDHCI_INT_DATA_AVAIL;
sdmmc->regs->norintstsen &= ~SDHCI_INT_DATA_AVAIL; sdmmc->regs->norintstsen &= ~SDHCI_INT_DATA_AVAIL;
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
return 1;
return 0;
} }
} }
@@ -648,7 +652,7 @@ static int _sdmmc_tuning_execute_once(sdmmc_t *sdmmc, u32 cmd, u32 tap)
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
return 0; return 1;
} }
#ifdef BDK_SDMMC_UHS_DDR200_SUPPORT #ifdef BDK_SDMMC_UHS_DDR200_SUPPORT
@@ -700,7 +704,7 @@ static int _sdmmc_manual_tuning_set_tap(sdmmc_t *sdmmc, sdmmc_manual_tuning_t *t
// Check if failed or window too small. // Check if failed or window too small.
if (!best_tap || best_size < SDMMC_SAMPLE_WIN_SIZE_MIN) if (!best_tap || best_size < SDMMC_SAMPLE_WIN_SIZE_MIN)
return 0; return 1;
sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN; sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN;
sdmmc->regs->ventunctl0 &= ~SDHCI_TEGRA_TUNING_TAP_HW_UPDATED; sdmmc->regs->ventunctl0 &= ~SDHCI_TEGRA_TUNING_TAP_HW_UPDATED;
@@ -711,7 +715,7 @@ static int _sdmmc_manual_tuning_set_tap(sdmmc_t *sdmmc, sdmmc_manual_tuning_t *t
sdmmc->regs->ventunctl0 |= SDHCI_TEGRA_TUNING_TAP_HW_UPDATED; sdmmc->regs->ventunctl0 |= SDHCI_TEGRA_TUNING_TAP_HW_UPDATED;
sdmmc->regs->clkcon |= SDHCI_CLOCK_CARD_EN; sdmmc->regs->clkcon |= SDHCI_CLOCK_CARD_EN;
return 1; return 0;
} }
/* /*
@@ -758,7 +762,7 @@ int sdmmc_tuning_execute(sdmmc_t *sdmmc, u32 type, u32 cmd)
u32 num_iter, flag; u32 num_iter, flag;
if (sdmmc->powersave_enabled) if (sdmmc->powersave_enabled)
return 0; return 1;
switch (type) switch (type)
{ {
@@ -779,7 +783,7 @@ int sdmmc_tuning_execute(sdmmc_t *sdmmc, u32 type, u32 cmd)
case SDHCI_TIMING_MMC_HS400: case SDHCI_TIMING_MMC_HS400:
case SDHCI_TIMING_UHS_SDR12: case SDHCI_TIMING_UHS_SDR12:
case SDHCI_TIMING_UHS_SDR25: case SDHCI_TIMING_UHS_SDR25:
return 1; return 0;
#ifdef BDK_SDMMC_UHS_DDR200_SUPPORT #ifdef BDK_SDMMC_UHS_DDR200_SUPPORT
case SDHCI_TIMING_UHS_DDR200: case SDHCI_TIMING_UHS_DDR200:
@@ -787,7 +791,7 @@ int sdmmc_tuning_execute(sdmmc_t *sdmmc, u32 type, u32 cmd)
#endif #endif
default: default:
return 0; return 1;
} }
sdmmc->regs->ventunctl1 = 0; // step_size 1. sdmmc->regs->ventunctl1 = 0; // step_size 1.
@@ -806,9 +810,9 @@ int sdmmc_tuning_execute(sdmmc_t *sdmmc, u32 type, u32 cmd)
} }
if (sdmmc->regs->hostctl2 & SDHCI_CTRL_TUNED_CLK) if (sdmmc->regs->hostctl2 & SDHCI_CTRL_TUNED_CLK)
return 1;
return 0; return 0;
return 1;
} }
static int _sdmmc_enable_internal_clock(sdmmc_t *sdmmc) static int _sdmmc_enable_internal_clock(sdmmc_t *sdmmc)
@@ -820,7 +824,7 @@ static int _sdmmc_enable_internal_clock(sdmmc_t *sdmmc)
while (!(sdmmc->regs->clkcon & SDHCI_CLOCK_INT_STABLE)) while (!(sdmmc->regs->clkcon & SDHCI_CLOCK_INT_STABLE))
{ {
if (get_tmr_ms() > timeout) if (get_tmr_ms() > timeout)
return 0; return 1;
} }
sdmmc->regs->hostctl2 &= ~SDHCI_CTRL_PRESET_VAL_EN; sdmmc->regs->hostctl2 &= ~SDHCI_CTRL_PRESET_VAL_EN;
@@ -829,13 +833,13 @@ static int _sdmmc_enable_internal_clock(sdmmc_t *sdmmc)
sdmmc->regs->hostctl2 |= SDHCI_HOST_VERSION_4_EN; sdmmc->regs->hostctl2 |= SDHCI_HOST_VERSION_4_EN;
if (!(sdmmc->regs->capareg & SDHCI_CAP_64BIT)) if (!(sdmmc->regs->capareg & SDHCI_CAP_64BIT))
return 0; return 1;
sdmmc->regs->hostctl2 |= SDHCI_ADDRESSING_64BIT_EN; sdmmc->regs->hostctl2 |= SDHCI_ADDRESSING_64BIT_EN;
sdmmc->regs->hostctl &= ~SDHCI_CTRL_DMA_MASK; // Use SDMA. Host V4 enabled so adma address regs in use. sdmmc->regs->hostctl &= ~SDHCI_CTRL_DMA_MASK; // Use SDMA. Host V4 enabled so adma address regs in use.
sdmmc->regs->timeoutcon = (sdmmc->regs->timeoutcon & 0xF0) | 14; // TMCLK * 2^27. sdmmc->regs->timeoutcon = (sdmmc->regs->timeoutcon & 0xF0) | 14; // TMCLK * 2^27.
return 1; return 0;
} }
static int _sdmmc_autocal_config_offset(sdmmc_t *sdmmc, u32 power) static int _sdmmc_autocal_config_offset(sdmmc_t *sdmmc, u32 power)
@@ -848,7 +852,7 @@ static int _sdmmc_autocal_config_offset(sdmmc_t *sdmmc, u32 power)
case SDMMC_2: case SDMMC_2:
case SDMMC_4: case SDMMC_4:
if (power != SDMMC_POWER_1_8) if (power != SDMMC_POWER_1_8)
return 0; return 1;
off_pd = 5; off_pd = 5;
off_pu = 5; off_pu = 5;
break; break;
@@ -876,12 +880,12 @@ static int _sdmmc_autocal_config_offset(sdmmc_t *sdmmc, u32 power)
} }
} }
else else
return 0; return 1;
break; break;
} }
sdmmc->regs->autocalcfg = (sdmmc->regs->autocalcfg & 0xFFFF8080) | (off_pd << 8) | off_pu; sdmmc->regs->autocalcfg = (sdmmc->regs->autocalcfg & 0xFFFF8080) | (off_pd << 8) | off_pu;
return 1; return 0;
} }
static void _sdmmc_enable_interrupts(sdmmc_t *sdmmc) static void _sdmmc_enable_interrupts(sdmmc_t *sdmmc)
@@ -935,25 +939,25 @@ static int _sdmmc_wait_response(sdmmc_t *sdmmc)
u32 timeout = get_tmr_ms() + 2000; u32 timeout = get_tmr_ms() + 2000;
while (true) while (true)
{ {
u32 result = _sdmmc_check_mask_interrupt(sdmmc, NULL, SDHCI_INT_RESPONSE); u32 res = _sdmmc_check_mask_interrupt(sdmmc, NULL, SDHCI_INT_RESPONSE);
if (result == SDMMC_MASKINT_MASKED) if (res == SDMMC_MASKINT_MASKED)
break; break;
if (result != SDMMC_MASKINT_NOERROR || get_tmr_ms() > timeout) if (res != SDMMC_MASKINT_NOERROR || get_tmr_ms() > timeout)
{ {
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
} }
return 1; return 0;
} }
static int _sdmmc_stop_transmission_inner(sdmmc_t *sdmmc, u32 *rsp) static int _sdmmc_stop_transmission_inner(sdmmc_t *sdmmc, u32 *rsp)
{ {
sdmmc_cmd_t cmd; sdmmc_cmd_t cmd;
if (!_sdmmc_wait_cmd_data_inhibit(sdmmc, false)) if (_sdmmc_wait_cmd_data_inhibit(sdmmc, false))
return 0; return 1;
_sdmmc_enable_interrupts(sdmmc); _sdmmc_enable_interrupts(sdmmc);
@@ -964,11 +968,11 @@ static int _sdmmc_stop_transmission_inner(sdmmc_t *sdmmc, u32 *rsp)
_sdmmc_send_cmd(sdmmc, &cmd, false); _sdmmc_send_cmd(sdmmc, &cmd, false);
int result = _sdmmc_wait_response(sdmmc); int res = _sdmmc_wait_response(sdmmc);
_sdmmc_mask_interrupts(sdmmc); _sdmmc_mask_interrupts(sdmmc);
if (!result) if (res)
return 0; return 1;
_sdmmc_cache_rsp(sdmmc, rsp, SDMMC_RSP_TYPE_1); _sdmmc_cache_rsp(sdmmc, rsp, SDMMC_RSP_TYPE_1);
@@ -978,7 +982,7 @@ static int _sdmmc_stop_transmission_inner(sdmmc_t *sdmmc, u32 *rsp)
int sdmmc_stop_transmission(sdmmc_t *sdmmc, u32 *rsp) int sdmmc_stop_transmission(sdmmc_t *sdmmc, u32 *rsp)
{ {
if (!sdmmc->card_clock_enabled) if (!sdmmc->card_clock_enabled)
return 0; return 1;
// Recalibrate periodically if needed. // Recalibrate periodically if needed.
if (sdmmc->periodic_calibration && sdmmc->powersave_enabled) if (sdmmc->periodic_calibration && sdmmc->powersave_enabled)
@@ -993,35 +997,35 @@ int sdmmc_stop_transmission(sdmmc_t *sdmmc, u32 *rsp)
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
} }
int result = _sdmmc_stop_transmission_inner(sdmmc, rsp); int res = _sdmmc_stop_transmission_inner(sdmmc, rsp);
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
if (should_disable_sd_clock) if (should_disable_sd_clock)
sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN; sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN;
return result; return res;
} }
static int _sdmmc_config_sdma(sdmmc_t *sdmmc, u32 *blkcnt_out, const sdmmc_req_t *req) static int _sdmmc_config_sdma(sdmmc_t *sdmmc, u32 *blkcnt_out, const sdmmc_req_t *request)
{ {
if (!req->blksize || !req->num_sectors) if (!request->blksize || !request->num_sectors)
return 0; return 1;
u32 blkcnt = req->num_sectors; u32 blkcnt = request->num_sectors;
if (blkcnt >= SDMMC_HMAX_BLOCKNUM) if (blkcnt >= SDMMC_HMAX_BLOCKNUM)
blkcnt = SDMMC_HMAX_BLOCKNUM; blkcnt = SDMMC_HMAX_BLOCKNUM;
u32 admaaddr = (u32)req->buf; u32 admaaddr = (u32)request->buf;
// Check alignment. // Check alignment.
if (admaaddr & 7) if (admaaddr & 7)
return 0; return 1;
sdmmc->regs->admaaddr = admaaddr; sdmmc->regs->admaaddr = admaaddr;
sdmmc->regs->admaaddr_hi = 0; sdmmc->regs->admaaddr_hi = 0;
sdmmc->dma_addr_next = ALIGN_DOWN((admaaddr + SZ_512K), SZ_512K); sdmmc->dma_addr_next = ALIGN_DOWN((admaaddr + SZ_512K), SZ_512K);
sdmmc->regs->blksize = req->blksize | (7u << 12); // SDMA DMA 512KB Boundary (Detects A18 carry out). sdmmc->regs->blksize = request->blksize | (7u << 12); // SDMA DMA 512KB Boundary (Detects A18 carry out).
sdmmc->regs->blkcnt = blkcnt; sdmmc->regs->blkcnt = blkcnt;
if (blkcnt_out) if (blkcnt_out)
@@ -1030,22 +1034,22 @@ static int _sdmmc_config_sdma(sdmmc_t *sdmmc, u32 *blkcnt_out, const sdmmc_req_t
u32 trnmode = SDHCI_TRNS_DMA | SDHCI_TRNS_RTYPE_R1; u32 trnmode = SDHCI_TRNS_DMA | SDHCI_TRNS_RTYPE_R1;
// Set multiblock request. // Set multiblock request.
if (req->is_multi_block) if (request->is_multi_block)
trnmode |= SDHCI_TRNS_MULTI | SDHCI_TRNS_BLK_CNT_EN; trnmode |= SDHCI_TRNS_MULTI | SDHCI_TRNS_BLK_CNT_EN;
// Set request direction. // Set request direction.
if (!req->is_write) if (!request->is_write)
trnmode |= SDHCI_TRNS_READ; trnmode |= SDHCI_TRNS_READ;
// Automatic send of stop transmission or set block count cmd. // Automatic send of stop transmission or set block count cmd.
if (req->is_auto_stop_trn) if (request->is_auto_stop_trn)
trnmode |= SDHCI_TRNS_AUTO_CMD12; trnmode |= SDHCI_TRNS_AUTO_CMD12;
//else if (req->is_auto_set_blkcnt) //else if (request->is_auto_set_blkcnt)
// trnmode |= SDHCI_TRNS_AUTO_CMD23; // trnmode |= SDHCI_TRNS_AUTO_CMD23;
sdmmc->regs->trnmod = trnmode; sdmmc->regs->trnmod = trnmode;
return 1; return 0;
} }
static int _sdmmc_update_sdma(sdmmc_t *sdmmc) static int _sdmmc_update_sdma(sdmmc_t *sdmmc)
@@ -1057,17 +1061,17 @@ static int _sdmmc_update_sdma(sdmmc_t *sdmmc)
u32 timeout = get_tmr_ms() + 1500; u32 timeout = get_tmr_ms() + 1500;
do do
{ {
u32 result = SDMMC_MASKINT_MASKED; u32 res = SDMMC_MASKINT_MASKED;
while (true) while (true)
{ {
u16 intr = 0; u16 intr = 0;
result = _sdmmc_check_mask_interrupt(sdmmc, &intr, res = _sdmmc_check_mask_interrupt(sdmmc, &intr,
SDHCI_INT_DATA_END | SDHCI_INT_DMA_END); SDHCI_INT_DATA_END | SDHCI_INT_DMA_END);
if (result != SDMMC_MASKINT_MASKED) if (res != SDMMC_MASKINT_MASKED)
break; break;
if (intr & SDHCI_INT_DATA_END) if (intr & SDHCI_INT_DATA_END)
return 1; // Transfer complete. return 0; // Transfer complete.
if (intr & SDHCI_INT_DMA_END) if (intr & SDHCI_INT_DMA_END)
{ {
@@ -1078,39 +1082,39 @@ static int _sdmmc_update_sdma(sdmmc_t *sdmmc)
} }
} }
if (result != SDMMC_MASKINT_NOERROR) if (res != SDMMC_MASKINT_NOERROR)
{ {
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
EPRINTFARGS("SDMMC%d: int error!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: int error!", sdmmc->id + 1);
#endif #endif
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
} while (get_tmr_ms() < timeout); } while (get_tmr_ms() < timeout);
} while (sdmmc->regs->blkcnt != blkcnt); } while (sdmmc->regs->blkcnt != blkcnt);
_sdmmc_reset_cmd_data(sdmmc); _sdmmc_reset_cmd_data(sdmmc);
return 0; return 1;
} }
static int _sdmmc_execute_cmd_inner(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *req, u32 *blkcnt_out) static int _sdmmc_execute_cmd_inner(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *request, u32 *blkcnt_out)
{ {
bool has_req_or_check_busy = req || cmd->check_busy; bool has_req_or_check_busy = request || cmd->check_busy;
if (!_sdmmc_wait_cmd_data_inhibit(sdmmc, has_req_or_check_busy)) if (_sdmmc_wait_cmd_data_inhibit(sdmmc, has_req_or_check_busy))
return 0; return 1;
u32 blkcnt = 0; u32 blkcnt = 0;
bool is_data_present = false; bool is_data_present = false;
if (req) if (request)
{ {
if (!_sdmmc_config_sdma(sdmmc, &blkcnt, req)) if (_sdmmc_config_sdma(sdmmc, &blkcnt, request))
{ {
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
EPRINTFARGS("SDMMC%d: DMA Wrong cfg!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: DMA Wrong cfg!", sdmmc->id + 1);
#endif #endif
return 0; return 1;
} }
// Flush cache before starting the transfer. // Flush cache before starting the transfer.
@@ -1121,37 +1125,38 @@ static int _sdmmc_execute_cmd_inner(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_
_sdmmc_enable_interrupts(sdmmc); _sdmmc_enable_interrupts(sdmmc);
if (!_sdmmc_send_cmd(sdmmc, cmd, is_data_present)) if (_sdmmc_send_cmd(sdmmc, cmd, is_data_present))
{ {
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
EPRINTFARGS("SDMMC%d: Wrong Response type %08X!", sdmmc->id + 1, cmd->rsp_type); EPRINTFARGS("SDMMC%d: Wrong Response type %08X!", sdmmc->id + 1, cmd->rsp_type);
#endif #endif
return 0; return 1;
} }
int result = _sdmmc_wait_response(sdmmc); int res = _sdmmc_wait_response(sdmmc);
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
if (!result) if (res)
EPRINTFARGS("SDMMC%d: Transfer error!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: Transfer error!", sdmmc->id + 1);
#endif #endif
DPRINTF("rsp(%d): %08X, %08X, %08X, %08X\n", result, DPRINTF("rsp(%d): %08X, %08X, %08X, %08X\n", res,
sdmmc->regs->rspreg[0], sdmmc->regs->rspreg[1], sdmmc->regs->rspreg[2], sdmmc->regs->rspreg[3]); sdmmc->regs->rspreg[0], sdmmc->regs->rspreg[1], sdmmc->regs->rspreg[2], sdmmc->regs->rspreg[3]);
if (result)
if (!res)
{ {
if (cmd->rsp_type) if (cmd->rsp_type)
{ {
sdmmc->expected_rsp_type = cmd->rsp_type; sdmmc->expected_rsp_type = cmd->rsp_type;
result = _sdmmc_cache_rsp(sdmmc, sdmmc->rsp, cmd->rsp_type); res = _sdmmc_cache_rsp(sdmmc, sdmmc->rsp, cmd->rsp_type);
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
if (!result) if (res)
EPRINTFARGS("SDMMC%d: Unknown response type!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: Unknown response type!", sdmmc->id + 1);
#endif #endif
} }
if (req && result) if (request && !res)
{ {
result = _sdmmc_update_sdma(sdmmc); res = _sdmmc_update_sdma(sdmmc);
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
if (!result) if (res)
EPRINTFARGS("SDMMC%d: DMA Update failed!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: DMA Update failed!", sdmmc->id + 1);
#endif #endif
} }
@@ -1159,9 +1164,9 @@ static int _sdmmc_execute_cmd_inner(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_
_sdmmc_mask_interrupts(sdmmc); _sdmmc_mask_interrupts(sdmmc);
if (result) if (!res)
{ {
if (req) if (request)
{ {
// Invalidate cache after transfer. // Invalidate cache after transfer.
bpmp_mmu_maintenance(BPMP_MMU_MAINT_INVALID_WAY, false); bpmp_mmu_maintenance(BPMP_MMU_MAINT_INVALID_WAY, false);
@@ -1169,22 +1174,21 @@ static int _sdmmc_execute_cmd_inner(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_
if (blkcnt_out) if (blkcnt_out)
*blkcnt_out = blkcnt; *blkcnt_out = blkcnt;
if (req->is_auto_stop_trn) if (request->is_auto_stop_trn)
sdmmc->stop_trn_rsp = sdmmc->regs->rspreg[3]; sdmmc->stop_trn_rsp = sdmmc->regs->rspreg[3];
} }
if (has_req_or_check_busy) if (has_req_or_check_busy)
{ {
result = _sdmmc_wait_card_busy(sdmmc); res = _sdmmc_wait_card_busy(sdmmc);
#ifdef ERROR_EXTRA_PRINTING #ifdef ERROR_EXTRA_PRINTING
if (!result) if (res)
EPRINTFARGS("SDMMC%d: Busy timeout!", sdmmc->id + 1); EPRINTFARGS("SDMMC%d: Busy timeout!", sdmmc->id + 1);
#endif #endif
return result;
} }
} }
return result; return res;
} }
bool sdmmc_get_sd_inserted() bool sdmmc_get_sd_inserted()
@@ -1251,7 +1255,7 @@ static int _sdmmc_config_sdmmc1(bool t210b01)
// Check if SD card is inserted. // Check if SD card is inserted.
if (!sdmmc_get_sd_inserted()) if (!sdmmc_get_sd_inserted())
return 0; return 1;
// Enable deep loopback for SDMMC1 CLK pad so reads work. // Enable deep loopback for SDMMC1 CLK pad so reads work.
APB_MISC(APB_MISC_GP_SDMMC1_CLK_LPBK_CONTROL) = 1; APB_MISC(APB_MISC_GP_SDMMC1_CLK_LPBK_CONTROL) = 1;
@@ -1300,7 +1304,7 @@ static int _sdmmc_config_sdmmc1(bool t210b01)
usleep(1000); usleep(1000);
} }
return 1; return 0;
} }
static void _sdmmc_config_emmc(u32 id, bool t210b01) static void _sdmmc_config_emmc(u32 id, bool t210b01)
@@ -1342,7 +1346,7 @@ int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type)
const u8 *trim_values; const u8 *trim_values;
if (id > SDMMC_4 || id == SDMMC_3) if (id > SDMMC_4 || id == SDMMC_3)
return 0; return 1;
memset(sdmmc, 0, sizeof(sdmmc_t)); memset(sdmmc, 0, sizeof(sdmmc_t));
@@ -1357,8 +1361,8 @@ int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type)
switch (id) switch (id)
{ {
case SDMMC_1: case SDMMC_1:
if (!_sdmmc_config_sdmmc1(sdmmc->t210b01)) if (_sdmmc_config_sdmmc1(sdmmc->t210b01))
return 0; return 1;
if (sdmmc->t210b01) if (sdmmc->t210b01)
vref_sel = 0; vref_sel = 0;
else else
@@ -1393,8 +1397,8 @@ int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type)
sdmmc->regs->sdmemcmppadctl = (sdmmc->regs->sdmemcmppadctl & ~SDHCI_TEGRA_PADCTRL_VREF_SEL_MASK) | vref_sel; sdmmc->regs->sdmemcmppadctl = (sdmmc->regs->sdmemcmppadctl & ~SDHCI_TEGRA_PADCTRL_VREF_SEL_MASK) | vref_sel;
// Configure auto calibration values. // Configure auto calibration values.
if (!_sdmmc_autocal_config_offset(sdmmc, power)) if (_sdmmc_autocal_config_offset(sdmmc, power))
return 0; return 1;
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
@@ -1402,22 +1406,23 @@ int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type)
_sdmmc_autocal_execute(sdmmc, power); _sdmmc_autocal_execute(sdmmc, power);
// Enable internal clock and power. // Enable internal clock and power.
if (_sdmmc_enable_internal_clock(sdmmc)) if (!_sdmmc_enable_internal_clock(sdmmc))
{ {
sdmmc_set_bus_width(sdmmc, bus_width); sdmmc_set_bus_width(sdmmc, bus_width);
_sdmmc_set_io_power(sdmmc, power); _sdmmc_set_io_power(sdmmc, power);
if (sdmmc_setup_clock(sdmmc, type)) if (!sdmmc_setup_clock(sdmmc, type))
{ {
sdmmc_card_clock_powersave(sdmmc, SDMMC_POWER_SAVE_DISABLE); sdmmc_card_clock_powersave(sdmmc, SDMMC_POWER_SAVE_DISABLE);
_sdmmc_card_clock_enable(sdmmc); _sdmmc_card_clock_enable(sdmmc);
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
return 1; return 0;
} }
} }
return 0; // Failed to enable clock.
return 1;
} }
void sdmmc1_disable_power() void sdmmc1_disable_power()
@@ -1480,10 +1485,10 @@ void sdmmc_init_cmd(sdmmc_cmd_t *cmdbuf, u16 cmd, u32 arg, u32 rsp_type, u32 che
cmdbuf->check_busy = check_busy; cmdbuf->check_busy = check_busy;
} }
int sdmmc_execute_cmd(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *req, u32 *blkcnt_out) int sdmmc_execute_cmd(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *request, u32 *blkcnt_out)
{ {
if (!sdmmc->card_clock_enabled) if (!sdmmc->card_clock_enabled)
return 0; return 1;
// Recalibrate periodically if needed. // Recalibrate periodically if needed.
if (sdmmc->periodic_calibration && sdmmc->powersave_enabled) if (sdmmc->periodic_calibration && sdmmc->powersave_enabled)
@@ -1498,19 +1503,19 @@ int sdmmc_execute_cmd(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *req, u32 *b
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
} }
int result = _sdmmc_execute_cmd_inner(sdmmc, cmd, req, blkcnt_out); int res = _sdmmc_execute_cmd_inner(sdmmc, cmd, request, blkcnt_out);
usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles. usleep((8 * 1000 + sdmmc->card_clock - 1) / sdmmc->card_clock); // Wait 8 cycles.
if (should_disable_sd_clock) if (should_disable_sd_clock)
sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN; sdmmc->regs->clkcon &= ~SDHCI_CLOCK_CARD_EN;
return result; return res;
} }
int sdmmc_enable_low_voltage(sdmmc_t *sdmmc) int sdmmc_enable_low_voltage(sdmmc_t *sdmmc)
{ {
if (sdmmc->id != SDMMC_1) if (sdmmc->id != SDMMC_1)
return 0; return 1;
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
@@ -1538,8 +1543,8 @@ int sdmmc_enable_low_voltage(sdmmc_t *sdmmc)
_sdmmc_commit_changes(sdmmc); _sdmmc_commit_changes(sdmmc);
usleep(1000); usleep(1000);
if ((sdmmc->regs->prnsts & SDHCI_DATA_LVL_MASK) == SDHCI_DATA_LVL_MASK) if ((sdmmc->regs->prnsts & SDHCI_DATA_LVL_MASK) == SDHCI_DATA_LVL_MASK)
return 1; return 0;
} }
return 0; return 1;
} }

View File

@@ -334,7 +334,7 @@ bool sdmmc_get_sd_inserted();
int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type); int sdmmc_init(sdmmc_t *sdmmc, u32 id, u32 power, u32 bus_width, u32 type);
void sdmmc_end(sdmmc_t *sdmmc); void sdmmc_end(sdmmc_t *sdmmc);
void sdmmc_init_cmd(sdmmc_cmd_t *cmdbuf, u16 cmd, u32 arg, u32 rsp_type, u32 check_busy); void sdmmc_init_cmd(sdmmc_cmd_t *cmdbuf, u16 cmd, u32 arg, u32 rsp_type, u32 check_busy);
int sdmmc_execute_cmd(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *req, u32 *blkcnt_out); int sdmmc_execute_cmd(sdmmc_t *sdmmc, sdmmc_cmd_t *cmd, sdmmc_req_t *request, u32 *blkcnt_out);
int sdmmc_enable_low_voltage(sdmmc_t *sdmmc); int sdmmc_enable_low_voltage(sdmmc_t *sdmmc);
#endif #endif

View File

@@ -495,7 +495,7 @@ static int _scsi_read(usbd_gadget_ums_t *ums, bulk_ctxt_t *bulk_ctxt)
} }
// Do the SDMMC read. // Do the SDMMC read.
if (!sdmmc_storage_read(ums->lun.storage, ums->lun.offset + lba_offset, amount, sdmmc_buf)) if (sdmmc_storage_read(ums->lun.storage, ums->lun.offset + lba_offset, amount, sdmmc_buf))
amount = 0; amount = 0;
// Wait for the async USB transfer to finish. // Wait for the async USB transfer to finish.
@@ -650,7 +650,7 @@ static int _scsi_write(usbd_gadget_ums_t *ums, bulk_ctxt_t *bulk_ctxt)
goto empty_write; goto empty_write;
// Perform the write. // Perform the write.
if (!sdmmc_storage_write(ums->lun.storage, ums->lun.offset + lba_offset, if (sdmmc_storage_write(ums->lun.storage, ums->lun.offset + lba_offset,
amount >> UMS_DISK_LBA_SHIFT, (u8 *)bulk_ctxt->bulk_out_buf)) amount >> UMS_DISK_LBA_SHIFT, (u8 *)bulk_ctxt->bulk_out_buf))
amount = 0; amount = 0;
@@ -722,7 +722,7 @@ static int _scsi_verify(usbd_gadget_ums_t *ums, bulk_ctxt_t *bulk_ctxt)
break; break;
} }
if (!sdmmc_storage_read(ums->lun.storage, ums->lun.offset + lba_offset, amount, bulk_ctxt->bulk_in_buf)) if (sdmmc_storage_read(ums->lun.storage, ums->lun.offset + lba_offset, amount, bulk_ctxt->bulk_in_buf))
amount = 0; amount = 0;
DPRINTF("File read %X @ %X\n", amount, lba_offset); DPRINTF("File read %X @ %X\n", amount, lba_offset);
@@ -1861,7 +1861,7 @@ int usb_device_gadget_ums(usb_ctxt_t *usbs)
if (usbs->type == MMC_SD) if (usbs->type == MMC_SD)
{ {
sd_end(); sd_end();
if (!sd_mount()) if (sd_mount())
{ {
ums.set_text(ums.label, "#FFDD00 Failed to init SD!#"); ums.set_text(ums.label, "#FFDD00 Failed to init SD!#");
res = 1; res = 1;
@@ -1874,7 +1874,7 @@ int usb_device_gadget_ums(usb_ctxt_t *usbs)
} }
else else
{ {
if (!emmc_initialize(false)) if (emmc_initialize(false))
{ {
ums.set_text(ums.label, "#FFDD00 Failed to init eMMC!#"); ums.set_text(ums.label, "#FFDD00 Failed to init eMMC!#");
res = 1; res = 1;