Merge tag 'linux-kselftest-next-5.11-rc1' of git://git.kernel.org/pub/scm/linux/kerne...
[linux-2.6-microblaze.git] / sound / soc / soc-compress.c
index c7ad52a..246a5e3 100644 (file)
 #include <sound/soc-link.h>
 #include <linux/pm_runtime.h>
 
-static int soc_compr_components_open(struct snd_compr_stream *cstream,
-                                    struct snd_soc_component **last)
+static int soc_compr_clean(struct snd_compr_stream *cstream, int rollback)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret;
+       struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
+       struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
+       int stream = cstream->direction; /* SND_COMPRESS_xxx is same as SNDRV_PCM_STREAM_xxx */
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->open)
-                       continue;
+       mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 
-               ret = component->driver->compress_ops->open(component, cstream);
-               if (ret < 0) {
-                       dev_err(component->dev,
-                               "Compress ASoC: can't open platform %s: %d\n",
-                               component->name, ret);
+       if (!rollback)
+               snd_soc_runtime_deactivate(rtd, stream);
 
-                       *last = component;
-                       return ret;
-               }
-       }
+       snd_soc_dai_digital_mute(codec_dai, 1, stream);
 
-       *last = NULL;
-       return 0;
-}
+       if (!snd_soc_dai_active(cpu_dai))
+               cpu_dai->rate = 0;
 
-static int soc_compr_components_free(struct snd_compr_stream *cstream,
-                                    struct snd_soc_component *last)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i;
+       if (!snd_soc_dai_active(codec_dai))
+               codec_dai->rate = 0;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (component == last)
-                       break;
+       snd_soc_link_compr_shutdown(cstream, rollback);
 
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->free)
-                       continue;
+       snd_soc_component_compr_free(cstream, rollback);
 
-               component->driver->compress_ops->free(component, cstream);
-       }
+       snd_soc_dai_compr_shutdown(cpu_dai, cstream, rollback);
+
+       if (!rollback)
+               snd_soc_dapm_stream_stop(rtd, stream);
+
+       mutex_unlock(&rtd->card->pcm_mutex);
+
+       snd_soc_pcm_component_pm_runtime_put(rtd, cstream, rollback);
 
        return 0;
 }
 
+static int soc_compr_free(struct snd_compr_stream *cstream)
+{
+       return soc_compr_clean(cstream, 0);
+}
+
 static int soc_compr_open(struct snd_compr_stream *cstream)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component = NULL;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
        int stream = cstream->direction; /* SND_COMPRESS_xxx is same as SNDRV_PCM_STREAM_xxx */
        int ret;
 
        ret = snd_soc_pcm_component_pm_runtime_get(rtd, cstream);
        if (ret < 0)
-               goto pm_err;
+               goto err_no_lock;
 
        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 
        ret = snd_soc_dai_compr_startup(cpu_dai, cstream);
        if (ret < 0)
-               goto out;
+               goto err;
 
-       ret = soc_compr_components_open(cstream, &component);
+       ret = snd_soc_component_compr_open(cstream);
        if (ret < 0)
-               goto machine_err;
+               goto err;
 
        ret = snd_soc_link_compr_startup(cstream);
        if (ret < 0)
-               goto machine_err;
+               goto err;
 
        snd_soc_runtime_activate(rtd, stream);
-
-       mutex_unlock(&rtd->card->pcm_mutex);
-
-       return 0;
-
-machine_err:
-       soc_compr_components_free(cstream, component);
-
-       snd_soc_dai_compr_shutdown(cpu_dai, cstream);
-out:
+err:
        mutex_unlock(&rtd->card->pcm_mutex);
-pm_err:
-       snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 1);
+err_no_lock:
+       if (ret < 0)
+               soc_compr_clean(cstream, 1);
 
        return ret;
 }
@@ -119,7 +103,6 @@ static int soc_compr_open_fe(struct snd_compr_stream *cstream)
        struct snd_soc_pcm_runtime *fe = cstream->private_data;
        struct snd_pcm_substream *fe_substream =
                 fe->pcm->streams[cstream->direction].substream;
-       struct snd_soc_component *component;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(fe, 0);
        struct snd_soc_dpcm *dpcm;
        struct snd_soc_dapm_widget_list *list;
@@ -156,7 +139,7 @@ static int soc_compr_open_fe(struct snd_compr_stream *cstream)
        if (ret < 0)
                goto out;
 
-       ret = soc_compr_components_open(cstream, &component);
+       ret = snd_soc_component_compr_open(cstream);
        if (ret < 0)
                goto open_err;
 
@@ -177,9 +160,9 @@ static int soc_compr_open_fe(struct snd_compr_stream *cstream)
        return 0;
 
 machine_err:
-       soc_compr_components_free(cstream, component);
+       snd_soc_component_compr_free(cstream, 1);
 open_err:
-       snd_soc_dai_compr_shutdown(cpu_dai, cstream);
+       snd_soc_dai_compr_shutdown(cpu_dai, cstream, 1);
 out:
        dpcm_path_put(&list);
 be_err:
@@ -188,40 +171,6 @@ be_err:
        return ret;
 }
 
-static int soc_compr_free(struct snd_compr_stream *cstream)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
-       struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
-       int stream = cstream->direction; /* SND_COMPRESS_xxx is same as SNDRV_PCM_STREAM_xxx */
-
-       mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
-
-       snd_soc_runtime_deactivate(rtd, stream);
-
-       snd_soc_dai_digital_mute(codec_dai, 1, stream);
-
-       if (!snd_soc_dai_active(cpu_dai))
-               cpu_dai->rate = 0;
-
-       if (!snd_soc_dai_active(codec_dai))
-               codec_dai->rate = 0;
-
-       snd_soc_link_compr_shutdown(cstream);
-
-       soc_compr_components_free(cstream, NULL);
-
-       snd_soc_dai_compr_shutdown(cpu_dai, cstream);
-
-       snd_soc_dapm_stream_stop(rtd, stream);
-
-       mutex_unlock(&rtd->card->pcm_mutex);
-
-       snd_soc_pcm_component_pm_runtime_put(rtd, cstream, 0);
-
-       return 0;
-}
-
 static int soc_compr_free_fe(struct snd_compr_stream *cstream)
 {
        struct snd_soc_pcm_runtime *fe = cstream->private_data;
@@ -255,37 +204,16 @@ static int soc_compr_free_fe(struct snd_compr_stream *cstream)
 
        fe->dpcm[stream].runtime = NULL;
 
-       snd_soc_link_compr_shutdown(cstream);
+       snd_soc_link_compr_shutdown(cstream, 0);
 
-       soc_compr_components_free(cstream, NULL);
+       snd_soc_component_compr_free(cstream, 0);
 
-       snd_soc_dai_compr_shutdown(cpu_dai, cstream);
+       snd_soc_dai_compr_shutdown(cpu_dai, cstream, 0);
 
        mutex_unlock(&fe->card->mutex);
        return 0;
 }
 
-static int soc_compr_components_trigger(struct snd_compr_stream *cstream,
-                                       int cmd)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret;
-
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->trigger)
-                       continue;
-
-               ret = component->driver->compress_ops->trigger(
-                       component, cstream, cmd);
-               if (ret < 0)
-                       return ret;
-       }
-
-       return 0;
-}
-
 static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
@@ -296,7 +224,7 @@ static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
 
        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 
-       ret = soc_compr_components_trigger(cstream, cmd);
+       ret = snd_soc_component_compr_trigger(cstream, cmd);
        if (ret < 0)
                goto out;
 
@@ -327,7 +255,7 @@ static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
 
        if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
            cmd == SND_COMPR_TRIGGER_DRAIN)
-               return soc_compr_components_trigger(cstream, cmd);
+               return snd_soc_component_compr_trigger(cstream, cmd);
 
        mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
 
@@ -335,7 +263,7 @@ static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
        if (ret < 0)
                goto out;
 
-       ret = soc_compr_components_trigger(cstream, cmd);
+       ret = snd_soc_component_compr_trigger(cstream, cmd);
        if (ret < 0)
                goto out;
 
@@ -364,27 +292,6 @@ out:
        return ret;
 }
 
-static int soc_compr_components_set_params(struct snd_compr_stream *cstream,
-                                          struct snd_compr_params *params)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret;
-
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->set_params)
-                       continue;
-
-               ret = component->driver->compress_ops->set_params(
-                       component, cstream, params);
-               if (ret < 0)
-                       return ret;
-       }
-
-       return 0;
-}
-
 static int soc_compr_set_params(struct snd_compr_stream *cstream,
                                struct snd_compr_params *params)
 {
@@ -406,7 +313,7 @@ static int soc_compr_set_params(struct snd_compr_stream *cstream,
        if (ret < 0)
                goto err;
 
-       ret = soc_compr_components_set_params(cstream, params);
+       ret = snd_soc_component_compr_set_params(cstream, params);
        if (ret < 0)
                goto err;
 
@@ -463,7 +370,7 @@ static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
        if (ret < 0)
                goto out;
 
-       ret = soc_compr_components_set_params(cstream, params);
+       ret = snd_soc_component_compr_set_params(cstream, params);
        if (ret < 0)
                goto out;
 
@@ -484,9 +391,8 @@ static int soc_compr_get_params(struct snd_compr_stream *cstream,
                                struct snd_codec *params)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
-       int i, ret = 0;
+       int ret = 0;
 
        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 
@@ -494,73 +400,17 @@ static int soc_compr_get_params(struct snd_compr_stream *cstream,
        if (ret < 0)
                goto err;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->get_params)
-                       continue;
-
-               ret = component->driver->compress_ops->get_params(
-                       component, cstream, params);
-               break;
-       }
-
+       ret = snd_soc_component_compr_get_params(cstream, params);
 err:
        mutex_unlock(&rtd->card->pcm_mutex);
        return ret;
 }
 
-static int soc_compr_get_caps(struct snd_compr_stream *cstream,
-                             struct snd_compr_caps *caps)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret = 0;
-
-       mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
-
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->get_caps)
-                       continue;
-
-               ret = component->driver->compress_ops->get_caps(
-                       component, cstream, caps);
-               break;
-       }
-
-       mutex_unlock(&rtd->card->pcm_mutex);
-       return ret;
-}
-
-static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
-                                   struct snd_compr_codec_caps *codec)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret = 0;
-
-       mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
-
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->get_codec_caps)
-                       continue;
-
-               ret = component->driver->compress_ops->get_codec_caps(
-                       component, cstream, codec);
-               break;
-       }
-
-       mutex_unlock(&rtd->card->pcm_mutex);
-       return ret;
-}
-
 static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
-       int i, ret = 0;
+       int ret;
 
        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 
@@ -568,17 +418,7 @@ static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
        if (ret < 0)
                goto err;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->ack)
-                       continue;
-
-               ret = component->driver->compress_ops->ack(
-                       component, cstream, bytes);
-               if (ret < 0)
-                       goto err;
-       }
-
+       ret = snd_soc_component_compr_ack(cstream, bytes);
 err:
        mutex_unlock(&rtd->card->pcm_mutex);
        return ret;
@@ -588,8 +428,7 @@ static int soc_compr_pointer(struct snd_compr_stream *cstream,
                             struct snd_compr_tstamp *tstamp)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret = 0;
+       int ret;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
 
        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
@@ -598,91 +437,38 @@ static int soc_compr_pointer(struct snd_compr_stream *cstream,
        if (ret < 0)
                goto out;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->pointer)
-                       continue;
-
-               ret = component->driver->compress_ops->pointer(
-                       component, cstream, tstamp);
-               break;
-       }
+       ret = snd_soc_component_compr_pointer(cstream, tstamp);
 out:
        mutex_unlock(&rtd->card->pcm_mutex);
        return ret;
 }
 
-static int soc_compr_copy(struct snd_compr_stream *cstream,
-                         char __user *buf, size_t count)
-{
-       struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
-       int i, ret = 0;
-
-       mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
-
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->copy)
-                       continue;
-
-               ret = component->driver->compress_ops->copy(
-                       component, cstream, buf, count);
-               break;
-       }
-
-       mutex_unlock(&rtd->card->pcm_mutex);
-       return ret;
-}
-
 static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
                                  struct snd_compr_metadata *metadata)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
-       int i, ret;
+       int ret;
 
        ret = snd_soc_dai_compr_set_metadata(cpu_dai, cstream, metadata);
        if (ret < 0)
                return ret;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->set_metadata)
-                       continue;
-
-               ret = component->driver->compress_ops->set_metadata(
-                       component, cstream, metadata);
-               if (ret < 0)
-                       return ret;
-       }
-
-       return 0;
+       return snd_soc_component_compr_set_metadata(cstream, metadata);
 }
 
 static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
                                  struct snd_compr_metadata *metadata)
 {
        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
-       struct snd_soc_component *component;
        struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
-       int i, ret;
+       int ret;
 
        ret = snd_soc_dai_compr_get_metadata(cpu_dai, cstream, metadata);
        if (ret < 0)
                return ret;
 
-       for_each_rtd_components(rtd, i, component) {
-               if (!component->driver->compress_ops ||
-                   !component->driver->compress_ops->get_metadata)
-                       continue;
-
-               return component->driver->compress_ops->get_metadata(
-                       component, cstream, metadata);
-       }
-
-       return 0;
+       return snd_soc_component_compr_get_metadata(cstream, metadata);
 }
 
 /* ASoC Compress operations */
@@ -696,8 +482,8 @@ static struct snd_compr_ops soc_compr_ops = {
        .trigger        = soc_compr_trigger,
        .pointer        = soc_compr_pointer,
        .ack            = soc_compr_ack,
-       .get_caps       = soc_compr_get_caps,
-       .get_codec_caps = soc_compr_get_codec_caps
+       .get_caps       = snd_soc_component_compr_get_caps,
+       .get_codec_caps = snd_soc_component_compr_get_codec_caps,
 };
 
 /* ASoC Dynamic Compress operations */
@@ -711,8 +497,8 @@ static struct snd_compr_ops soc_compr_dyn_ops = {
        .trigger        = soc_compr_trigger_fe,
        .pointer        = soc_compr_pointer,
        .ack            = soc_compr_ack,
-       .get_caps       = soc_compr_get_caps,
-       .get_codec_caps = soc_compr_get_codec_caps
+       .get_caps       = snd_soc_component_compr_get_caps,
+       .get_codec_caps = snd_soc_component_compr_get_codec_caps,
 };
 
 /**
@@ -815,7 +601,7 @@ int snd_soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
                    !component->driver->compress_ops->copy)
                        continue;
 
-               compr->ops->copy = soc_compr_copy;
+               compr->ops->copy = snd_soc_component_compr_copy;
                break;
        }