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
13 static struct snd_soc_dapm_widget *
meson_codec_glue_get_input(struct snd_soc_dapm_widget * w)14 meson_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
meson_codec_glue_input_set_data(struct snd_soc_dai * dai,struct meson_codec_glue_input * data)39 static 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
45 struct meson_codec_glue_input *
meson_codec_glue_input_get_data(struct snd_soc_dai * dai)46 meson_codec_glue_input_get_data(struct snd_soc_dai *dai)
47 {
48 return dai->playback_dma_data;
49 }
50 EXPORT_SYMBOL_GPL(meson_codec_glue_input_get_data);
51
52 static struct meson_codec_glue_input *
meson_codec_glue_output_get_input_data(struct snd_soc_dapm_widget * w)53 meson_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
meson_codec_glue_input_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)67 int 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 }
84 EXPORT_SYMBOL_GPL(meson_codec_glue_input_hw_params);
85
meson_codec_glue_input_set_fmt(struct snd_soc_dai * dai,unsigned int fmt)86 int 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 }
96 EXPORT_SYMBOL_GPL(meson_codec_glue_input_set_fmt);
97
meson_codec_glue_output_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)98 int 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 }
121 EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);
122
meson_codec_glue_input_dai_probe(struct snd_soc_dai * dai)123 int 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 }
134 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);
135
meson_codec_glue_input_dai_remove(struct snd_soc_dai * dai)136 int 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 }
144 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);
145
146 MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
147 MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");
148 MODULE_LICENSE("GPL v2");
149
150