1 files changed, 25 insertions, 12 deletions

diff --git a/sound/soc/davinci/davinci-mcasp.c b/sound/soc/davinci/davinci-mcasp.c
index 5d1f98a4c978..79f0f4ad242c 100644
--- a/sound/soc/davinci/davinci-mcasp.c
+++ b/sound/soc/davinci/davinci-mcasp.c
@@ -18,6 +18,7 @@
 #include <linux/init.h>
 #include <linux/module.h>
 #include <linux/device.h>
+#include <linux/slab.h>
 #include <linux/delay.h>
 #include <linux/io.h>
 #include <linux/clk.h>
@@ -714,16 +715,13 @@ static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
         struct davinci_pcm_dma_params *dma_params =
                                         &dev->dma_params[substream->stream];
         int word_length;
-        u8 numevt;
+        u8 fifo_level;
 
         davinci_hw_common_param(dev, substream->stream);
         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
-                numevt = dev->txnumevt;
+                fifo_level = dev->txnumevt;
         else
-                numevt = dev->rxnumevt;
-
-        if (!numevt)
-                numevt = 1;
+                fifo_level = dev->rxnumevt;
 
         if (dev->op_mode == DAVINCI_MCASP_DIT_MODE)
                 davinci_hw_dit_param(dev);
@@ -751,12 +749,12 @@ static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
                 return -EINVAL;
         }
 
-        if (dev->version == MCASP_VERSION_2) {
-                dma_params->data_type *= numevt;
-                dma_params->acnt = 4 * numevt;
-        } else
+        if (dev->version == MCASP_VERSION_2 && !fifo_level)
+                dma_params->acnt = 4;
+        else
                 dma_params->acnt = dma_params->data_type;
 
+        dma_params->fifo_level = fifo_level;
         davinci_config_channel_size(dev, word_length);
 
         return 0;
@@ -770,14 +768,26 @@ static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
         int ret = 0;
 
         switch (cmd) {
-        case SNDRV_PCM_TRIGGER_START:
         case SNDRV_PCM_TRIGGER_RESUME:
+        case SNDRV_PCM_TRIGGER_START:
         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
+                if (!dev->clk_active) {
+                        clk_enable(dev->clk);
+                        dev->clk_active = 1;
+                }
                 davinci_mcasp_start(dev, substream->stream);
                 break;
 
-        case SNDRV_PCM_TRIGGER_STOP:
         case SNDRV_PCM_TRIGGER_SUSPEND:
+                davinci_mcasp_stop(dev, substream->stream);
+                if (dev->clk_active) {
+                        clk_disable(dev->clk);
+                        dev->clk_active = 0;
+                }
+
+                break;
+
+        case SNDRV_PCM_TRIGGER_STOP:
         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
                 davinci_mcasp_stop(dev, substream->stream);
                 break;
@@ -869,6 +879,7 @@ static int davinci_mcasp_probe(struct platform_device *pdev)
         }
 
         clk_enable(dev->clk);
+        dev->clk_active = 1;
 
         dev->base = (void __iomem *)IO_ADDRESS(mem->start);
         dev->op_mode = pdata->op_mode;
@@ -907,6 +918,8 @@ static int davinci_mcasp_probe(struct platform_device *pdev)
 
         dma_data->channel = res->start;
         davinci_mcasp_dai[pdata->op_mode].private_data = dev;
+        davinci_mcasp_dai[pdata->op_mode].capture.dma_data = dev->dma_params;
+        davinci_mcasp_dai[pdata->op_mode].playback.dma_data = dev->dma_params;
         davinci_mcasp_dai[pdata->op_mode].dev = &pdev->dev;
         ret = snd_soc_register_dai(&davinci_mcasp_dai[pdata->op_mode]);