![Guennadi Liakhovetski](/assets/img/avatar_default.png)
Use managed allocations to get memory, clock and interrupts . This significantly simplifies clean up paths. Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de> Signed-off-by: Chris Ball <cjb@laptop.org>
326 lines
8 KiB
C
326 lines
8 KiB
C
/*
|
|
* SuperH Mobile SDHI
|
|
*
|
|
* Copyright (C) 2009 Magnus Damm
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* Based on "Compaq ASIC3 support":
|
|
*
|
|
* Copyright 2001 Compaq Computer Corporation.
|
|
* Copyright 2004-2005 Phil Blundell
|
|
* Copyright 2007-2008 OpenedHand Ltd.
|
|
*
|
|
* Authors: Phil Blundell <pb@handhelds.org>,
|
|
* Samuel Ortiz <sameo@openedhand.com>
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/mod_devicetable.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mmc/host.h>
|
|
#include <linux/mmc/sh_mobile_sdhi.h>
|
|
#include <linux/mfd/tmio.h>
|
|
#include <linux/sh_dma.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include "tmio_mmc.h"
|
|
|
|
struct sh_mobile_sdhi_of_data {
|
|
unsigned long tmio_flags;
|
|
};
|
|
|
|
static const struct sh_mobile_sdhi_of_data sh_mobile_sdhi_of_cfg[] = {
|
|
{
|
|
.tmio_flags = TMIO_MMC_HAS_IDLE_WAIT,
|
|
},
|
|
};
|
|
|
|
struct sh_mobile_sdhi {
|
|
struct clk *clk;
|
|
struct tmio_mmc_data mmc_data;
|
|
struct sh_dmae_slave param_tx;
|
|
struct sh_dmae_slave param_rx;
|
|
struct tmio_mmc_dma dma_priv;
|
|
};
|
|
|
|
static int sh_mobile_sdhi_clk_enable(struct platform_device *pdev, unsigned int *f)
|
|
{
|
|
struct mmc_host *mmc = dev_get_drvdata(&pdev->dev);
|
|
struct tmio_mmc_host *host = mmc_priv(mmc);
|
|
struct sh_mobile_sdhi *priv = container_of(host->pdata, struct sh_mobile_sdhi, mmc_data);
|
|
int ret = clk_enable(priv->clk);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
*f = clk_get_rate(priv->clk);
|
|
return 0;
|
|
}
|
|
|
|
static void sh_mobile_sdhi_clk_disable(struct platform_device *pdev)
|
|
{
|
|
struct mmc_host *mmc = dev_get_drvdata(&pdev->dev);
|
|
struct tmio_mmc_host *host = mmc_priv(mmc);
|
|
struct sh_mobile_sdhi *priv = container_of(host->pdata, struct sh_mobile_sdhi, mmc_data);
|
|
clk_disable(priv->clk);
|
|
}
|
|
|
|
static void sh_mobile_sdhi_set_pwr(struct platform_device *pdev, int state)
|
|
{
|
|
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
|
|
|
p->set_pwr(pdev, state);
|
|
}
|
|
|
|
static int sh_mobile_sdhi_get_cd(struct platform_device *pdev)
|
|
{
|
|
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
|
|
|
return p->get_cd(pdev);
|
|
}
|
|
|
|
static int sh_mobile_sdhi_wait_idle(struct tmio_mmc_host *host)
|
|
{
|
|
int timeout = 1000;
|
|
|
|
while (--timeout && !(sd_ctrl_read16(host, CTL_STATUS2) & (1 << 13)))
|
|
udelay(1);
|
|
|
|
if (!timeout) {
|
|
dev_warn(host->pdata->dev, "timeout waiting for SD bus idle\n");
|
|
return -EBUSY;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sh_mobile_sdhi_write16_hook(struct tmio_mmc_host *host, int addr)
|
|
{
|
|
switch (addr)
|
|
{
|
|
case CTL_SD_CMD:
|
|
case CTL_STOP_INTERNAL_ACTION:
|
|
case CTL_XFER_BLK_COUNT:
|
|
case CTL_SD_CARD_CLK_CTL:
|
|
case CTL_SD_XFER_LEN:
|
|
case CTL_SD_MEM_CARD_OPT:
|
|
case CTL_TRANSACTION_CTL:
|
|
case CTL_DMA_ENABLE:
|
|
return sh_mobile_sdhi_wait_idle(host);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sh_mobile_sdhi_cd_wakeup(const struct platform_device *pdev)
|
|
{
|
|
mmc_detect_change(dev_get_drvdata(&pdev->dev), msecs_to_jiffies(100));
|
|
}
|
|
|
|
static const struct sh_mobile_sdhi_ops sdhi_ops = {
|
|
.cd_wakeup = sh_mobile_sdhi_cd_wakeup,
|
|
};
|
|
|
|
static const struct of_device_id sh_mobile_sdhi_of_match[] = {
|
|
{ .compatible = "renesas,shmobile-sdhi" },
|
|
{ .compatible = "renesas,sh7372-sdhi" },
|
|
{ .compatible = "renesas,r8a7740-sdhi", .data = &sh_mobile_sdhi_of_cfg[0], },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sh_mobile_sdhi_of_match);
|
|
|
|
static int sh_mobile_sdhi_probe(struct platform_device *pdev)
|
|
{
|
|
const struct of_device_id *of_id =
|
|
of_match_device(sh_mobile_sdhi_of_match, &pdev->dev);
|
|
struct sh_mobile_sdhi *priv;
|
|
struct tmio_mmc_data *mmc_data;
|
|
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
|
struct tmio_mmc_host *host;
|
|
int irq, ret, i = 0;
|
|
bool multiplexed_isr = true;
|
|
|
|
priv = devm_kzalloc(&pdev->dev, sizeof(struct sh_mobile_sdhi), GFP_KERNEL);
|
|
if (priv == NULL) {
|
|
dev_err(&pdev->dev, "kzalloc failed\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
mmc_data = &priv->mmc_data;
|
|
|
|
if (p) {
|
|
if (p->init) {
|
|
ret = p->init(pdev, &sdhi_ops);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
priv->clk = devm_clk_get(&pdev->dev, NULL);
|
|
if (IS_ERR(priv->clk)) {
|
|
ret = PTR_ERR(priv->clk);
|
|
dev_err(&pdev->dev, "cannot get clock: %d\n", ret);
|
|
goto eclkget;
|
|
}
|
|
|
|
mmc_data->clk_enable = sh_mobile_sdhi_clk_enable;
|
|
mmc_data->clk_disable = sh_mobile_sdhi_clk_disable;
|
|
mmc_data->capabilities = MMC_CAP_MMC_HIGHSPEED;
|
|
mmc_data->write16_hook = sh_mobile_sdhi_write16_hook;
|
|
if (p) {
|
|
mmc_data->flags = p->tmio_flags;
|
|
mmc_data->ocr_mask = p->tmio_ocr_mask;
|
|
mmc_data->capabilities |= p->tmio_caps;
|
|
mmc_data->capabilities2 |= p->tmio_caps2;
|
|
mmc_data->cd_gpio = p->cd_gpio;
|
|
if (p->set_pwr)
|
|
mmc_data->set_pwr = sh_mobile_sdhi_set_pwr;
|
|
if (p->get_cd)
|
|
mmc_data->get_cd = sh_mobile_sdhi_get_cd;
|
|
|
|
if (p->dma_slave_tx > 0 && p->dma_slave_rx > 0) {
|
|
priv->param_tx.shdma_slave.slave_id = p->dma_slave_tx;
|
|
priv->param_rx.shdma_slave.slave_id = p->dma_slave_rx;
|
|
priv->dma_priv.chan_priv_tx = &priv->param_tx.shdma_slave;
|
|
priv->dma_priv.chan_priv_rx = &priv->param_rx.shdma_slave;
|
|
priv->dma_priv.alignment_shift = 1; /* 2-byte alignment */
|
|
mmc_data->dma = &priv->dma_priv;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* All SDHI blocks support 2-byte and larger block sizes in 4-bit
|
|
* bus width mode.
|
|
*/
|
|
mmc_data->flags |= TMIO_MMC_BLKSZ_2BYTES;
|
|
|
|
/*
|
|
* All SDHI blocks support SDIO IRQ signalling.
|
|
*/
|
|
mmc_data->flags |= TMIO_MMC_SDIO_IRQ;
|
|
|
|
if (of_id && of_id->data) {
|
|
const struct sh_mobile_sdhi_of_data *of_data = of_id->data;
|
|
mmc_data->flags |= of_data->tmio_flags;
|
|
}
|
|
|
|
ret = tmio_mmc_host_probe(&host, pdev, mmc_data);
|
|
if (ret < 0)
|
|
goto eprobe;
|
|
|
|
/*
|
|
* Allow one or more specific (named) ISRs or
|
|
* one or more multiplexed (un-named) ISRs.
|
|
*/
|
|
|
|
irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_CARD_DETECT);
|
|
if (irq >= 0) {
|
|
multiplexed_isr = false;
|
|
ret = devm_request_irq(&pdev->dev, irq, tmio_mmc_card_detect_irq, 0,
|
|
dev_name(&pdev->dev), host);
|
|
if (ret)
|
|
goto eirq;
|
|
}
|
|
|
|
irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_SDIO);
|
|
if (irq >= 0) {
|
|
multiplexed_isr = false;
|
|
ret = devm_request_irq(&pdev->dev, irq, tmio_mmc_sdio_irq, 0,
|
|
dev_name(&pdev->dev), host);
|
|
if (ret)
|
|
goto eirq;
|
|
}
|
|
|
|
irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_SDCARD);
|
|
if (irq >= 0) {
|
|
multiplexed_isr = false;
|
|
ret = devm_request_irq(&pdev->dev, irq, tmio_mmc_sdcard_irq, 0,
|
|
dev_name(&pdev->dev), host);
|
|
if (ret)
|
|
goto eirq;
|
|
} else if (!multiplexed_isr) {
|
|
dev_err(&pdev->dev,
|
|
"Principal SD-card IRQ is missing among named interrupts\n");
|
|
ret = irq;
|
|
goto eirq;
|
|
}
|
|
|
|
if (multiplexed_isr) {
|
|
while (1) {
|
|
irq = platform_get_irq(pdev, i);
|
|
if (irq < 0)
|
|
break;
|
|
i++;
|
|
ret = devm_request_irq(&pdev->dev, irq, tmio_mmc_irq, 0,
|
|
dev_name(&pdev->dev), host);
|
|
if (ret)
|
|
goto eirq;
|
|
}
|
|
|
|
/* There must be at least one IRQ source */
|
|
if (!i)
|
|
goto eirq;
|
|
}
|
|
|
|
dev_info(&pdev->dev, "%s base at 0x%08lx clock rate %u MHz\n",
|
|
mmc_hostname(host->mmc), (unsigned long)
|
|
(platform_get_resource(pdev, IORESOURCE_MEM, 0)->start),
|
|
host->mmc->f_max / 1000000);
|
|
|
|
return ret;
|
|
|
|
eirq:
|
|
tmio_mmc_host_remove(host);
|
|
eprobe:
|
|
eclkget:
|
|
if (p && p->cleanup)
|
|
p->cleanup(pdev);
|
|
return ret;
|
|
}
|
|
|
|
static int sh_mobile_sdhi_remove(struct platform_device *pdev)
|
|
{
|
|
struct mmc_host *mmc = platform_get_drvdata(pdev);
|
|
struct tmio_mmc_host *host = mmc_priv(mmc);
|
|
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
|
|
|
tmio_mmc_host_remove(host);
|
|
|
|
if (p && p->cleanup)
|
|
p->cleanup(pdev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops tmio_mmc_dev_pm_ops = {
|
|
.suspend = tmio_mmc_host_suspend,
|
|
.resume = tmio_mmc_host_resume,
|
|
.runtime_suspend = tmio_mmc_host_runtime_suspend,
|
|
.runtime_resume = tmio_mmc_host_runtime_resume,
|
|
};
|
|
|
|
static struct platform_driver sh_mobile_sdhi_driver = {
|
|
.driver = {
|
|
.name = "sh_mobile_sdhi",
|
|
.owner = THIS_MODULE,
|
|
.pm = &tmio_mmc_dev_pm_ops,
|
|
.of_match_table = sh_mobile_sdhi_of_match,
|
|
},
|
|
.probe = sh_mobile_sdhi_probe,
|
|
.remove = sh_mobile_sdhi_remove,
|
|
};
|
|
|
|
module_platform_driver(sh_mobile_sdhi_driver);
|
|
|
|
MODULE_DESCRIPTION("SuperH Mobile SDHI driver");
|
|
MODULE_AUTHOR("Magnus Damm");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_ALIAS("platform:sh_mobile_sdhi");
|