LXR linux/sound/soc/meson/meson-codec-glue.c

   1// SPDX-License-Identifier: GPL-2.0
   2//
   3// Copyright (c) 2019 BayLibre, SAS.
   4// Author: Jerome Brunet <jbrunet@baylibre.com>
   5
   6#include <linux/module.h>
   7#include <sound/pcm_params.h>
   8#include <sound/soc.h>
   9#include <sound/soc-dai.h>
  10
  11#include "meson-codec-glue.h"
  12
  13static struct snd_soc_dapm_widget *
  14meson_codec_glue_get_input(struct snd_soc_dapm_widget *w)
  15{
  16        struct snd_soc_dapm_path *p = NULL;
  17        struct snd_soc_dapm_widget *in;
  18
  19        snd_soc_dapm_widget_for_each_source_path(w, p) {
  20                if (!p->connect)
  21                        continue;
  22
  23                /* Check that we still are in the same component */
  24                if (snd_soc_dapm_to_component(w->dapm) !=
  25                    snd_soc_dapm_to_component(p->source->dapm))
  26                        continue;
  27
  28                if (p->source->id == snd_soc_dapm_dai_in)
  29                        return p->source;
  30
  31                in = meson_codec_glue_get_input(p->source);
  32                if (in)
  33                        return in;
  34        }
  35
  36        return NULL;
  37}
  38
  39static void meson_codec_glue_input_set_data(struct snd_soc_dai *dai,
  40                                            struct meson_codec_glue_input *data)
  41{
  42        dai->playback_dma_data = data;
  43}
  44
  45struct meson_codec_glue_input *
  46meson_codec_glue_input_get_data(struct snd_soc_dai *dai)
  47{
  48        return dai->playback_dma_data;
  49}
  50EXPORT_SYMBOL_GPL(meson_codec_glue_input_get_data);
  51
  52static struct meson_codec_glue_input *
  53meson_codec_glue_output_get_input_data(struct snd_soc_dapm_widget *w)
  54{
  55        struct snd_soc_dapm_widget *in =
  56                meson_codec_glue_get_input(w);
  57        struct snd_soc_dai *dai;
  58
  59        if (WARN_ON(!in))
  60                return NULL;
  61
  62        dai = in->priv;
  63
  64        return meson_codec_glue_input_get_data(dai);
  65}
  66
  67int meson_codec_glue_input_hw_params(struct snd_pcm_substream *substream,
  68                                     struct snd_pcm_hw_params *params,
  69                                     struct snd_soc_dai *dai)
  70{
  71        struct meson_codec_glue_input *data =
  72                meson_codec_glue_input_get_data(dai);
  73
  74        data->params.rates = snd_pcm_rate_to_rate_bit(params_rate(params));
  75        data->params.rate_min = params_rate(params);
  76        data->params.rate_max = params_rate(params);
  77        data->params.formats = 1ULL << (__force int) params_format(params);
  78        data->params.channels_min = params_channels(params);
  79        data->params.channels_max = params_channels(params);
  80        data->params.sig_bits = dai->driver->playback.sig_bits;
  81
  82        return 0;
  83}
  84EXPORT_SYMBOL_GPL(meson_codec_glue_input_hw_params);
  85
  86int meson_codec_glue_input_set_fmt(struct snd_soc_dai *dai,
  87                                   unsigned int fmt)
  88{
  89        struct meson_codec_glue_input *data =
  90                meson_codec_glue_input_get_data(dai);
  91
  92        /* Save the source stream format for the downstream link */
  93        data->fmt = fmt;
  94        return 0;
  95}
  96EXPORT_SYMBOL_GPL(meson_codec_glue_input_set_fmt);
  97
  98int meson_codec_glue_output_startup(struct snd_pcm_substream *substream,
  99                                    struct snd_soc_dai *dai)
 100{
 101        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 102        struct meson_codec_glue_input *in_data =
 103                meson_codec_glue_output_get_input_data(dai->capture_widget);
 104
 105        if (!in_data)
 106                return -ENODEV;
 107
 108        if (WARN_ON(!rtd->dai_link->params)) {
 109                dev_warn(dai->dev, "codec2codec link expected\n");
 110                return -EINVAL;
 111        }
 112
 113        /* Replace link params with the input params */
 114        rtd->dai_link->params = &in_data->params;
 115
 116        if (!in_data->fmt)
 117                return 0;
 118
 119        return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt);
 120}
 121EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);
 122
 123int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai)
 124{
 125        struct meson_codec_glue_input *data;
 126
 127        data = kzalloc(sizeof(*data), GFP_KERNEL);
 128        if (!data)
 129                return -ENOMEM;
 130
 131        meson_codec_glue_input_set_data(dai, data);
 132        return 0;
 133}
 134EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);
 135
 136int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai)
 137{
 138        struct meson_codec_glue_input *data =
 139                meson_codec_glue_input_get_data(dai);
 140
 141        kfree(data);
 142        return 0;
 143}
 144EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);
 145
 146MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
 147MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");
 148MODULE_LICENSE("GPL v2");
 149
 150