1 files changed, 120 insertions, 69 deletions

diff --git a/sound/soc/au1x/psc-i2s.c b/sound/soc/au1x/psc-i2s.c
index bb589327ee32..0cf2ca61c776 100644
--- a/sound/soc/au1x/psc-i2s.c
+++ b/sound/soc/au1x/psc-i2s.c
@@ -2,7 +2,7 @@
  * Au12x0/Au1550 PSC ALSA ASoC audio support.
  *
  * (c) 2007-2008 MSC Vertriebsges.m.b.H.,
- *      Manuel Lauss <mano@roarinelk.homelinux.net>
+ *      Manuel Lauss <manuel.lauss@gmail.com>
  *
  * 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
@@ -265,16 +265,52 @@ static int au1xpsc_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
 static int au1xpsc_i2s_probe(struct platform_device *pdev,
                              struct snd_soc_dai *dai)
 {
+        return  au1xpsc_i2s_workdata ? 0 : -ENODEV;
+}
+
+static void au1xpsc_i2s_remove(struct platform_device *pdev,
+                               struct snd_soc_dai *dai)
+{
+}
+
+static struct snd_soc_dai_ops au1xpsc_i2s_dai_ops = {
+        .trigger        = au1xpsc_i2s_trigger,
+        .hw_params      = au1xpsc_i2s_hw_params,
+        .set_fmt        = au1xpsc_i2s_set_fmt,
+};
+
+struct snd_soc_dai au1xpsc_i2s_dai = {
+        .name                   = "au1xpsc_i2s",
+        .probe                  = au1xpsc_i2s_probe,
+        .remove                 = au1xpsc_i2s_remove,
+        .playback = {
+                .rates          = AU1XPSC_I2S_RATES,
+                .formats        = AU1XPSC_I2S_FMTS,
+                .channels_min   = 2,
+                .channels_max   = 8,    /* 2 without external help */
+        },
+        .capture = {
+                .rates          = AU1XPSC_I2S_RATES,
+                .formats        = AU1XPSC_I2S_FMTS,
+                .channels_min   = 2,
+                .channels_max   = 8,    /* 2 without external help */
+        },
+        .ops = &au1xpsc_i2s_dai_ops,
+};
+EXPORT_SYMBOL(au1xpsc_i2s_dai);
+
+static int __init au1xpsc_i2s_drvprobe(struct platform_device *pdev)
+{
         struct resource *r;
         unsigned long sel;
         int ret;
+        struct au1xpsc_audio_data *wd;
 
         if (au1xpsc_i2s_workdata)
                 return -EBUSY;
 
-        au1xpsc_i2s_workdata =
-                kzalloc(sizeof(struct au1xpsc_audio_data), GFP_KERNEL);
-        if (!au1xpsc_i2s_workdata)
+        wd = kzalloc(sizeof(struct au1xpsc_audio_data), GFP_KERNEL);
+        if (!wd)
                 return -ENOMEM;
 
         r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
@@ -284,131 +320,146 @@ static int au1xpsc_i2s_probe(struct platform_device *pdev,
         }
 
         ret = -EBUSY;
-        au1xpsc_i2s_workdata->ioarea =
-                request_mem_region(r->start, r->end - r->start + 1,
+        wd->ioarea = request_mem_region(r->start, r->end - r->start + 1,
                                         "au1xpsc_i2s");
-        if (!au1xpsc_i2s_workdata->ioarea)
+        if (!wd->ioarea)
                 goto out0;
 
-        au1xpsc_i2s_workdata->mmio = ioremap(r->start, 0xffff);
-        if (!au1xpsc_i2s_workdata->mmio)
+        wd->mmio = ioremap(r->start, 0xffff);
+        if (!wd->mmio)
                 goto out1;
 
         /* preserve PSC clock source set up by platform (dev.platform_data
          * is already occupied by soc layer)
          */
-        sel = au_readl(PSC_SEL(au1xpsc_i2s_workdata)) & PSC_SEL_CLK_MASK;
-        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_i2s_workdata));
+        sel = au_readl(PSC_SEL(wd)) & PSC_SEL_CLK_MASK;
+        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(wd));
         au_sync();
-        au_writel(PSC_SEL_PS_I2SMODE | sel, PSC_SEL(au1xpsc_i2s_workdata));
-        au_writel(0, I2S_CFG(au1xpsc_i2s_workdata));
+        au_writel(PSC_SEL_PS_I2SMODE | sel, PSC_SEL(wd));
+        au_writel(0, I2S_CFG(wd));
         au_sync();
 
         /* preconfigure: set max rx/tx fifo depths */
-        au1xpsc_i2s_workdata->cfg |=
-                        PSC_I2SCFG_RT_FIFO8 | PSC_I2SCFG_TT_FIFO8;
+        wd->cfg |= PSC_I2SCFG_RT_FIFO8 | PSC_I2SCFG_TT_FIFO8;
 
         /* don't wait for I2S core to become ready now; clocks may not
          * be running yet; depending on clock input for PSC a wait might
          * time out.
          */
 
-        return 0;
+        ret = snd_soc_register_dai(&au1xpsc_i2s_dai);
+        if (ret)
+                goto out1;
 
+        /* finally add the DMA device for this PSC */
+        wd->dmapd = au1xpsc_pcm_add(pdev);
+        if (wd->dmapd) {
+                platform_set_drvdata(pdev, wd);
+                au1xpsc_i2s_workdata = wd;
+                return 0;
+        }
+
+        snd_soc_unregister_dai(&au1xpsc_i2s_dai);
 out1:
-        release_resource(au1xpsc_i2s_workdata->ioarea);
-        kfree(au1xpsc_i2s_workdata->ioarea);
+        release_resource(wd->ioarea);
+        kfree(wd->ioarea);
 out0:
-        kfree(au1xpsc_i2s_workdata);
-        au1xpsc_i2s_workdata = NULL;
+        kfree(wd);
         return ret;
 }
 
-static void au1xpsc_i2s_remove(struct platform_device *pdev,
-                               struct snd_soc_dai *dai)
+static int __devexit au1xpsc_i2s_drvremove(struct platform_device *pdev)
 {
-        au_writel(0, I2S_CFG(au1xpsc_i2s_workdata));
+        struct au1xpsc_audio_data *wd = platform_get_drvdata(pdev);
+
+        if (wd->dmapd)
+                au1xpsc_pcm_destroy(wd->dmapd);
+
+        snd_soc_unregister_dai(&au1xpsc_i2s_dai);
+
+        au_writel(0, I2S_CFG(wd));
         au_sync();
-        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_i2s_workdata));
+        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(wd));
         au_sync();
 
-        iounmap(au1xpsc_i2s_workdata->mmio);
-        release_resource(au1xpsc_i2s_workdata->ioarea);
-        kfree(au1xpsc_i2s_workdata->ioarea);
-        kfree(au1xpsc_i2s_workdata);
-        au1xpsc_i2s_workdata = NULL;
+        iounmap(wd->mmio);
+        release_resource(wd->ioarea);
+        kfree(wd->ioarea);
+        kfree(wd);
+
+        au1xpsc_i2s_workdata = NULL;    /* MDEV */
+
+        return 0;
 }
 
-static int au1xpsc_i2s_suspend(struct snd_soc_dai *cpu_dai)
+#ifdef CONFIG_PM
+static int au1xpsc_i2s_drvsuspend(struct device *dev)
 {
+        struct au1xpsc_audio_data *wd = dev_get_drvdata(dev);
+
         /* save interesting register and disable PSC */
-        au1xpsc_i2s_workdata->pm[0] =
-                au_readl(PSC_SEL(au1xpsc_i2s_workdata));
+        wd->pm[0] = au_readl(PSC_SEL(wd));
 
-        au_writel(0, I2S_CFG(au1xpsc_i2s_workdata));
+        au_writel(0, I2S_CFG(wd));
         au_sync();
-        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_i2s_workdata));
+        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(wd));
         au_sync();
 
         return 0;
 }
 
-static int au1xpsc_i2s_resume(struct snd_soc_dai *cpu_dai)
+static int au1xpsc_i2s_drvresume(struct device *dev)
 {
+        struct au1xpsc_audio_data *wd = dev_get_drvdata(dev);
+
         /* select I2S mode and PSC clock */
-        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_i2s_workdata));
+        au_writel(PSC_CTRL_DISABLE, PSC_CTRL(wd));
         au_sync();
-        au_writel(0, PSC_SEL(au1xpsc_i2s_workdata));
+        au_writel(0, PSC_SEL(wd));
         au_sync();
-        au_writel(au1xpsc_i2s_workdata->pm[0],
-                        PSC_SEL(au1xpsc_i2s_workdata));
+        au_writel(wd->pm[0], PSC_SEL(wd));
         au_sync();
 
         return 0;
 }
 
-static struct snd_soc_dai_ops au1xpsc_i2s_dai_ops = {
-        .trigger        = au1xpsc_i2s_trigger,
-        .hw_params      = au1xpsc_i2s_hw_params,
-        .set_fmt        = au1xpsc_i2s_set_fmt,
+static struct dev_pm_ops au1xpsci2s_pmops = {
+        .suspend        = au1xpsc_i2s_drvsuspend,
+        .resume         = au1xpsc_i2s_drvresume,
 };
 
-struct snd_soc_dai au1xpsc_i2s_dai = {
-        .name                   = "au1xpsc_i2s",
-        .probe                  = au1xpsc_i2s_probe,
-        .remove                 = au1xpsc_i2s_remove,
-        .suspend                = au1xpsc_i2s_suspend,
-        .resume                 = au1xpsc_i2s_resume,
-        .playback = {
-                .rates          = AU1XPSC_I2S_RATES,
-                .formats        = AU1XPSC_I2S_FMTS,
-                .channels_min   = 2,
-                .channels_max   = 8,    /* 2 without external help */
-        },
-        .capture = {
-                .rates          = AU1XPSC_I2S_RATES,
-                .formats        = AU1XPSC_I2S_FMTS,
-                .channels_min   = 2,
-                .channels_max   = 8,    /* 2 without external help */
+#define AU1XPSCI2S_PMOPS &au1xpsci2s_pmops
+
+#else
+
+#define AU1XPSCI2S_PMOPS NULL
+
+#endif
+
+static struct platform_driver au1xpsc_i2s_driver = {
+        .driver         = {
+                .name   = "au1xpsc_i2s",
+                .owner  = THIS_MODULE,
+                .pm     = AU1XPSCI2S_PMOPS,
         },
-        .ops = &au1xpsc_i2s_dai_ops,
+        .probe          = au1xpsc_i2s_drvprobe,
+        .remove         = __devexit_p(au1xpsc_i2s_drvremove),
 };
-EXPORT_SYMBOL(au1xpsc_i2s_dai);
 
-static int __init au1xpsc_i2s_init(void)
+static int __init au1xpsc_i2s_load(void)
 {
         au1xpsc_i2s_workdata = NULL;
-        return snd_soc_register_dai(&au1xpsc_i2s_dai);
+        return platform_driver_register(&au1xpsc_i2s_driver);
 }
 
-static void __exit au1xpsc_i2s_exit(void)
+static void __exit au1xpsc_i2s_unload(void)
 {
-        snd_soc_unregister_dai(&au1xpsc_i2s_dai);
+        platform_driver_unregister(&au1xpsc_i2s_driver);
 }
 
-module_init(au1xpsc_i2s_init);
-module_exit(au1xpsc_i2s_exit);
+module_init(au1xpsc_i2s_load);
+module_exit(au1xpsc_i2s_unload);
 
 MODULE_LICENSE("GPL");
 MODULE_DESCRIPTION("Au12x0/Au1550 PSC I2S ALSA ASoC audio driver");
-MODULE_AUTHOR("Manuel Lauss <mano@roarinelk.homelinux.net>");
+MODULE_AUTHOR("Manuel Lauss");