| // SPDX-License-Identifier: GPL-2.0 | |
| // | |
| // Copyright (C) 2017-2018 Socionext Inc. | |
| // Author: Masahiro Yamada <yamada.masahiro@socionext.com> | |
| #include <linux/bitfield.h> | |
| #include <linux/bitops.h> | |
| #include <linux/clk.h> | |
| #include <linux/delay.h> | |
| #include <linux/dma-mapping.h> | |
| #include <linux/mfd/syscon.h> | |
| #include <linux/mmc/host.h> | |
| #include <linux/module.h> | |
| #include <linux/of.h> | |
| #include <linux/pinctrl/consumer.h> | |
| #include <linux/platform_data/tmio.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/regmap.h> | |
| #include <linux/reset.h> | |
| #include "tmio_mmc.h" | |
| #define UNIPHIER_SD_CLK_CTL_DIV1024 BIT(16) | |
| #define UNIPHIER_SD_CLK_CTL_DIV1 BIT(10) | |
| #define UNIPHIER_SD_CLKCTL_OFFEN BIT(9) // auto SDCLK stop | |
| #define UNIPHIER_SD_CC_EXT_MODE 0x1b0 | |
| #define UNIPHIER_SD_CC_EXT_MODE_DMA BIT(1) | |
| #define UNIPHIER_SD_HOST_MODE 0x1c8 | |
| #define UNIPHIER_SD_VOLT 0x1e4 | |
| #define UNIPHIER_SD_VOLT_MASK GENMASK(1, 0) | |
| #define UNIPHIER_SD_VOLT_OFF 0 | |
| #define UNIPHIER_SD_VOLT_330 1 // 3.3V signal | |
| #define UNIPHIER_SD_VOLT_180 2 // 1.8V signal | |
| #define UNIPHIER_SD_DMA_MODE 0x410 | |
| #define UNIPHIER_SD_DMA_MODE_DIR_MASK GENMASK(17, 16) | |
| #define UNIPHIER_SD_DMA_MODE_DIR_TO_DEV 0 | |
| #define UNIPHIER_SD_DMA_MODE_DIR_FROM_DEV 1 | |
| #define UNIPHIER_SD_DMA_MODE_WIDTH_MASK GENMASK(5, 4) | |
| #define UNIPHIER_SD_DMA_MODE_WIDTH_8 0 | |
| #define UNIPHIER_SD_DMA_MODE_WIDTH_16 1 | |
| #define UNIPHIER_SD_DMA_MODE_WIDTH_32 2 | |
| #define UNIPHIER_SD_DMA_MODE_WIDTH_64 3 | |
| #define UNIPHIER_SD_DMA_MODE_ADDR_INC BIT(0) // 1: inc, 0: fixed | |
| #define UNIPHIER_SD_DMA_CTL 0x414 | |
| #define UNIPHIER_SD_DMA_CTL_START BIT(0) // start DMA (auto cleared) | |
| #define UNIPHIER_SD_DMA_RST 0x418 | |
| #define UNIPHIER_SD_DMA_RST_CH1 BIT(9) | |
| #define UNIPHIER_SD_DMA_RST_CH0 BIT(8) | |
| #define UNIPHIER_SD_DMA_ADDR_L 0x440 | |
| #define UNIPHIER_SD_DMA_ADDR_H 0x444 | |
| /* SD control */ | |
| #define UNIPHIER_SDCTRL_CHOFFSET 0x200 | |
| #define UNIPHIER_SDCTRL_MODE 0x30 | |
| #define UNIPHIER_SDCTRL_MODE_UHS1MOD BIT(15) | |
| #define UNIPHIER_SDCTRL_MODE_SDRSEL BIT(14) | |
| /* | |
| * IP is extended to support various features: built-in DMA engine, | |
| * 1/1024 divisor, etc. | |
| */ | |
| #define UNIPHIER_SD_CAP_EXTENDED_IP BIT(0) | |
| /* RX channel of the built-in DMA controller is broken (Pro5) */ | |
| #define UNIPHIER_SD_CAP_BROKEN_DMA_RX BIT(1) | |
| struct uniphier_sd_priv { | |
| struct tmio_mmc_data tmio_data; | |
| struct pinctrl *pinctrl; | |
| struct pinctrl_state *pinstate_uhs; | |
| struct clk *clk; | |
| struct reset_control *rst; | |
| struct reset_control *rst_br; | |
| struct reset_control *rst_hw; | |
| struct dma_chan *chan; | |
| enum dma_data_direction dma_dir; | |
| struct regmap *sdctrl_regmap; | |
| u32 sdctrl_ch; | |
| unsigned long clk_rate; | |
| unsigned long caps; | |
| }; | |
| static void *uniphier_sd_priv(struct tmio_mmc_host *host) | |
| { | |
| return container_of(host->pdata, struct uniphier_sd_priv, tmio_data); | |
| } | |
| static void uniphier_sd_dma_endisable(struct tmio_mmc_host *host, int enable) | |
| { | |
| sd_ctrl_write16(host, CTL_DMA_ENABLE, enable ? DMA_ENABLE_DMASDRW : 0); | |
| } | |
| /* external DMA engine */ | |
| static void uniphier_sd_external_dma_issue(struct work_struct *t) | |
| { | |
| struct tmio_mmc_host *host = from_work(host, t, dma_issue); | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| uniphier_sd_dma_endisable(host, 1); | |
| dma_async_issue_pending(priv->chan); | |
| } | |
| static void uniphier_sd_external_dma_callback(void *param, | |
| const struct dmaengine_result *result) | |
| { | |
| struct tmio_mmc_host *host = param; | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| unsigned long flags; | |
| dma_unmap_sg(mmc_dev(host->mmc), host->sg_ptr, host->sg_len, | |
| priv->dma_dir); | |
| spin_lock_irqsave(&host->lock, flags); | |
| if (result->result == DMA_TRANS_NOERROR) { | |
| /* | |
| * When the external DMA engine is enabled, strangely enough, | |
| * the DATAEND flag can be asserted even if the DMA engine has | |
| * not been kicked yet. Enable the TMIO_STAT_DATAEND irq only | |
| * after we make sure the DMA engine finishes the transfer, | |
| * hence, in this callback. | |
| */ | |
| tmio_mmc_enable_mmc_irqs(host, TMIO_STAT_DATAEND); | |
| } else { | |
| host->data->error = -ETIMEDOUT; | |
| tmio_mmc_do_data_irq(host); | |
| } | |
| spin_unlock_irqrestore(&host->lock, flags); | |
| } | |
| static void uniphier_sd_external_dma_start(struct tmio_mmc_host *host, | |
| struct mmc_data *data) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| enum dma_transfer_direction dma_tx_dir; | |
| struct dma_async_tx_descriptor *desc; | |
| dma_cookie_t cookie; | |
| int sg_len; | |
| if (!priv->chan) | |
| goto force_pio; | |
| if (data->flags & MMC_DATA_READ) { | |
| priv->dma_dir = DMA_FROM_DEVICE; | |
| dma_tx_dir = DMA_DEV_TO_MEM; | |
| } else { | |
| priv->dma_dir = DMA_TO_DEVICE; | |
| dma_tx_dir = DMA_MEM_TO_DEV; | |
| } | |
| sg_len = dma_map_sg(mmc_dev(host->mmc), host->sg_ptr, host->sg_len, | |
| priv->dma_dir); | |
| if (sg_len == 0) | |
| goto force_pio; | |
| desc = dmaengine_prep_slave_sg(priv->chan, host->sg_ptr, sg_len, | |
| dma_tx_dir, DMA_CTRL_ACK); | |
| if (!desc) | |
| goto unmap_sg; | |
| desc->callback_result = uniphier_sd_external_dma_callback; | |
| desc->callback_param = host; | |
| cookie = dmaengine_submit(desc); | |
| if (cookie < 0) | |
| goto unmap_sg; | |
| host->dma_on = true; | |
| return; | |
| unmap_sg: | |
| dma_unmap_sg(mmc_dev(host->mmc), host->sg_ptr, host->sg_len, | |
| priv->dma_dir); | |
| force_pio: | |
| uniphier_sd_dma_endisable(host, 0); | |
| } | |
| static void uniphier_sd_external_dma_enable(struct tmio_mmc_host *host, | |
| bool enable) | |
| { | |
| } | |
| static void uniphier_sd_external_dma_request(struct tmio_mmc_host *host, | |
| struct tmio_mmc_data *pdata) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| struct dma_chan *chan; | |
| chan = dma_request_chan(mmc_dev(host->mmc), "rx-tx"); | |
| if (IS_ERR(chan)) { | |
| dev_warn(mmc_dev(host->mmc), | |
| "failed to request DMA channel. falling back to PIO\n"); | |
| return; /* just use PIO even for -EPROBE_DEFER */ | |
| } | |
| /* this driver uses a single channel for both RX an TX */ | |
| priv->chan = chan; | |
| host->chan_rx = chan; | |
| host->chan_tx = chan; | |
| INIT_WORK(&host->dma_issue, uniphier_sd_external_dma_issue); | |
| } | |
| static void uniphier_sd_external_dma_release(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| if (priv->chan) | |
| dma_release_channel(priv->chan); | |
| } | |
| static void uniphier_sd_external_dma_abort(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| uniphier_sd_dma_endisable(host, 0); | |
| if (priv->chan) | |
| dmaengine_terminate_sync(priv->chan); | |
| } | |
| static void uniphier_sd_external_dma_dataend(struct tmio_mmc_host *host) | |
| { | |
| uniphier_sd_dma_endisable(host, 0); | |
| tmio_mmc_do_data_irq(host); | |
| } | |
| static const struct tmio_mmc_dma_ops uniphier_sd_external_dma_ops = { | |
| .start = uniphier_sd_external_dma_start, | |
| .enable = uniphier_sd_external_dma_enable, | |
| .request = uniphier_sd_external_dma_request, | |
| .release = uniphier_sd_external_dma_release, | |
| .abort = uniphier_sd_external_dma_abort, | |
| .dataend = uniphier_sd_external_dma_dataend, | |
| }; | |
| static void uniphier_sd_internal_dma_issue(struct work_struct *t) | |
| { | |
| struct tmio_mmc_host *host = from_work(host, t, dma_issue); | |
| unsigned long flags; | |
| spin_lock_irqsave(&host->lock, flags); | |
| tmio_mmc_enable_mmc_irqs(host, TMIO_STAT_DATAEND); | |
| spin_unlock_irqrestore(&host->lock, flags); | |
| uniphier_sd_dma_endisable(host, 1); | |
| writel(UNIPHIER_SD_DMA_CTL_START, host->ctl + UNIPHIER_SD_DMA_CTL); | |
| } | |
| static void uniphier_sd_internal_dma_start(struct tmio_mmc_host *host, | |
| struct mmc_data *data) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| struct scatterlist *sg = host->sg_ptr; | |
| dma_addr_t dma_addr; | |
| unsigned int dma_mode_dir; | |
| u32 dma_mode; | |
| int sg_len; | |
| if ((data->flags & MMC_DATA_READ) && !host->chan_rx) | |
| goto force_pio; | |
| if (WARN_ON(host->sg_len != 1)) | |
| goto force_pio; | |
| if (!IS_ALIGNED(sg->offset, 8)) | |
| goto force_pio; | |
| if (data->flags & MMC_DATA_READ) { | |
| priv->dma_dir = DMA_FROM_DEVICE; | |
| dma_mode_dir = UNIPHIER_SD_DMA_MODE_DIR_FROM_DEV; | |
| } else { | |
| priv->dma_dir = DMA_TO_DEVICE; | |
| dma_mode_dir = UNIPHIER_SD_DMA_MODE_DIR_TO_DEV; | |
| } | |
| sg_len = dma_map_sg(mmc_dev(host->mmc), sg, 1, priv->dma_dir); | |
| if (sg_len == 0) | |
| goto force_pio; | |
| dma_mode = FIELD_PREP(UNIPHIER_SD_DMA_MODE_DIR_MASK, dma_mode_dir); | |
| dma_mode |= FIELD_PREP(UNIPHIER_SD_DMA_MODE_WIDTH_MASK, | |
| UNIPHIER_SD_DMA_MODE_WIDTH_64); | |
| dma_mode |= UNIPHIER_SD_DMA_MODE_ADDR_INC; | |
| writel(dma_mode, host->ctl + UNIPHIER_SD_DMA_MODE); | |
| dma_addr = sg_dma_address(data->sg); | |
| writel(lower_32_bits(dma_addr), host->ctl + UNIPHIER_SD_DMA_ADDR_L); | |
| writel(upper_32_bits(dma_addr), host->ctl + UNIPHIER_SD_DMA_ADDR_H); | |
| host->dma_on = true; | |
| return; | |
| force_pio: | |
| uniphier_sd_dma_endisable(host, 0); | |
| } | |
| static void uniphier_sd_internal_dma_enable(struct tmio_mmc_host *host, | |
| bool enable) | |
| { | |
| } | |
| static void uniphier_sd_internal_dma_request(struct tmio_mmc_host *host, | |
| struct tmio_mmc_data *pdata) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| /* | |
| * Due to a hardware bug, Pro5 cannot use DMA for RX. | |
| * We can still use DMA for TX, but PIO for RX. | |
| */ | |
| if (!(priv->caps & UNIPHIER_SD_CAP_BROKEN_DMA_RX)) | |
| host->chan_rx = (void *)0xdeadbeaf; | |
| host->chan_tx = (void *)0xdeadbeaf; | |
| INIT_WORK(&host->dma_issue, uniphier_sd_internal_dma_issue); | |
| } | |
| static void uniphier_sd_internal_dma_release(struct tmio_mmc_host *host) | |
| { | |
| /* Each value is set to zero to assume "disabling" each DMA */ | |
| host->chan_rx = NULL; | |
| host->chan_tx = NULL; | |
| } | |
| static void uniphier_sd_internal_dma_abort(struct tmio_mmc_host *host) | |
| { | |
| u32 tmp; | |
| uniphier_sd_dma_endisable(host, 0); | |
| tmp = readl(host->ctl + UNIPHIER_SD_DMA_RST); | |
| tmp &= ~(UNIPHIER_SD_DMA_RST_CH1 | UNIPHIER_SD_DMA_RST_CH0); | |
| writel(tmp, host->ctl + UNIPHIER_SD_DMA_RST); | |
| tmp |= UNIPHIER_SD_DMA_RST_CH1 | UNIPHIER_SD_DMA_RST_CH0; | |
| writel(tmp, host->ctl + UNIPHIER_SD_DMA_RST); | |
| } | |
| static void uniphier_sd_internal_dma_dataend(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| uniphier_sd_dma_endisable(host, 0); | |
| dma_unmap_sg(mmc_dev(host->mmc), host->sg_ptr, 1, priv->dma_dir); | |
| tmio_mmc_do_data_irq(host); | |
| } | |
| static const struct tmio_mmc_dma_ops uniphier_sd_internal_dma_ops = { | |
| .start = uniphier_sd_internal_dma_start, | |
| .enable = uniphier_sd_internal_dma_enable, | |
| .request = uniphier_sd_internal_dma_request, | |
| .release = uniphier_sd_internal_dma_release, | |
| .abort = uniphier_sd_internal_dma_abort, | |
| .dataend = uniphier_sd_internal_dma_dataend, | |
| }; | |
| static int uniphier_sd_clk_enable(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| struct mmc_host *mmc = host->mmc; | |
| int ret; | |
| ret = clk_prepare_enable(priv->clk); | |
| if (ret) | |
| return ret; | |
| ret = clk_set_rate(priv->clk, ULONG_MAX); | |
| if (ret) | |
| goto disable_clk; | |
| priv->clk_rate = clk_get_rate(priv->clk); | |
| /* If max-frequency property is set, use it. */ | |
| if (!mmc->f_max) | |
| mmc->f_max = priv->clk_rate; | |
| /* | |
| * 1/512 is the finest divisor in the original IP. Newer versions | |
| * also supports 1/1024 divisor. (UniPhier-specific extension) | |
| */ | |
| if (priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP) | |
| mmc->f_min = priv->clk_rate / 1024; | |
| else | |
| mmc->f_min = priv->clk_rate / 512; | |
| ret = reset_control_deassert(priv->rst); | |
| if (ret) | |
| goto disable_clk; | |
| ret = reset_control_deassert(priv->rst_br); | |
| if (ret) | |
| goto assert_rst; | |
| return 0; | |
| assert_rst: | |
| reset_control_assert(priv->rst); | |
| disable_clk: | |
| clk_disable_unprepare(priv->clk); | |
| return ret; | |
| } | |
| static void uniphier_sd_clk_disable(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| reset_control_assert(priv->rst_br); | |
| reset_control_assert(priv->rst); | |
| clk_disable_unprepare(priv->clk); | |
| } | |
| static void uniphier_sd_hw_reset(struct mmc_host *mmc) | |
| { | |
| struct tmio_mmc_host *host = mmc_priv(mmc); | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| reset_control_assert(priv->rst_hw); | |
| /* For eMMC, minimum is 1us but give it 9us for good measure */ | |
| udelay(9); | |
| reset_control_deassert(priv->rst_hw); | |
| /* For eMMC, minimum is 200us but give it 300us for good measure */ | |
| usleep_range(300, 1000); | |
| } | |
| static void uniphier_sd_speed_switch(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| unsigned int offset; | |
| u32 val = 0; | |
| if (!(host->mmc->caps & MMC_CAP_UHS)) | |
| return; | |
| if (host->mmc->ios.timing == MMC_TIMING_UHS_SDR50 || | |
| host->mmc->ios.timing == MMC_TIMING_UHS_SDR104) | |
| val = UNIPHIER_SDCTRL_MODE_SDRSEL; | |
| offset = UNIPHIER_SDCTRL_CHOFFSET * priv->sdctrl_ch | |
| + UNIPHIER_SDCTRL_MODE; | |
| regmap_write_bits(priv->sdctrl_regmap, offset, | |
| UNIPHIER_SDCTRL_MODE_SDRSEL, val); | |
| } | |
| static void uniphier_sd_uhs_enable(struct tmio_mmc_host *host, bool uhs_en) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| unsigned int offset; | |
| u32 val; | |
| if (!(host->mmc->caps & MMC_CAP_UHS)) | |
| return; | |
| val = (uhs_en) ? UNIPHIER_SDCTRL_MODE_UHS1MOD : 0; | |
| offset = UNIPHIER_SDCTRL_CHOFFSET * priv->sdctrl_ch | |
| + UNIPHIER_SDCTRL_MODE; | |
| regmap_write_bits(priv->sdctrl_regmap, offset, | |
| UNIPHIER_SDCTRL_MODE_UHS1MOD, val); | |
| } | |
| static void uniphier_sd_set_clock(struct tmio_mmc_host *host, | |
| unsigned int clock) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| unsigned long divisor; | |
| u32 tmp; | |
| tmp = readl(host->ctl + (CTL_SD_CARD_CLK_CTL << 1)); | |
| /* stop the clock before changing its rate to avoid a glitch signal */ | |
| tmp &= ~CLK_CTL_SCLKEN; | |
| writel(tmp, host->ctl + (CTL_SD_CARD_CLK_CTL << 1)); | |
| uniphier_sd_speed_switch(host); | |
| if (clock == 0) | |
| return; | |
| tmp &= ~UNIPHIER_SD_CLK_CTL_DIV1024; | |
| tmp &= ~UNIPHIER_SD_CLK_CTL_DIV1; | |
| tmp &= ~CLK_CTL_DIV_MASK; | |
| divisor = priv->clk_rate / clock; | |
| /* | |
| * In the original IP, bit[7:0] represents the divisor. | |
| * bit7 set: 1/512, ... bit0 set:1/4, all bits clear: 1/2 | |
| * | |
| * The IP does not define a way to achieve 1/1. For UniPhier variants, | |
| * bit10 is used for 1/1. Newer versions of UniPhier variants use | |
| * bit16 for 1/1024. | |
| */ | |
| if (divisor <= 1) | |
| tmp |= UNIPHIER_SD_CLK_CTL_DIV1; | |
| else if (priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP && divisor > 512) | |
| tmp |= UNIPHIER_SD_CLK_CTL_DIV1024; | |
| else | |
| tmp |= roundup_pow_of_two(divisor) >> 2; | |
| writel(tmp, host->ctl + (CTL_SD_CARD_CLK_CTL << 1)); | |
| tmp |= CLK_CTL_SCLKEN; | |
| writel(tmp, host->ctl + (CTL_SD_CARD_CLK_CTL << 1)); | |
| } | |
| static void uniphier_sd_host_init(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| u32 val; | |
| /* | |
| * Connected to 32bit AXI. | |
| * This register holds settings for SoC-specific internal bus | |
| * connection. What is worse, the register spec was changed, | |
| * breaking the backward compatibility. Write an appropriate | |
| * value depending on a flag associated with a compatible string. | |
| */ | |
| if (priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP) | |
| val = 0x00000101; | |
| else | |
| val = 0x00000000; | |
| writel(val, host->ctl + UNIPHIER_SD_HOST_MODE); | |
| val = 0; | |
| /* | |
| * If supported, the controller can automatically | |
| * enable/disable the clock line to the card. | |
| */ | |
| if (priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP) | |
| val |= UNIPHIER_SD_CLKCTL_OFFEN; | |
| writel(val, host->ctl + (CTL_SD_CARD_CLK_CTL << 1)); | |
| } | |
| static int uniphier_sd_start_signal_voltage_switch(struct mmc_host *mmc, | |
| struct mmc_ios *ios) | |
| { | |
| struct tmio_mmc_host *host = mmc_priv(mmc); | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| struct pinctrl_state *pinstate = NULL; | |
| u32 val, tmp; | |
| bool uhs_en; | |
| switch (ios->signal_voltage) { | |
| case MMC_SIGNAL_VOLTAGE_330: | |
| val = UNIPHIER_SD_VOLT_330; | |
| uhs_en = false; | |
| break; | |
| case MMC_SIGNAL_VOLTAGE_180: | |
| val = UNIPHIER_SD_VOLT_180; | |
| pinstate = priv->pinstate_uhs; | |
| uhs_en = true; | |
| break; | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| tmp = readl(host->ctl + UNIPHIER_SD_VOLT); | |
| tmp &= ~UNIPHIER_SD_VOLT_MASK; | |
| tmp |= FIELD_PREP(UNIPHIER_SD_VOLT_MASK, val); | |
| writel(tmp, host->ctl + UNIPHIER_SD_VOLT); | |
| if (pinstate) | |
| pinctrl_select_state(priv->pinctrl, pinstate); | |
| else | |
| pinctrl_select_default_state(mmc_dev(mmc)); | |
| uniphier_sd_uhs_enable(host, uhs_en); | |
| return 0; | |
| } | |
| static int uniphier_sd_uhs_init(struct tmio_mmc_host *host) | |
| { | |
| struct uniphier_sd_priv *priv = uniphier_sd_priv(host); | |
| struct device *dev = &host->pdev->dev; | |
| struct device_node *np = dev->of_node; | |
| struct of_phandle_args args; | |
| int ret; | |
| priv->pinctrl = devm_pinctrl_get(mmc_dev(host->mmc)); | |
| if (IS_ERR(priv->pinctrl)) | |
| return PTR_ERR(priv->pinctrl); | |
| priv->pinstate_uhs = pinctrl_lookup_state(priv->pinctrl, "uhs"); | |
| if (IS_ERR(priv->pinstate_uhs)) | |
| return PTR_ERR(priv->pinstate_uhs); | |
| ret = of_parse_phandle_with_fixed_args(np, | |
| "socionext,syscon-uhs-mode", | |
| 1, 0, &args); | |
| if (ret) { | |
| dev_err(dev, "Can't get syscon-uhs-mode property\n"); | |
| return ret; | |
| } | |
| priv->sdctrl_regmap = syscon_node_to_regmap(args.np); | |
| of_node_put(args.np); | |
| if (IS_ERR(priv->sdctrl_regmap)) { | |
| dev_err(dev, "Can't map syscon-uhs-mode\n"); | |
| return PTR_ERR(priv->sdctrl_regmap); | |
| } | |
| priv->sdctrl_ch = args.args[0]; | |
| return 0; | |
| } | |
| static int uniphier_sd_probe(struct platform_device *pdev) | |
| { | |
| struct device *dev = &pdev->dev; | |
| struct uniphier_sd_priv *priv; | |
| struct tmio_mmc_data *tmio_data; | |
| struct tmio_mmc_host *host; | |
| int irq, ret; | |
| irq = platform_get_irq(pdev, 0); | |
| if (irq < 0) | |
| return irq; | |
| priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | |
| if (!priv) | |
| return -ENOMEM; | |
| priv->caps = (unsigned long)of_device_get_match_data(dev); | |
| priv->clk = devm_clk_get(dev, NULL); | |
| if (IS_ERR(priv->clk)) { | |
| dev_err(dev, "failed to get clock\n"); | |
| return PTR_ERR(priv->clk); | |
| } | |
| priv->rst = devm_reset_control_get_shared(dev, "host"); | |
| if (IS_ERR(priv->rst)) { | |
| dev_err(dev, "failed to get host reset\n"); | |
| return PTR_ERR(priv->rst); | |
| } | |
| /* old version has one more reset */ | |
| if (!(priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP)) { | |
| priv->rst_br = devm_reset_control_get_shared(dev, "bridge"); | |
| if (IS_ERR(priv->rst_br)) { | |
| dev_err(dev, "failed to get bridge reset\n"); | |
| return PTR_ERR(priv->rst_br); | |
| } | |
| } | |
| tmio_data = &priv->tmio_data; | |
| tmio_data->flags |= TMIO_MMC_32BIT_DATA_PORT; | |
| tmio_data->flags |= TMIO_MMC_USE_BUSY_TIMEOUT; | |
| host = tmio_mmc_host_alloc(pdev, tmio_data); | |
| if (IS_ERR(host)) | |
| return PTR_ERR(host); | |
| if (host->mmc->caps & MMC_CAP_HW_RESET) { | |
| priv->rst_hw = devm_reset_control_get_exclusive(dev, "hw"); | |
| if (IS_ERR(priv->rst_hw)) { | |
| dev_err(dev, "failed to get hw reset\n"); | |
| return PTR_ERR(priv->rst_hw); | |
| } | |
| host->ops.card_hw_reset = uniphier_sd_hw_reset; | |
| } | |
| if (host->mmc->caps & MMC_CAP_UHS) { | |
| ret = uniphier_sd_uhs_init(host); | |
| if (ret) { | |
| dev_warn(dev, | |
| "failed to setup UHS (error %d). Disabling UHS.", | |
| ret); | |
| host->mmc->caps &= ~MMC_CAP_UHS; | |
| } else { | |
| host->ops.start_signal_voltage_switch = | |
| uniphier_sd_start_signal_voltage_switch; | |
| } | |
| } | |
| if (priv->caps & UNIPHIER_SD_CAP_EXTENDED_IP) | |
| host->dma_ops = &uniphier_sd_internal_dma_ops; | |
| else | |
| host->dma_ops = &uniphier_sd_external_dma_ops; | |
| host->bus_shift = 1; | |
| host->clk_enable = uniphier_sd_clk_enable; | |
| host->clk_disable = uniphier_sd_clk_disable; | |
| host->set_clock = uniphier_sd_set_clock; | |
| ret = uniphier_sd_clk_enable(host); | |
| if (ret) | |
| return ret; | |
| uniphier_sd_host_init(host); | |
| tmio_data->ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34; | |
| if (host->mmc->caps & MMC_CAP_UHS) | |
| tmio_data->ocr_mask |= MMC_VDD_165_195; | |
| tmio_data->max_segs = 1; | |
| tmio_data->max_blk_count = U16_MAX; | |
| sd_ctrl_write32_as_16_and_16(host, CTL_IRQ_MASK, TMIO_MASK_ALL); | |
| ret = devm_request_irq(dev, irq, tmio_mmc_irq, IRQF_SHARED, | |
| dev_name(dev), host); | |
| if (ret) | |
| goto disable_clk; | |
| ret = tmio_mmc_host_probe(host); | |
| if (ret) | |
| goto disable_clk; | |
| return 0; | |
| disable_clk: | |
| uniphier_sd_clk_disable(host); | |
| return ret; | |
| } | |
| static void uniphier_sd_remove(struct platform_device *pdev) | |
| { | |
| struct tmio_mmc_host *host = platform_get_drvdata(pdev); | |
| tmio_mmc_host_remove(host); | |
| uniphier_sd_clk_disable(host); | |
| } | |
| static const struct of_device_id uniphier_sd_match[] = { | |
| { | |
| .compatible = "socionext,uniphier-sd-v2.91", | |
| }, | |
| { | |
| .compatible = "socionext,uniphier-sd-v3.1", | |
| .data = (void *)(UNIPHIER_SD_CAP_EXTENDED_IP | | |
| UNIPHIER_SD_CAP_BROKEN_DMA_RX), | |
| }, | |
| { | |
| .compatible = "socionext,uniphier-sd-v3.1.1", | |
| .data = (void *)UNIPHIER_SD_CAP_EXTENDED_IP, | |
| }, | |
| { /* sentinel */ } | |
| }; | |
| MODULE_DEVICE_TABLE(of, uniphier_sd_match); | |
| static struct platform_driver uniphier_sd_driver = { | |
| .probe = uniphier_sd_probe, | |
| .remove = uniphier_sd_remove, | |
| .driver = { | |
| .name = "uniphier-sd", | |
| .probe_type = PROBE_PREFER_ASYNCHRONOUS, | |
| .of_match_table = uniphier_sd_match, | |
| }, | |
| }; | |
| module_platform_driver(uniphier_sd_driver); | |
| MODULE_AUTHOR("Masahiro Yamada <yamada.masahiro@socionext.com>"); | |
| MODULE_DESCRIPTION("UniPhier SD/eMMC host controller driver"); | |
| MODULE_LICENSE("GPL v2"); |