mmc: tmio/sdhi: break out interrupt request/free
Move request_irq()/free_irq() from the shared code in tmio_mmc.c into the SDHI/tmio specific portion in sh_mobile_sdhi.c and tmio_mmc_pio.c. This is ground work to allow us to adjust the SDHI code with IRQ flags and number of interupt sources. Signed-off-by: Magnus Damm <damm@opensource.se> Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de> Signed-off-by: Chris Ball <cjb@laptop.org>
This commit is contained in:
@@ -62,7 +62,7 @@ static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)
|
|||||||
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
|
||||||
struct tmio_mmc_host *host;
|
struct tmio_mmc_host *host;
|
||||||
char clk_name[8];
|
char clk_name[8];
|
||||||
int ret;
|
int irq, ret;
|
||||||
|
|
||||||
priv = kzalloc(sizeof(struct sh_mobile_sdhi), GFP_KERNEL);
|
priv = kzalloc(sizeof(struct sh_mobile_sdhi), GFP_KERNEL);
|
||||||
if (priv == NULL) {
|
if (priv == NULL) {
|
||||||
@@ -116,11 +116,24 @@ static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)
|
|||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
goto eprobe;
|
goto eprobe;
|
||||||
|
|
||||||
|
irq = platform_get_irq(pdev, 0);
|
||||||
|
if (irq < 0) {
|
||||||
|
ret = irq;
|
||||||
|
goto eirq;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = request_irq(irq, tmio_mmc_irq, IRQF_DISABLED |
|
||||||
|
IRQF_TRIGGER_FALLING, dev_name(&pdev->dev), host);
|
||||||
|
if (ret)
|
||||||
|
goto eirq;
|
||||||
|
|
||||||
pr_info("%s at 0x%08lx irq %d\n", mmc_hostname(host->mmc),
|
pr_info("%s at 0x%08lx irq %d\n", mmc_hostname(host->mmc),
|
||||||
(unsigned long)host->ctl, host->irq);
|
(unsigned long)host->ctl, irq);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
|
eirq:
|
||||||
|
tmio_mmc_host_remove(host);
|
||||||
eprobe:
|
eprobe:
|
||||||
clk_disable(priv->clk);
|
clk_disable(priv->clk);
|
||||||
clk_put(priv->clk);
|
clk_put(priv->clk);
|
||||||
@@ -135,6 +148,7 @@ static int sh_mobile_sdhi_remove(struct platform_device *pdev)
|
|||||||
struct tmio_mmc_host *host = mmc_priv(mmc);
|
struct tmio_mmc_host *host = mmc_priv(mmc);
|
||||||
struct sh_mobile_sdhi *priv = container_of(host->pdata, struct sh_mobile_sdhi, mmc_data);
|
struct sh_mobile_sdhi *priv = container_of(host->pdata, struct sh_mobile_sdhi, mmc_data);
|
||||||
|
|
||||||
|
free_irq(platform_get_irq(pdev, 0), host);
|
||||||
tmio_mmc_host_remove(host);
|
tmio_mmc_host_remove(host);
|
||||||
clk_disable(priv->clk);
|
clk_disable(priv->clk);
|
||||||
clk_put(priv->clk);
|
clk_put(priv->clk);
|
||||||
|
@@ -64,7 +64,7 @@ static int __devinit tmio_mmc_probe(struct platform_device *pdev)
|
|||||||
const struct mfd_cell *cell = mfd_get_cell(pdev);
|
const struct mfd_cell *cell = mfd_get_cell(pdev);
|
||||||
struct tmio_mmc_data *pdata;
|
struct tmio_mmc_data *pdata;
|
||||||
struct tmio_mmc_host *host;
|
struct tmio_mmc_host *host;
|
||||||
int ret = -EINVAL;
|
int ret = -EINVAL, irq;
|
||||||
|
|
||||||
if (pdev->num_resources != 2)
|
if (pdev->num_resources != 2)
|
||||||
goto out;
|
goto out;
|
||||||
@@ -73,6 +73,12 @@ static int __devinit tmio_mmc_probe(struct platform_device *pdev)
|
|||||||
if (!pdata || !pdata->hclk)
|
if (!pdata || !pdata->hclk)
|
||||||
goto out;
|
goto out;
|
||||||
|
|
||||||
|
irq = platform_get_irq(pdev, 0);
|
||||||
|
if (irq < 0) {
|
||||||
|
ret = irq;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
/* Tell the MFD core we are ready to be enabled */
|
/* Tell the MFD core we are ready to be enabled */
|
||||||
if (cell->enable) {
|
if (cell->enable) {
|
||||||
ret = cell->enable(pdev);
|
ret = cell->enable(pdev);
|
||||||
@@ -84,11 +90,18 @@ static int __devinit tmio_mmc_probe(struct platform_device *pdev)
|
|||||||
if (ret)
|
if (ret)
|
||||||
goto cell_disable;
|
goto cell_disable;
|
||||||
|
|
||||||
|
ret = request_irq(irq, tmio_mmc_irq, IRQF_DISABLED |
|
||||||
|
IRQF_TRIGGER_FALLING, dev_name(&pdev->dev), host);
|
||||||
|
if (ret)
|
||||||
|
goto host_remove;
|
||||||
|
|
||||||
pr_info("%s at 0x%08lx irq %d\n", mmc_hostname(host->mmc),
|
pr_info("%s at 0x%08lx irq %d\n", mmc_hostname(host->mmc),
|
||||||
(unsigned long)host->ctl, host->irq);
|
(unsigned long)host->ctl, irq);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
|
host_remove:
|
||||||
|
tmio_mmc_host_remove(host);
|
||||||
cell_disable:
|
cell_disable:
|
||||||
if (cell->disable)
|
if (cell->disable)
|
||||||
cell->disable(pdev);
|
cell->disable(pdev);
|
||||||
@@ -104,7 +117,9 @@ static int __devexit tmio_mmc_remove(struct platform_device *pdev)
|
|||||||
platform_set_drvdata(pdev, NULL);
|
platform_set_drvdata(pdev, NULL);
|
||||||
|
|
||||||
if (mmc) {
|
if (mmc) {
|
||||||
tmio_mmc_host_remove(mmc_priv(mmc));
|
struct tmio_mmc_host *host = mmc_priv(mmc);
|
||||||
|
free_irq(platform_get_irq(pdev, 0), host);
|
||||||
|
tmio_mmc_host_remove(host);
|
||||||
if (cell->disable)
|
if (cell->disable)
|
||||||
cell->disable(pdev);
|
cell->disable(pdev);
|
||||||
}
|
}
|
||||||
|
@@ -45,7 +45,6 @@ struct tmio_mmc_host {
|
|||||||
struct mmc_request *mrq;
|
struct mmc_request *mrq;
|
||||||
struct mmc_data *data;
|
struct mmc_data *data;
|
||||||
struct mmc_host *mmc;
|
struct mmc_host *mmc;
|
||||||
int irq;
|
|
||||||
unsigned int sdio_irq_enabled;
|
unsigned int sdio_irq_enabled;
|
||||||
|
|
||||||
/* Callbacks for clock / power control */
|
/* Callbacks for clock / power control */
|
||||||
@@ -86,6 +85,7 @@ void tmio_mmc_do_data_irq(struct tmio_mmc_host *host);
|
|||||||
|
|
||||||
void tmio_mmc_enable_mmc_irqs(struct tmio_mmc_host *host, u32 i);
|
void tmio_mmc_enable_mmc_irqs(struct tmio_mmc_host *host, u32 i);
|
||||||
void tmio_mmc_disable_mmc_irqs(struct tmio_mmc_host *host, u32 i);
|
void tmio_mmc_disable_mmc_irqs(struct tmio_mmc_host *host, u32 i);
|
||||||
|
irqreturn_t tmio_mmc_irq(int irq, void *devid);
|
||||||
|
|
||||||
static inline char *tmio_mmc_kmap_atomic(struct scatterlist *sg,
|
static inline char *tmio_mmc_kmap_atomic(struct scatterlist *sg,
|
||||||
unsigned long *flags)
|
unsigned long *flags)
|
||||||
|
@@ -564,7 +564,7 @@ out:
|
|||||||
spin_unlock(&host->lock);
|
spin_unlock(&host->lock);
|
||||||
}
|
}
|
||||||
|
|
||||||
static irqreturn_t tmio_mmc_irq(int irq, void *devid)
|
irqreturn_t tmio_mmc_irq(int irq, void *devid)
|
||||||
{
|
{
|
||||||
struct tmio_mmc_host *host = devid;
|
struct tmio_mmc_host *host = devid;
|
||||||
struct tmio_mmc_data *pdata = host->pdata;
|
struct tmio_mmc_data *pdata = host->pdata;
|
||||||
@@ -659,6 +659,7 @@ static irqreturn_t tmio_mmc_irq(int irq, void *devid)
|
|||||||
out:
|
out:
|
||||||
return IRQ_HANDLED;
|
return IRQ_HANDLED;
|
||||||
}
|
}
|
||||||
|
EXPORT_SYMBOL(tmio_mmc_irq);
|
||||||
|
|
||||||
static int tmio_mmc_start_data(struct tmio_mmc_host *host,
|
static int tmio_mmc_start_data(struct tmio_mmc_host *host,
|
||||||
struct mmc_data *data)
|
struct mmc_data *data)
|
||||||
@@ -893,21 +894,10 @@ int __devinit tmio_mmc_host_probe(struct tmio_mmc_host **host,
|
|||||||
tmio_mmc_clk_stop(_host);
|
tmio_mmc_clk_stop(_host);
|
||||||
tmio_mmc_reset(_host);
|
tmio_mmc_reset(_host);
|
||||||
|
|
||||||
ret = platform_get_irq(pdev, 0);
|
|
||||||
if (ret < 0)
|
|
||||||
goto pm_suspend;
|
|
||||||
|
|
||||||
_host->irq = ret;
|
|
||||||
|
|
||||||
tmio_mmc_disable_mmc_irqs(_host, TMIO_MASK_ALL);
|
tmio_mmc_disable_mmc_irqs(_host, TMIO_MASK_ALL);
|
||||||
if (pdata->flags & TMIO_MMC_SDIO_IRQ)
|
if (pdata->flags & TMIO_MMC_SDIO_IRQ)
|
||||||
tmio_mmc_enable_sdio_irq(mmc, 0);
|
tmio_mmc_enable_sdio_irq(mmc, 0);
|
||||||
|
|
||||||
ret = request_irq(_host->irq, tmio_mmc_irq, IRQF_DISABLED |
|
|
||||||
IRQF_TRIGGER_FALLING, dev_name(&pdev->dev), _host);
|
|
||||||
if (ret)
|
|
||||||
goto pm_suspend;
|
|
||||||
|
|
||||||
spin_lock_init(&_host->lock);
|
spin_lock_init(&_host->lock);
|
||||||
|
|
||||||
/* Init delayed work for request timeouts */
|
/* Init delayed work for request timeouts */
|
||||||
@@ -933,8 +923,6 @@ int __devinit tmio_mmc_host_probe(struct tmio_mmc_host **host,
|
|||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
pm_suspend:
|
|
||||||
pm_runtime_suspend(&pdev->dev);
|
|
||||||
pm_disable:
|
pm_disable:
|
||||||
pm_runtime_disable(&pdev->dev);
|
pm_runtime_disable(&pdev->dev);
|
||||||
iounmap(_host->ctl);
|
iounmap(_host->ctl);
|
||||||
@@ -952,7 +940,6 @@ void tmio_mmc_host_remove(struct tmio_mmc_host *host)
|
|||||||
mmc_remove_host(host->mmc);
|
mmc_remove_host(host->mmc);
|
||||||
cancel_delayed_work_sync(&host->delayed_reset_work);
|
cancel_delayed_work_sync(&host->delayed_reset_work);
|
||||||
tmio_mmc_release_dma(host);
|
tmio_mmc_release_dma(host);
|
||||||
free_irq(host->irq, host);
|
|
||||||
iounmap(host->ctl);
|
iounmap(host->ctl);
|
||||||
mmc_free_host(host->mmc);
|
mmc_free_host(host->mmc);
|
||||||
|
|
||||||
|
Reference in New Issue
Block a user