blob: cf34545f41085061ea05d271713d21a27b16bf76 [file] [log] [blame]
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +09001// SPDX-License-Identifier: GPL-2.0
2//
3// soc-component.c
4//
Kuninori Morimoto460b42d2020-06-04 17:08:03 +09005// Copyright 2009-2011 Wolfson Microelectronics PLC.
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +09006// Copyright (C) 2019 Renesas Electronics Corp.
Kuninori Morimoto460b42d2020-06-04 17:08:03 +09007//
8// Mark Brown <broonie@opensource.wolfsonmicro.com>
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +09009// Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
10//
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +090011#include <linux/module.h>
Kuninori Morimoto939a5cf2020-09-28 09:01:17 +090012#include <linux/pm_runtime.h>
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +090013#include <sound/soc.h>
14
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +090015#define soc_component_ret(dai, ret) _soc_component_ret(dai, __func__, ret)
16static inline int _soc_component_ret(struct snd_soc_component *component,
17 const char *func, int ret)
18{
19 /* Positive/Zero values are not errors */
20 if (ret >= 0)
21 return ret;
22
23 /* Negative values might be errors */
24 switch (ret) {
25 case -EPROBE_DEFER:
26 case -ENOTSUPP:
27 break;
28 default:
29 dev_err(component->dev,
30 "ASoC: error at %s on %s: %d\n",
31 func, component->name, ret);
32 }
33
34 return ret;
35}
36
Kuninori Morimoto51aff912020-09-28 09:01:04 +090037/*
38 * We might want to check substream by using list.
39 * In such case, we can update these macros.
40 */
41#define soc_component_mark_push(component, substream, tgt) ((component)->mark_##tgt = substream)
42#define soc_component_mark_pop(component, substream, tgt) ((component)->mark_##tgt = NULL)
43#define soc_component_mark_match(component, substream, tgt) ((component)->mark_##tgt == substream)
44
Kuninori Morimoto257c4da2020-06-04 17:07:54 +090045void snd_soc_component_set_aux(struct snd_soc_component *component,
46 struct snd_soc_aux_dev *aux)
47{
48 component->init = (aux) ? aux->init : NULL;
49}
50
51int snd_soc_component_init(struct snd_soc_component *component)
52{
53 int ret = 0;
54
55 if (component->init)
56 ret = component->init(component);
57
58 return soc_component_ret(component, ret);
59}
60
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +090061/**
62 * snd_soc_component_set_sysclk - configure COMPONENT system or master clock.
63 * @component: COMPONENT
64 * @clk_id: DAI specific clock ID
65 * @source: Source for the clock
66 * @freq: new clock frequency in Hz
67 * @dir: new clock direction - input/output.
68 *
69 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
70 */
71int snd_soc_component_set_sysclk(struct snd_soc_component *component,
72 int clk_id, int source, unsigned int freq,
73 int dir)
74{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +090075 int ret = -ENOTSUPP;
76
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +090077 if (component->driver->set_sysclk)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +090078 ret = component->driver->set_sysclk(component, clk_id, source,
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +090079 freq, dir);
80
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +090081 return soc_component_ret(component, ret);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +090082}
83EXPORT_SYMBOL_GPL(snd_soc_component_set_sysclk);
84
85/*
86 * snd_soc_component_set_pll - configure component PLL.
87 * @component: COMPONENT
88 * @pll_id: DAI specific PLL ID
89 * @source: DAI specific source for the PLL
90 * @freq_in: PLL input clock frequency in Hz
91 * @freq_out: requested PLL output clock frequency in Hz
92 *
93 * Configures and enables PLL to generate output clock based on input clock.
94 */
95int snd_soc_component_set_pll(struct snd_soc_component *component, int pll_id,
96 int source, unsigned int freq_in,
97 unsigned int freq_out)
98{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +090099 int ret = -EINVAL;
100
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900101 if (component->driver->set_pll)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900102 ret = component->driver->set_pll(component, pll_id, source,
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900103 freq_in, freq_out);
104
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900105 return soc_component_ret(component, ret);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900106}
107EXPORT_SYMBOL_GPL(snd_soc_component_set_pll);
108
Kuninori Morimoto9d415fb2019-07-26 13:51:35 +0900109void snd_soc_component_seq_notifier(struct snd_soc_component *component,
110 enum snd_soc_dapm_type type, int subseq)
111{
112 if (component->driver->seq_notifier)
113 component->driver->seq_notifier(component, type, subseq);
114}
115
Kuninori Morimoto8e2a9902019-07-26 13:51:39 +0900116int snd_soc_component_stream_event(struct snd_soc_component *component,
117 int event)
118{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900119 int ret = 0;
Kuninori Morimoto8e2a9902019-07-26 13:51:39 +0900120
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900121 if (component->driver->stream_event)
122 ret = component->driver->stream_event(component, event);
123
124 return soc_component_ret(component, ret);
Kuninori Morimoto8e2a9902019-07-26 13:51:39 +0900125}
126
Kuninori Morimoto7951b1462019-07-26 13:51:43 +0900127int snd_soc_component_set_bias_level(struct snd_soc_component *component,
128 enum snd_soc_bias_level level)
129{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900130 int ret = 0;
Kuninori Morimoto7951b1462019-07-26 13:51:43 +0900131
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900132 if (component->driver->set_bias_level)
133 ret = component->driver->set_bias_level(component, level);
134
135 return soc_component_ret(component, ret);
Kuninori Morimoto7951b1462019-07-26 13:51:43 +0900136}
137
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900138static int soc_component_pin(struct snd_soc_component *component,
139 const char *pin,
140 int (*pin_func)(struct snd_soc_dapm_context *dapm,
141 const char *pin))
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900142{
143 struct snd_soc_dapm_context *dapm =
144 snd_soc_component_get_dapm(component);
145 char *full_name;
146 int ret;
147
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900148 if (!component->name_prefix) {
149 ret = pin_func(dapm, pin);
150 goto end;
151 }
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900152
153 full_name = kasprintf(GFP_KERNEL, "%s %s", component->name_prefix, pin);
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900154 if (!full_name) {
155 ret = -ENOMEM;
156 goto end;
157 }
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900158
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900159 ret = pin_func(dapm, full_name);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900160 kfree(full_name);
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900161end:
162 return soc_component_ret(component, ret);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900163}
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900164
165int snd_soc_component_enable_pin(struct snd_soc_component *component,
166 const char *pin)
167{
168 return soc_component_pin(component, pin, snd_soc_dapm_enable_pin);
169}
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900170EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin);
171
172int snd_soc_component_enable_pin_unlocked(struct snd_soc_component *component,
173 const char *pin)
174{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900175 return soc_component_pin(component, pin, snd_soc_dapm_enable_pin_unlocked);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900176}
177EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin_unlocked);
178
179int snd_soc_component_disable_pin(struct snd_soc_component *component,
180 const char *pin)
181{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900182 return soc_component_pin(component, pin, snd_soc_dapm_disable_pin);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900183}
184EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin);
185
186int snd_soc_component_disable_pin_unlocked(struct snd_soc_component *component,
187 const char *pin)
188{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900189 return soc_component_pin(component, pin, snd_soc_dapm_disable_pin_unlocked);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900190}
191EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin_unlocked);
192
193int snd_soc_component_nc_pin(struct snd_soc_component *component,
194 const char *pin)
195{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900196 return soc_component_pin(component, pin, snd_soc_dapm_nc_pin);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900197}
198EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin);
199
200int snd_soc_component_nc_pin_unlocked(struct snd_soc_component *component,
201 const char *pin)
202{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900203 return soc_component_pin(component, pin, snd_soc_dapm_nc_pin_unlocked);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900204}
205EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin_unlocked);
206
207int snd_soc_component_get_pin_status(struct snd_soc_component *component,
208 const char *pin)
209{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900210 return soc_component_pin(component, pin, snd_soc_dapm_get_pin_status);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900211}
212EXPORT_SYMBOL_GPL(snd_soc_component_get_pin_status);
213
214int snd_soc_component_force_enable_pin(struct snd_soc_component *component,
215 const char *pin)
216{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900217 return soc_component_pin(component, pin, snd_soc_dapm_force_enable_pin);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900218}
219EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin);
220
221int snd_soc_component_force_enable_pin_unlocked(
222 struct snd_soc_component *component,
223 const char *pin)
224{
Kuninori Morimoto4ca87012020-06-04 17:06:11 +0900225 return soc_component_pin(component, pin, snd_soc_dapm_force_enable_pin_unlocked);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900226}
227EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin_unlocked);
228
229/**
230 * snd_soc_component_set_jack - configure component jack.
231 * @component: COMPONENTs
232 * @jack: structure to use for the jack
233 * @data: can be used if codec driver need extra data for configuring jack
234 *
235 * Configures and enables jack detection function.
236 */
237int snd_soc_component_set_jack(struct snd_soc_component *component,
238 struct snd_soc_jack *jack, void *data)
239{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900240 int ret = -ENOTSUPP;
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900241
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900242 if (component->driver->set_jack)
243 ret = component->driver->set_jack(component, jack, data);
244
245 return soc_component_ret(component, ret);
Kuninori Morimoto4ff1fef2019-07-26 13:49:48 +0900246}
247EXPORT_SYMBOL_GPL(snd_soc_component_set_jack);
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900248
249int snd_soc_component_module_get(struct snd_soc_component *component,
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900250 struct snd_pcm_substream *substream,
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900251 int upon_open)
252{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900253 int ret = 0;
254
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900255 if (component->driver->module_get_upon_open == !!upon_open &&
256 !try_module_get(component->dev->driver->owner))
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900257 ret = -ENODEV;
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900258
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900259 /* mark substream if succeeded */
260 if (ret == 0)
261 soc_component_mark_push(component, substream, module);
262
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900263 return soc_component_ret(component, ret);
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900264}
265
266void snd_soc_component_module_put(struct snd_soc_component *component,
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900267 struct snd_pcm_substream *substream,
268 int upon_open, int rollback)
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900269{
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900270 if (rollback && !soc_component_mark_match(component, substream, module))
271 return;
272
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900273 if (component->driver->module_get_upon_open == !!upon_open)
274 module_put(component->dev->driver->owner);
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900275
276 /* remove marked substream */
277 soc_component_mark_pop(component, substream, module);
Kuninori Morimoto4a81e8f2019-07-26 13:49:54 +0900278}
Kuninori Morimotoae2f4842019-07-26 13:50:01 +0900279
280int snd_soc_component_open(struct snd_soc_component *component,
281 struct snd_pcm_substream *substream)
282{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900283 int ret = 0;
284
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900285 if (component->driver->open)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900286 ret = component->driver->open(component, substream);
287
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900288 /* mark substream if succeeded */
289 if (ret == 0)
290 soc_component_mark_push(component, substream, open);
291
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900292 return soc_component_ret(component, ret);
Kuninori Morimotoae2f4842019-07-26 13:50:01 +0900293}
Kuninori Morimoto3672beb2019-07-26 13:50:07 +0900294
295int snd_soc_component_close(struct snd_soc_component *component,
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900296 struct snd_pcm_substream *substream,
297 int rollback)
Kuninori Morimoto3672beb2019-07-26 13:50:07 +0900298{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900299 int ret = 0;
300
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900301 if (rollback && !soc_component_mark_match(component, substream, open))
302 return 0;
303
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900304 if (component->driver->close)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900305 ret = component->driver->close(component, substream);
306
Kuninori Morimoto51aff912020-09-28 09:01:04 +0900307 /* remove marked substream */
308 soc_component_mark_pop(component, substream, open);
309
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900310 return soc_component_ret(component, ret);
Kuninori Morimoto3672beb2019-07-26 13:50:07 +0900311}
Kuninori Morimoto6d537232019-07-26 13:50:13 +0900312
Kuninori Morimoto66c51572019-07-26 13:50:34 +0900313void snd_soc_component_suspend(struct snd_soc_component *component)
314{
315 if (component->driver->suspend)
316 component->driver->suspend(component);
317 component->suspended = 1;
318}
Kuninori Morimoto9a840cb2019-07-26 13:51:08 +0900319
320void snd_soc_component_resume(struct snd_soc_component *component)
321{
322 if (component->driver->resume)
323 component->driver->resume(component);
324 component->suspended = 0;
325}
Kuninori Morimotoe40fadb2019-07-26 13:51:13 +0900326
327int snd_soc_component_is_suspended(struct snd_soc_component *component)
328{
329 return component->suspended;
330}
Kuninori Morimoto08e837d2019-07-26 13:51:17 +0900331
332int snd_soc_component_probe(struct snd_soc_component *component)
333{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900334 int ret = 0;
Kuninori Morimoto08e837d2019-07-26 13:51:17 +0900335
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900336 if (component->driver->probe)
337 ret = component->driver->probe(component);
338
339 return soc_component_ret(component, ret);
Kuninori Morimoto08e837d2019-07-26 13:51:17 +0900340}
Kuninori Morimoto03b34dd2019-07-26 13:51:22 +0900341
342void snd_soc_component_remove(struct snd_soc_component *component)
343{
344 if (component->driver->remove)
345 component->driver->remove(component);
346}
Kuninori Morimoto2c7b1702019-07-26 13:51:26 +0900347
348int snd_soc_component_of_xlate_dai_id(struct snd_soc_component *component,
349 struct device_node *ep)
350{
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900351 int ret = -ENOTSUPP;
Kuninori Morimoto2c7b1702019-07-26 13:51:26 +0900352
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900353 if (component->driver->of_xlate_dai_id)
354 ret = component->driver->of_xlate_dai_id(component, ep);
355
356 return soc_component_ret(component, ret);
Kuninori Morimoto2c7b1702019-07-26 13:51:26 +0900357}
Kuninori Morimotoa2a34172019-07-26 13:51:31 +0900358
359int snd_soc_component_of_xlate_dai_name(struct snd_soc_component *component,
360 struct of_phandle_args *args,
361 const char **dai_name)
362{
363 if (component->driver->of_xlate_dai_name)
Jerome Brunetcc4d8ce2020-07-23 16:20:20 +0200364 return component->driver->of_xlate_dai_name(component,
365 args, dai_name);
366 /*
367 * Don't use soc_component_ret here because we may not want to report
368 * the error just yet. If a device has more than one component, the
369 * first may not match and we don't want spam the log with this.
370 */
371 return -ENOTSUPP;
Kuninori Morimotoa2a34172019-07-26 13:51:31 +0900372}
Kuninori Morimoto0035e252019-07-26 13:51:47 +0900373
Kuninori Morimotoc7d75b52020-06-04 17:06:22 +0900374void snd_soc_component_setup_regmap(struct snd_soc_component *component)
375{
376 int val_bytes = regmap_get_val_bytes(component->regmap);
377
378 /* Errors are legitimate for non-integer byte multiples */
379 if (val_bytes > 0)
380 component->val_bytes = val_bytes;
381}
382
383#ifdef CONFIG_REGMAP
384
385/**
386 * snd_soc_component_init_regmap() - Initialize regmap instance for the
387 * component
388 * @component: The component for which to initialize the regmap instance
389 * @regmap: The regmap instance that should be used by the component
390 *
391 * This function allows deferred assignment of the regmap instance that is
392 * associated with the component. Only use this if the regmap instance is not
393 * yet ready when the component is registered. The function must also be called
394 * before the first IO attempt of the component.
395 */
396void snd_soc_component_init_regmap(struct snd_soc_component *component,
397 struct regmap *regmap)
398{
399 component->regmap = regmap;
400 snd_soc_component_setup_regmap(component);
401}
402EXPORT_SYMBOL_GPL(snd_soc_component_init_regmap);
403
404/**
405 * snd_soc_component_exit_regmap() - De-initialize regmap instance for the
406 * component
407 * @component: The component for which to de-initialize the regmap instance
408 *
409 * Calls regmap_exit() on the regmap instance associated to the component and
410 * removes the regmap instance from the component.
411 *
412 * This function should only be used if snd_soc_component_init_regmap() was used
413 * to initialize the regmap instance.
414 */
415void snd_soc_component_exit_regmap(struct snd_soc_component *component)
416{
417 regmap_exit(component->regmap);
418 component->regmap = NULL;
419}
420EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
421
422#endif
423
Kuninori Morimotoa4e427c2020-11-13 13:15:20 +0900424int snd_soc_component_compr_open(struct snd_compr_stream *cstream,
425 struct snd_soc_component **last)
426{
427 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
428 struct snd_soc_component *component;
429 int i, ret;
430
431 for_each_rtd_components(rtd, i, component) {
432 if (component->driver->compress_ops &&
433 component->driver->compress_ops->open) {
434 ret = component->driver->compress_ops->open(component, cstream);
435 if (ret < 0) {
436 *last = component;
437 return soc_component_ret(component, ret);
438 }
439 }
440 }
441
442 *last = NULL;
443 return 0;
444}
445EXPORT_SYMBOL_GPL(snd_soc_component_compr_open);
446
Kuninori Morimotodbde5e212020-11-13 13:15:26 +0900447void snd_soc_component_compr_free(struct snd_compr_stream *cstream,
448 struct snd_soc_component *last)
449{
450 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
451 struct snd_soc_component *component;
452 int i;
453
454 for_each_rtd_components(rtd, i, component) {
455 if (component == last)
456 break;
457
458 if (component->driver->compress_ops &&
459 component->driver->compress_ops->free)
460 component->driver->compress_ops->free(component, cstream);
461 }
462}
463EXPORT_SYMBOL_GPL(snd_soc_component_compr_free);
464
Kuninori Morimoto08aee252020-11-13 13:15:33 +0900465int snd_soc_component_compr_trigger(struct snd_compr_stream *cstream, int cmd)
466{
467 struct snd_soc_pcm_runtime *rtd = cstream->private_data;
468 struct snd_soc_component *component;
469 int i, ret;
470
471 for_each_rtd_components(rtd, i, component) {
472 if (component->driver->compress_ops &&
473 component->driver->compress_ops->trigger) {
474 ret = component->driver->compress_ops->trigger(
475 component, cstream, cmd);
476 if (ret < 0)
477 return soc_component_ret(component, ret);
478 }
479 }
480
481 return 0;
482}
483EXPORT_SYMBOL_GPL(snd_soc_component_compr_trigger);
484
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900485static unsigned int soc_component_read_no_lock(
486 struct snd_soc_component *component,
487 unsigned int reg)
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900488{
489 int ret;
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900490 unsigned int val = 0;
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900491
492 if (component->regmap)
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900493 ret = regmap_read(component->regmap, reg, &val);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900494 else if (component->driver->read) {
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900495 ret = 0;
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900496 val = component->driver->read(component, reg);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900497 }
498 else
499 ret = -EIO;
500
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900501 if (ret < 0)
Takashi Iwaiefc913c2020-08-10 15:46:31 +0200502 return soc_component_ret(component, ret);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900503
504 return val;
505}
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900506
507/**
508 * snd_soc_component_read() - Read register value
509 * @component: Component to read from
510 * @reg: Register to read
511 *
512 * Return: read value
513 */
514unsigned int snd_soc_component_read(struct snd_soc_component *component,
515 unsigned int reg)
516{
517 unsigned int val;
518
519 mutex_lock(&component->io_mutex);
520 val = soc_component_read_no_lock(component, reg);
521 mutex_unlock(&component->io_mutex);
522
523 return val;
524}
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900525EXPORT_SYMBOL_GPL(snd_soc_component_read);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900526
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900527static int soc_component_write_no_lock(
528 struct snd_soc_component *component,
529 unsigned int reg, unsigned int val)
530{
531 int ret = -EIO;
532
533 if (component->regmap)
534 ret = regmap_write(component->regmap, reg, val);
535 else if (component->driver->write)
536 ret = component->driver->write(component, reg, val);
537
538 return soc_component_ret(component, ret);
539}
540
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900541/**
542 * snd_soc_component_write() - Write register value
543 * @component: Component to write to
544 * @reg: Register to write
545 * @val: Value to write to the register
546 *
547 * Return: 0 on success, a negative error code otherwise.
548 */
549int snd_soc_component_write(struct snd_soc_component *component,
550 unsigned int reg, unsigned int val)
551{
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900552 int ret;
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900553
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900554 mutex_lock(&component->io_mutex);
555 ret = soc_component_write_no_lock(component, reg, val);
556 mutex_unlock(&component->io_mutex);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900557
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900558 return ret;
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900559}
560EXPORT_SYMBOL_GPL(snd_soc_component_write);
561
562static int snd_soc_component_update_bits_legacy(
563 struct snd_soc_component *component, unsigned int reg,
564 unsigned int mask, unsigned int val, bool *change)
565{
566 unsigned int old, new;
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900567 int ret = 0;
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900568
569 mutex_lock(&component->io_mutex);
570
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900571 old = soc_component_read_no_lock(component, reg);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900572
573 new = (old & ~mask) | (val & mask);
574 *change = old != new;
575 if (*change)
Kuninori Morimotoe8712312020-06-16 14:19:52 +0900576 ret = soc_component_write_no_lock(component, reg, new);
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900577
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900578 mutex_unlock(&component->io_mutex);
579
580 return soc_component_ret(component, ret);
581}
582
583/**
584 * snd_soc_component_update_bits() - Perform read/modify/write cycle
585 * @component: Component to update
586 * @reg: Register to update
587 * @mask: Mask that specifies which bits to update
588 * @val: New value for the bits specified by mask
589 *
590 * Return: 1 if the operation was successful and the value of the register
591 * changed, 0 if the operation was successful, but the value did not change.
592 * Returns a negative error code otherwise.
593 */
594int snd_soc_component_update_bits(struct snd_soc_component *component,
595 unsigned int reg, unsigned int mask, unsigned int val)
596{
597 bool change;
598 int ret;
599
600 if (component->regmap)
601 ret = regmap_update_bits_check(component->regmap, reg, mask,
602 val, &change);
603 else
604 ret = snd_soc_component_update_bits_legacy(component, reg,
605 mask, val, &change);
606
607 if (ret < 0)
608 return soc_component_ret(component, ret);
609 return change;
610}
611EXPORT_SYMBOL_GPL(snd_soc_component_update_bits);
612
613/**
614 * snd_soc_component_update_bits_async() - Perform asynchronous
615 * read/modify/write cycle
616 * @component: Component to update
617 * @reg: Register to update
618 * @mask: Mask that specifies which bits to update
619 * @val: New value for the bits specified by mask
620 *
621 * This function is similar to snd_soc_component_update_bits(), but the update
622 * operation is scheduled asynchronously. This means it may not be completed
623 * when the function returns. To make sure that all scheduled updates have been
624 * completed snd_soc_component_async_complete() must be called.
625 *
626 * Return: 1 if the operation was successful and the value of the register
627 * changed, 0 if the operation was successful, but the value did not change.
628 * Returns a negative error code otherwise.
629 */
630int snd_soc_component_update_bits_async(struct snd_soc_component *component,
631 unsigned int reg, unsigned int mask, unsigned int val)
632{
633 bool change;
634 int ret;
635
636 if (component->regmap)
637 ret = regmap_update_bits_check_async(component->regmap, reg,
638 mask, val, &change);
639 else
640 ret = snd_soc_component_update_bits_legacy(component, reg,
641 mask, val, &change);
642
643 if (ret < 0)
644 return soc_component_ret(component, ret);
645 return change;
646}
647EXPORT_SYMBOL_GPL(snd_soc_component_update_bits_async);
648
649/**
650 * snd_soc_component_async_complete() - Ensure asynchronous I/O has completed
651 * @component: Component for which to wait
652 *
653 * This function blocks until all asynchronous I/O which has previously been
654 * scheduled using snd_soc_component_update_bits_async() has completed.
655 */
656void snd_soc_component_async_complete(struct snd_soc_component *component)
657{
658 if (component->regmap)
659 regmap_async_complete(component->regmap);
660}
661EXPORT_SYMBOL_GPL(snd_soc_component_async_complete);
662
663/**
664 * snd_soc_component_test_bits - Test register for change
665 * @component: component
666 * @reg: Register to test
667 * @mask: Mask that specifies which bits to test
668 * @value: Value to test against
669 *
670 * Tests a register with a new value and checks if the new value is
671 * different from the old value.
672 *
673 * Return: 1 for change, otherwise 0.
674 */
675int snd_soc_component_test_bits(struct snd_soc_component *component,
676 unsigned int reg, unsigned int mask, unsigned int value)
677{
678 unsigned int old, new;
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900679
Kuninori Morimotocf6e26c2020-06-16 14:19:41 +0900680 old = snd_soc_component_read(component, reg);
Kuninori Morimoto460b42d2020-06-04 17:08:03 +0900681 new = (old & ~mask) | value;
682 return old != new;
683}
684EXPORT_SYMBOL_GPL(snd_soc_component_test_bits);
685
Kuninori Morimoto0035e252019-07-26 13:51:47 +0900686int snd_soc_pcm_component_pointer(struct snd_pcm_substream *substream)
687{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900688 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto0035e252019-07-26 13:51:47 +0900689 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900690 int i;
Kuninori Morimoto0035e252019-07-26 13:51:47 +0900691
Kuninori Morimoto2b544dd2019-10-15 12:59:31 +0900692 /* FIXME: use 1st pointer */
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900693 for_each_rtd_components(rtd, i, component)
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900694 if (component->driver->pointer)
695 return component->driver->pointer(component, substream);
Kuninori Morimoto0035e252019-07-26 13:51:47 +0900696
697 return 0;
698}
Kuninori Morimoto96a47902019-07-26 13:51:51 +0900699
700int snd_soc_pcm_component_ioctl(struct snd_pcm_substream *substream,
701 unsigned int cmd, void *arg)
702{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900703 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto96a47902019-07-26 13:51:51 +0900704 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900705 int i;
Kuninori Morimoto96a47902019-07-26 13:51:51 +0900706
Kuninori Morimoto2b544dd2019-10-15 12:59:31 +0900707 /* FIXME: use 1st ioctl */
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900708 for_each_rtd_components(rtd, i, component)
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900709 if (component->driver->ioctl)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900710 return soc_component_ret(
711 component,
712 component->driver->ioctl(component,
713 substream, cmd, arg));
Kuninori Morimoto96a47902019-07-26 13:51:51 +0900714
715 return snd_pcm_lib_ioctl(substream, cmd, arg);
716}
Kuninori Morimoto82d81f52019-07-26 13:51:56 +0900717
Takashi Iwai1e5ddb62019-11-21 20:07:09 +0100718int snd_soc_pcm_component_sync_stop(struct snd_pcm_substream *substream)
719{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900720 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Takashi Iwai1e5ddb62019-11-21 20:07:09 +0100721 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900722 int i, ret;
Takashi Iwai1e5ddb62019-11-21 20:07:09 +0100723
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900724 for_each_rtd_components(rtd, i, component) {
Kuninori Morimotof1861a72020-02-28 10:48:35 +0900725 if (component->driver->sync_stop) {
Takashi Iwai1e5ddb62019-11-21 20:07:09 +0100726 ret = component->driver->sync_stop(component,
727 substream);
728 if (ret < 0)
Shengjiu Wangbe75db52020-07-16 13:07:08 +0800729 return soc_component_ret(component, ret);
Takashi Iwai1e5ddb62019-11-21 20:07:09 +0100730 }
731 }
732
733 return 0;
734}
735
Kuninori Morimoto82d81f52019-07-26 13:51:56 +0900736int snd_soc_pcm_component_copy_user(struct snd_pcm_substream *substream,
737 int channel, unsigned long pos,
738 void __user *buf, unsigned long bytes)
739{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900740 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto82d81f52019-07-26 13:51:56 +0900741 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900742 int i;
Kuninori Morimoto82d81f52019-07-26 13:51:56 +0900743
Kuninori Morimoto2b544dd2019-10-15 12:59:31 +0900744 /* FIXME. it returns 1st copy now */
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900745 for_each_rtd_components(rtd, i, component)
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900746 if (component->driver->copy_user)
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900747 return soc_component_ret(
748 component,
749 component->driver->copy_user(
750 component, substream, channel,
751 pos, buf, bytes));
Kuninori Morimoto82d81f52019-07-26 13:51:56 +0900752
753 return -EINVAL;
754}
Kuninori Morimoto9c712e42019-07-26 13:52:00 +0900755
756struct page *snd_soc_pcm_component_page(struct snd_pcm_substream *substream,
757 unsigned long offset)
758{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900759 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto9c712e42019-07-26 13:52:00 +0900760 struct snd_soc_component *component;
761 struct page *page;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900762 int i;
Kuninori Morimoto9c712e42019-07-26 13:52:00 +0900763
Kuninori Morimoto2b544dd2019-10-15 12:59:31 +0900764 /* FIXME. it returns 1st page now */
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900765 for_each_rtd_components(rtd, i, component) {
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900766 if (component->driver->page) {
767 page = component->driver->page(component,
768 substream, offset);
769 if (page)
770 return page;
771 }
Kuninori Morimoto9c712e42019-07-26 13:52:00 +0900772 }
773
774 return NULL;
775}
Kuninori Morimoto205875e2019-07-26 13:52:04 +0900776
777int snd_soc_pcm_component_mmap(struct snd_pcm_substream *substream,
778 struct vm_area_struct *vma)
779{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900780 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto205875e2019-07-26 13:52:04 +0900781 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900782 int i;
Kuninori Morimoto205875e2019-07-26 13:52:04 +0900783
Kuninori Morimoto2b544dd2019-10-15 12:59:31 +0900784 /* FIXME. it returns 1st mmap now */
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900785 for_each_rtd_components(rtd, i, component)
Kuninori Morimotoe2cb4a12019-10-02 14:30:48 +0900786 if (component->driver->mmap)
Shengjiu Wangbe75db52020-07-16 13:07:08 +0800787 return soc_component_ret(
Kuninori Morimotoe2329ee2020-06-04 17:06:41 +0900788 component,
789 component->driver->mmap(component,
790 substream, vma));
Kuninori Morimoto205875e2019-07-26 13:52:04 +0900791
792 return -EINVAL;
793}
Kuninori Morimoto74842912019-07-26 13:52:08 +0900794
Kuninori Morimotob2b2afb2019-11-18 10:50:32 +0900795int snd_soc_pcm_component_new(struct snd_soc_pcm_runtime *rtd)
Kuninori Morimoto74842912019-07-26 13:52:08 +0900796{
Kuninori Morimoto74842912019-07-26 13:52:08 +0900797 struct snd_soc_component *component;
798 int ret;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900799 int i;
Kuninori Morimoto74842912019-07-26 13:52:08 +0900800
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900801 for_each_rtd_components(rtd, i, component) {
Kuninori Morimotoc64bfc92019-10-02 14:30:59 +0900802 if (component->driver->pcm_construct) {
803 ret = component->driver->pcm_construct(component, rtd);
804 if (ret < 0)
Shengjiu Wangbe75db52020-07-16 13:07:08 +0800805 return soc_component_ret(component, ret);
Kuninori Morimotoc64bfc92019-10-02 14:30:59 +0900806 }
Kuninori Morimoto74842912019-07-26 13:52:08 +0900807 }
808
809 return 0;
810}
Kuninori Morimoto79776da2019-07-26 13:52:12 +0900811
Kuninori Morimotob2b2afb2019-11-18 10:50:32 +0900812void snd_soc_pcm_component_free(struct snd_soc_pcm_runtime *rtd)
Kuninori Morimoto79776da2019-07-26 13:52:12 +0900813{
Kuninori Morimoto79776da2019-07-26 13:52:12 +0900814 struct snd_soc_component *component;
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900815 int i;
Kuninori Morimoto79776da2019-07-26 13:52:12 +0900816
Takashi Iwai8e3366c2020-01-07 08:09:56 +0100817 if (!rtd->pcm)
818 return;
819
Kuninori Morimoto613fb502020-01-10 11:35:21 +0900820 for_each_rtd_components(rtd, i, component)
Kuninori Morimotoc64bfc92019-10-02 14:30:59 +0900821 if (component->driver->pcm_destruct)
Kuninori Morimotob2b2afb2019-11-18 10:50:32 +0900822 component->driver->pcm_destruct(component, rtd->pcm);
Kuninori Morimoto79776da2019-07-26 13:52:12 +0900823}
Kuninori Morimoto4f395142020-06-04 17:06:58 +0900824
825int snd_soc_pcm_component_prepare(struct snd_pcm_substream *substream)
826{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900827 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto4f395142020-06-04 17:06:58 +0900828 struct snd_soc_component *component;
829 int i, ret;
830
831 for_each_rtd_components(rtd, i, component) {
832 if (component->driver->prepare) {
833 ret = component->driver->prepare(component, substream);
834 if (ret < 0)
835 return soc_component_ret(component, ret);
836 }
837 }
838
839 return 0;
840}
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900841
842int snd_soc_pcm_component_hw_params(struct snd_pcm_substream *substream,
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900843 struct snd_pcm_hw_params *params)
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900844{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900845 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900846 struct snd_soc_component *component;
847 int i, ret;
848
849 for_each_rtd_components(rtd, i, component) {
850 if (component->driver->hw_params) {
851 ret = component->driver->hw_params(component,
852 substream, params);
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900853 if (ret < 0)
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900854 return soc_component_ret(component, ret);
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900855 }
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900856 /* mark substream if succeeded */
857 soc_component_mark_push(component, substream, hw_params);
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900858 }
859
Kuninori Morimotoe1bafa82020-06-04 17:07:11 +0900860 return 0;
861}
Kuninori Morimoto04751112020-06-04 17:07:24 +0900862
863void snd_soc_pcm_component_hw_free(struct snd_pcm_substream *substream,
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900864 int rollback)
Kuninori Morimoto04751112020-06-04 17:07:24 +0900865{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900866 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto04751112020-06-04 17:07:24 +0900867 struct snd_soc_component *component;
868 int i, ret;
869
870 for_each_rtd_components(rtd, i, component) {
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900871 if (rollback && !soc_component_mark_match(component, substream, hw_params))
872 continue;
Kuninori Morimoto04751112020-06-04 17:07:24 +0900873
874 if (component->driver->hw_free) {
875 ret = component->driver->hw_free(component, substream);
876 if (ret < 0)
877 soc_component_ret(component, ret);
878 }
Kuninori Morimoto3a36a642020-09-29 13:31:41 +0900879
880 /* remove marked substream */
881 soc_component_mark_pop(component, substream, hw_params);
Kuninori Morimoto04751112020-06-04 17:07:24 +0900882 }
883}
Kuninori Morimoto32fd1202020-06-04 17:07:40 +0900884
885int snd_soc_pcm_component_trigger(struct snd_pcm_substream *substream,
886 int cmd)
887{
Kuninori Morimoto0ceef682020-07-20 10:17:39 +0900888 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
Kuninori Morimoto32fd1202020-06-04 17:07:40 +0900889 struct snd_soc_component *component;
890 int i, ret;
891
892 for_each_rtd_components(rtd, i, component) {
893 if (component->driver->trigger) {
894 ret = component->driver->trigger(component, substream, cmd);
895 if (ret < 0)
896 return soc_component_ret(component, ret);
897 }
898 }
899
900 return 0;
901}
Kuninori Morimoto939a5cf2020-09-28 09:01:17 +0900902
903int snd_soc_pcm_component_pm_runtime_get(struct snd_soc_pcm_runtime *rtd,
904 void *stream)
905{
906 struct snd_soc_component *component;
907 int i, ret;
908
909 for_each_rtd_components(rtd, i, component) {
910 ret = pm_runtime_get_sync(component->dev);
911 if (ret < 0 && ret != -EACCES) {
912 pm_runtime_put_noidle(component->dev);
913 return soc_component_ret(component, ret);
914 }
915 /* mark stream if succeeded */
916 soc_component_mark_push(component, stream, pm);
917 }
918
919 return 0;
920}
921
922void snd_soc_pcm_component_pm_runtime_put(struct snd_soc_pcm_runtime *rtd,
923 void *stream, int rollback)
924{
925 struct snd_soc_component *component;
926 int i;
927
928 for_each_rtd_components(rtd, i, component) {
929 if (rollback && !soc_component_mark_match(component, stream, pm))
930 continue;
931
932 pm_runtime_mark_last_busy(component->dev);
933 pm_runtime_put_autosuspend(component->dev);
934
935 /* remove marked stream */
936 soc_component_mark_pop(component, stream, pm);
937 }
938}