- patches.suse/slab-handle-memoryless-nodes-v2a.patch: Refresh.
[linux-flexiantxendom0-3.2.10.git] / sound / soc / au1x / psc-i2s.c
index bb58932..0cf2ca6 100644 (file)
@@ -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");