1// SPDX-License-Identifier: GPL-2.0
  2//
  3// soc-link.c
  4//
  5// Copyright (C) 2019 Renesas Electronics Corp.
  6// Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
  7//
  8#include <sound/soc.h>
  9#include <sound/soc-link.h>
 10
 11#define soc_link_ret(rtd, ret) _soc_link_ret(rtd, __func__, ret)
 12static inline int _soc_link_ret(struct snd_soc_pcm_runtime *rtd,
 13				const char *func, int ret)
 14{
 15	/* Positive, Zero values are not errors */
 16	if (ret >= 0)
 17		return ret;
 18
 19	/* Negative values might be errors */
 20	switch (ret) {
 21	case -EPROBE_DEFER:
 22	case -ENOTSUPP:
 23		break;
 24	default:
 25		dev_err(rtd->dev,
 26			"ASoC: error at %s on %s: %d\n",
 27			func, rtd->dai_link->name, ret);
 28	}
 29
 30	return ret;
 31}
 32
 33/*
 34 * We might want to check substream by using list.
 35 * In such case, we can update these macros.
 36 */
 37#define soc_link_mark_push(rtd, substream, tgt)		((rtd)->mark_##tgt = substream)
 38#define soc_link_mark_pop(rtd, tgt)		((rtd)->mark_##tgt = NULL)
 39#define soc_link_mark_match(rtd, substream, tgt)	((rtd)->mark_##tgt == substream)
 40
 41int snd_soc_link_init(struct snd_soc_pcm_runtime *rtd)
 42{
 43	int ret = 0;
 44
 45	if (rtd->dai_link->init)
 46		ret = rtd->dai_link->init(rtd);
 47
 48	return soc_link_ret(rtd, ret);
 49}
 50
 51void snd_soc_link_exit(struct snd_soc_pcm_runtime *rtd)
 52{
 53	if (rtd->dai_link->exit)
 54		rtd->dai_link->exit(rtd);
 55}
 56
 57int snd_soc_link_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
 58				    struct snd_pcm_hw_params *params)
 59{
 60	int ret = 0;
 61
 62	if (rtd->dai_link->be_hw_params_fixup)
 63		ret = rtd->dai_link->be_hw_params_fixup(rtd, params);
 64
 65	return soc_link_ret(rtd, ret);
 66}
 67
 68int snd_soc_link_startup(struct snd_pcm_substream *substream)
 69{
 70	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
 71	int ret = 0;
 72
 73	if (rtd->dai_link->ops &&
 74	    rtd->dai_link->ops->startup)
 75		ret = rtd->dai_link->ops->startup(substream);
 76
 77	/* mark substream if succeeded */
 78	if (ret == 0)
 79		soc_link_mark_push(rtd, substream, startup);
 80
 81	return soc_link_ret(rtd, ret);
 82}
 83
 84void snd_soc_link_shutdown(struct snd_pcm_substream *substream,
 85			   int rollback)
 86{
 87	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
 88
 89	if (rollback && !soc_link_mark_match(rtd, substream, startup))
 90		return;
 91
 92	if (rtd->dai_link->ops &&
 93	    rtd->dai_link->ops->shutdown)
 94		rtd->dai_link->ops->shutdown(substream);
 95
 96	/* remove marked substream */
 97	soc_link_mark_pop(rtd, startup);
 98}
 99
100int snd_soc_link_prepare(struct snd_pcm_substream *substream)
101{
102	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
103	int ret = 0;
104
105	if (rtd->dai_link->ops &&
106	    rtd->dai_link->ops->prepare)
107		ret = rtd->dai_link->ops->prepare(substream);
108
109	return soc_link_ret(rtd, ret);
110}
111
112int snd_soc_link_hw_params(struct snd_pcm_substream *substream,
113			   struct snd_pcm_hw_params *params)
114{
115	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
116	int ret = 0;
117
118	if (rtd->dai_link->ops &&
119	    rtd->dai_link->ops->hw_params)
120		ret = rtd->dai_link->ops->hw_params(substream, params);
121
122	/* mark substream if succeeded */
123	if (ret == 0)
124		soc_link_mark_push(rtd, substream, hw_params);
125
126	return soc_link_ret(rtd, ret);
127}
128
129void snd_soc_link_hw_free(struct snd_pcm_substream *substream, int rollback)
130{
131	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
132
133	if (rollback && !soc_link_mark_match(rtd, substream, hw_params))
134		return;
135
136	if (rtd->dai_link->ops &&
137	    rtd->dai_link->ops->hw_free)
138		rtd->dai_link->ops->hw_free(substream);
139
140	/* remove marked substream */
141	soc_link_mark_pop(rtd, hw_params);
142}
143
144static int soc_link_trigger(struct snd_pcm_substream *substream, int cmd)
145{
146	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
147	int ret = 0;
148
149	if (rtd->dai_link->ops &&
150	    rtd->dai_link->ops->trigger)
151		ret = rtd->dai_link->ops->trigger(substream, cmd);
152
153	return soc_link_ret(rtd, ret);
154}
155
156int snd_soc_link_trigger(struct snd_pcm_substream *substream, int cmd,
157			 int rollback)
158{
159	struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
160	int ret = 0;
161
162	switch (cmd) {
163	case SNDRV_PCM_TRIGGER_START:
164	case SNDRV_PCM_TRIGGER_RESUME:
165	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
166		ret = soc_link_trigger(substream, cmd);
167		if (ret < 0)
168			break;
169		soc_link_mark_push(rtd, substream, trigger);
170		break;
171	case SNDRV_PCM_TRIGGER_STOP:
172	case SNDRV_PCM_TRIGGER_SUSPEND:
173	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
174		if (rollback && !soc_link_mark_match(rtd, substream, trigger))
175			break;
176
177		ret = soc_link_trigger(substream, cmd);
178		soc_link_mark_pop(rtd, startup);
179	}
180
181	return ret;
182}
183
184int snd_soc_link_compr_startup(struct snd_compr_stream *cstream)
185{
186	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
187	int ret = 0;
188
189	if (rtd->dai_link->compr_ops &&
190	    rtd->dai_link->compr_ops->startup)
191		ret = rtd->dai_link->compr_ops->startup(cstream);
192
193	if (ret == 0)
194		soc_link_mark_push(rtd, cstream, compr_startup);
195
196	return soc_link_ret(rtd, ret);
197}
198EXPORT_SYMBOL_GPL(snd_soc_link_compr_startup);
199
200void snd_soc_link_compr_shutdown(struct snd_compr_stream *cstream,
201				 int rollback)
202{
203	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
204
205	if (rollback && !soc_link_mark_match(rtd, cstream, compr_startup))
206		return;
207
208	if (rtd->dai_link->compr_ops &&
209	    rtd->dai_link->compr_ops->shutdown)
210		rtd->dai_link->compr_ops->shutdown(cstream);
211
212	soc_link_mark_pop(rtd, compr_startup);
213}
214EXPORT_SYMBOL_GPL(snd_soc_link_compr_shutdown);
215
216int snd_soc_link_compr_set_params(struct snd_compr_stream *cstream)
217{
218	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
219	int ret = 0;
220
221	if (rtd->dai_link->compr_ops &&
222	    rtd->dai_link->compr_ops->set_params)
223		ret = rtd->dai_link->compr_ops->set_params(cstream);
224
225	return soc_link_ret(rtd, ret);
226}
227EXPORT_SYMBOL_GPL(snd_soc_link_compr_set_params);