mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-23 09:19:51 +00:00
mmc: dw_mmc: exynos: add variable delay tuning sequence
Implements variable delay tuning. In this change, exynos host can determine the correct sampling point for the HS200 and SDR104 speed mode. Signed-off-by: Seungwon Jeon <tgih.jun@samsung.com> Tested-by: Alim Akhtar <alim.akhtar@samsung.com> Signed-off-by: Chris Ball <cjb@laptop.org>
This commit is contained in:
parent
0976f16d2d
commit
c537a1c5ff
1 changed files with 124 additions and 0 deletions
|
@ -14,8 +14,10 @@
|
||||||
#include <linux/clk.h>
|
#include <linux/clk.h>
|
||||||
#include <linux/mmc/host.h>
|
#include <linux/mmc/host.h>
|
||||||
#include <linux/mmc/dw_mmc.h>
|
#include <linux/mmc/dw_mmc.h>
|
||||||
|
#include <linux/mmc/mmc.h>
|
||||||
#include <linux/of.h>
|
#include <linux/of.h>
|
||||||
#include <linux/of_gpio.h>
|
#include <linux/of_gpio.h>
|
||||||
|
#include <linux/slab.h>
|
||||||
|
|
||||||
#include "dw_mmc.h"
|
#include "dw_mmc.h"
|
||||||
#include "dw_mmc-pltfm.h"
|
#include "dw_mmc-pltfm.h"
|
||||||
|
@ -231,6 +233,127 @@ static int dw_mci_exynos_parse_dt(struct dw_mci *host)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static inline u8 dw_mci_exynos_get_clksmpl(struct dw_mci *host)
|
||||||
|
{
|
||||||
|
return SDMMC_CLKSEL_CCLK_SAMPLE(mci_readl(host, CLKSEL));
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void dw_mci_exynos_set_clksmpl(struct dw_mci *host, u8 sample)
|
||||||
|
{
|
||||||
|
u32 clksel;
|
||||||
|
clksel = mci_readl(host, CLKSEL);
|
||||||
|
clksel = (clksel & ~0x7) | SDMMC_CLKSEL_CCLK_SAMPLE(sample);
|
||||||
|
mci_writel(host, CLKSEL, clksel);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline u8 dw_mci_exynos_move_next_clksmpl(struct dw_mci *host)
|
||||||
|
{
|
||||||
|
u32 clksel;
|
||||||
|
u8 sample;
|
||||||
|
|
||||||
|
clksel = mci_readl(host, CLKSEL);
|
||||||
|
sample = (clksel + 1) & 0x7;
|
||||||
|
clksel = (clksel & ~0x7) | sample;
|
||||||
|
mci_writel(host, CLKSEL, clksel);
|
||||||
|
return sample;
|
||||||
|
}
|
||||||
|
|
||||||
|
static s8 dw_mci_exynos_get_best_clksmpl(u8 candiates)
|
||||||
|
{
|
||||||
|
const u8 iter = 8;
|
||||||
|
u8 __c;
|
||||||
|
s8 i, loc = -1;
|
||||||
|
|
||||||
|
for (i = 0; i < iter; i++) {
|
||||||
|
__c = ror8(candiates, i);
|
||||||
|
if ((__c & 0xc7) == 0xc7) {
|
||||||
|
loc = i;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < iter; i++) {
|
||||||
|
__c = ror8(candiates, i);
|
||||||
|
if ((__c & 0x83) == 0x83) {
|
||||||
|
loc = i;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
out:
|
||||||
|
return loc;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dw_mci_exynos_execute_tuning(struct dw_mci_slot *slot, u32 opcode,
|
||||||
|
struct dw_mci_tuning_data *tuning_data)
|
||||||
|
{
|
||||||
|
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 (!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);
|
||||||
|
if (found >= 0)
|
||||||
|
dw_mci_exynos_set_clksmpl(host, found);
|
||||||
|
else
|
||||||
|
ret = -EIO;
|
||||||
|
|
||||||
|
kfree(blk_test);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
/* Common capabilities of Exynos4/Exynos5 SoC */
|
/* Common capabilities of Exynos4/Exynos5 SoC */
|
||||||
static unsigned long exynos_dwmmc_caps[4] = {
|
static unsigned long exynos_dwmmc_caps[4] = {
|
||||||
MMC_CAP_UHS_DDR50 | MMC_CAP_1_8V_DDR |
|
MMC_CAP_UHS_DDR50 | MMC_CAP_1_8V_DDR |
|
||||||
|
@ -247,6 +370,7 @@ static const struct dw_mci_drv_data exynos_drv_data = {
|
||||||
.prepare_command = dw_mci_exynos_prepare_command,
|
.prepare_command = dw_mci_exynos_prepare_command,
|
||||||
.set_ios = dw_mci_exynos_set_ios,
|
.set_ios = dw_mci_exynos_set_ios,
|
||||||
.parse_dt = dw_mci_exynos_parse_dt,
|
.parse_dt = dw_mci_exynos_parse_dt,
|
||||||
|
.execute_tuning = dw_mci_exynos_execute_tuning,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct of_device_id dw_mci_exynos_match[] = {
|
static const struct of_device_id dw_mci_exynos_match[] = {
|
||||||
|
|
Loading…
Reference in a new issue