|
@@ -340,64 +340,23 @@ out:
|
|
|
return loc;
|
|
|
}
|
|
|
|
|
|
-static int dw_mci_exynos_execute_tuning(struct dw_mci_slot *slot, u32 opcode,
|
|
|
- struct dw_mci_tuning_data *tuning_data)
|
|
|
+static int dw_mci_exynos_execute_tuning(struct dw_mci_slot *slot)
|
|
|
{
|
|
|
struct dw_mci *host = slot->host;
|
|
|
struct mmc_host *mmc = slot->mmc;
|
|
|
- const u8 *blk_pattern = tuning_data->blk_pattern;
|
|
|
- u8 *blk_test;
|
|
|
- unsigned int blksz = tuning_data->blksz;
|
|
|
u8 start_smpl, smpl, candiates = 0;
|
|
|
s8 found = -1;
|
|
|
int ret = 0;
|
|
|
|
|
|
- blk_test = kmalloc(blksz, GFP_KERNEL);
|
|
|
- if (!blk_test)
|
|
|
- return -ENOMEM;
|
|
|
-
|
|
|
start_smpl = dw_mci_exynos_get_clksmpl(host);
|
|
|
|
|
|
do {
|
|
|
- struct mmc_request mrq = {NULL};
|
|
|
- struct mmc_command cmd = {0};
|
|
|
- struct mmc_command stop = {0};
|
|
|
- struct mmc_data data = {0};
|
|
|
- struct scatterlist sg;
|
|
|
-
|
|
|
- cmd.opcode = opcode;
|
|
|
- cmd.arg = 0;
|
|
|
- cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
|
|
|
-
|
|
|
- stop.opcode = MMC_STOP_TRANSMISSION;
|
|
|
- stop.arg = 0;
|
|
|
- stop.flags = MMC_RSP_R1B | MMC_CMD_AC;
|
|
|
-
|
|
|
- data.blksz = blksz;
|
|
|
- data.blocks = 1;
|
|
|
- data.flags = MMC_DATA_READ;
|
|
|
- data.sg = &sg;
|
|
|
- data.sg_len = 1;
|
|
|
-
|
|
|
- sg_init_one(&sg, blk_test, blksz);
|
|
|
- mrq.cmd = &cmd;
|
|
|
- mrq.stop = &stop;
|
|
|
- mrq.data = &data;
|
|
|
- host->mrq = &mrq;
|
|
|
-
|
|
|
mci_writel(host, TMOUT, ~0);
|
|
|
smpl = dw_mci_exynos_move_next_clksmpl(host);
|
|
|
|
|
|
- mmc_wait_for_req(mmc, &mrq);
|
|
|
+ if (!mmc_send_tuning(mmc))
|
|
|
+ candiates |= (1 << smpl);
|
|
|
|
|
|
- if (!cmd.error && !data.error) {
|
|
|
- if (!memcmp(blk_pattern, blk_test, blksz))
|
|
|
- candiates |= (1 << smpl);
|
|
|
- } else {
|
|
|
- dev_dbg(host->dev,
|
|
|
- "Tuning error: cmd.error:%d, data.error:%d\n",
|
|
|
- cmd.error, data.error);
|
|
|
- }
|
|
|
} while (start_smpl != smpl);
|
|
|
|
|
|
found = dw_mci_exynos_get_best_clksmpl(candiates);
|
|
@@ -406,7 +365,6 @@ static int dw_mci_exynos_execute_tuning(struct dw_mci_slot *slot, u32 opcode,
|
|
|
else
|
|
|
ret = -EIO;
|
|
|
|
|
|
- kfree(blk_test);
|
|
|
return ret;
|
|
|
}
|
|
|
|