soc/meson/meson-codec-glue.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 //
0003 // Copyright (c) 2019 BayLibre, SAS.
0004 // Author: Jerome Brunet <jbrunet@baylibre.com>
0005
0006 #include <linux/module.h>
0007 #include <sound/pcm_params.h>
0008 #include <sound/soc.h>
0009 #include <sound/soc-dai.h>
0010
0011 #include "meson-codec-glue.h"
0012
0013 static struct snd_soc_dapm_widget *
0014 meson_codec_glue_get_input(struct snd_soc_dapm_widget *w)
0015 {
0016     struct snd_soc_dapm_path *p;
0017     struct snd_soc_dapm_widget *in;
0018
0019     snd_soc_dapm_widget_for_each_source_path(w, p) {
0020         if (!p->connect)
0021             continue;
0022
0023         /* Check that we still are in the same component */
0024         if (snd_soc_dapm_to_component(w->dapm) !=
0025             snd_soc_dapm_to_component(p->source->dapm))
0026             continue;
0027
0028         if (p->source->id == snd_soc_dapm_dai_in)
0029             return p->source;
0030
0031         in = meson_codec_glue_get_input(p->source);
0032         if (in)
0033             return in;
0034     }
0035
0036     return NULL;
0037 }
0038
0039 static void meson_codec_glue_input_set_data(struct snd_soc_dai *dai,
0040                         struct meson_codec_glue_input *data)
0041 {
0042     dai->playback_dma_data = data;
0043 }
0044
0045 struct meson_codec_glue_input *
0046 meson_codec_glue_input_get_data(struct snd_soc_dai *dai)
0047 {
0048     return dai->playback_dma_data;
0049 }
0050 EXPORT_SYMBOL_GPL(meson_codec_glue_input_get_data);
0051
0052 static struct meson_codec_glue_input *
0053 meson_codec_glue_output_get_input_data(struct snd_soc_dapm_widget *w)
0054 {
0055     struct snd_soc_dapm_widget *in =
0056         meson_codec_glue_get_input(w);
0057     struct snd_soc_dai *dai;
0058
0059     if (WARN_ON(!in))
0060         return NULL;
0061
0062     dai = in->priv;
0063
0064     return meson_codec_glue_input_get_data(dai);
0065 }
0066
0067 int meson_codec_glue_input_hw_params(struct snd_pcm_substream *substream,
0068                      struct snd_pcm_hw_params *params,
0069                      struct snd_soc_dai *dai)
0070 {
0071     struct meson_codec_glue_input *data =
0072         meson_codec_glue_input_get_data(dai);
0073
0074     data->params.rates = snd_pcm_rate_to_rate_bit(params_rate(params));
0075     data->params.rate_min = params_rate(params);
0076     data->params.rate_max = params_rate(params);
0077     data->params.formats = 1ULL << (__force int) params_format(params);
0078     data->params.channels_min = params_channels(params);
0079     data->params.channels_max = params_channels(params);
0080     data->params.sig_bits = dai->driver->playback.sig_bits;
0081
0082     return 0;
0083 }
0084 EXPORT_SYMBOL_GPL(meson_codec_glue_input_hw_params);
0085
0086 int meson_codec_glue_input_set_fmt(struct snd_soc_dai *dai,
0087                    unsigned int fmt)
0088 {
0089     struct meson_codec_glue_input *data =
0090         meson_codec_glue_input_get_data(dai);
0091
0092     /* Save the source stream format for the downstream link */
0093     data->fmt = fmt;
0094     return 0;
0095 }
0096 EXPORT_SYMBOL_GPL(meson_codec_glue_input_set_fmt);
0097
0098 int meson_codec_glue_output_startup(struct snd_pcm_substream *substream,
0099                     struct snd_soc_dai *dai)
0100 {
0101     struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
0102     struct meson_codec_glue_input *in_data =
0103         meson_codec_glue_output_get_input_data(dai->capture_widget);
0104
0105     if (!in_data)
0106         return -ENODEV;
0107
0108     if (WARN_ON(!rtd->dai_link->params)) {
0109         dev_warn(dai->dev, "codec2codec link expected\n");
0110         return -EINVAL;
0111     }
0112
0113     /* Replace link params with the input params */
0114     rtd->dai_link->params = &in_data->params;
0115
0116     return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt);
0117 }
0118 EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);
0119
0120 int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai)
0121 {
0122     struct meson_codec_glue_input *data;
0123
0124     data = kzalloc(sizeof(*data), GFP_KERNEL);
0125     if (!data)
0126         return -ENOMEM;
0127
0128     meson_codec_glue_input_set_data(dai, data);
0129     return 0;
0130 }
0131 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);
0132
0133 int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai)
0134 {
0135     struct meson_codec_glue_input *data =
0136         meson_codec_glue_input_get_data(dai);
0137
0138     kfree(data);
0139     return 0;
0140 }
0141 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);
0142
0143 MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
0144 MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");
0145 MODULE_LICENSE("GPL v2");
0146