Merge branch 'stable/for-linus-5.11' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6-microblaze.git] / sound / soc / soc-component.c
1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // soc-component.c
4 //
5 // Copyright 2009-2011 Wolfson Microelectronics PLC.
6 // Copyright (C) 2019 Renesas Electronics Corp.
7 //
8 // Mark Brown <broonie@opensource.wolfsonmicro.com>
9 // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
10 //
11 #include <linux/module.h>
12 #include <linux/pm_runtime.h>
13 #include <sound/soc.h>
14
15 #define soc_component_ret(dai, ret) _soc_component_ret(dai, __func__, ret)
16 static 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
37 /*
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
45 void 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
51 int 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
61 /**
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  */
71 int snd_soc_component_set_sysclk(struct snd_soc_component *component,
72                                  int clk_id, int source, unsigned int freq,
73                                  int dir)
74 {
75         int ret = -ENOTSUPP;
76
77         if (component->driver->set_sysclk)
78                 ret = component->driver->set_sysclk(component, clk_id, source,
79                                                      freq, dir);
80
81         return soc_component_ret(component, ret);
82 }
83 EXPORT_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  */
95 int 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 {
99         int ret = -EINVAL;
100
101         if (component->driver->set_pll)
102                 ret = component->driver->set_pll(component, pll_id, source,
103                                                   freq_in, freq_out);
104
105         return soc_component_ret(component, ret);
106 }
107 EXPORT_SYMBOL_GPL(snd_soc_component_set_pll);
108
109 void 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
116 int snd_soc_component_stream_event(struct snd_soc_component *component,
117                                    int event)
118 {
119         int ret = 0;
120
121         if (component->driver->stream_event)
122                 ret = component->driver->stream_event(component, event);
123
124         return soc_component_ret(component, ret);
125 }
126
127 int snd_soc_component_set_bias_level(struct snd_soc_component *component,
128                                      enum snd_soc_bias_level level)
129 {
130         int ret = 0;
131
132         if (component->driver->set_bias_level)
133                 ret = component->driver->set_bias_level(component, level);
134
135         return soc_component_ret(component, ret);
136 }
137
138 static 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))
142 {
143         struct snd_soc_dapm_context *dapm =
144                 snd_soc_component_get_dapm(component);
145         char *full_name;
146         int ret;
147
148         if (!component->name_prefix) {
149                 ret = pin_func(dapm, pin);
150                 goto end;
151         }
152
153         full_name = kasprintf(GFP_KERNEL, "%s %s", component->name_prefix, pin);
154         if (!full_name) {
155                 ret = -ENOMEM;
156                 goto end;
157         }
158
159         ret = pin_func(dapm, full_name);
160         kfree(full_name);
161 end:
162         return soc_component_ret(component, ret);
163 }
164
165 int 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 }
170 EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin);
171
172 int snd_soc_component_enable_pin_unlocked(struct snd_soc_component *component,
173                                           const char *pin)
174 {
175         return soc_component_pin(component, pin, snd_soc_dapm_enable_pin_unlocked);
176 }
177 EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin_unlocked);
178
179 int snd_soc_component_disable_pin(struct snd_soc_component *component,
180                                   const char *pin)
181 {
182         return soc_component_pin(component, pin, snd_soc_dapm_disable_pin);
183 }
184 EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin);
185
186 int snd_soc_component_disable_pin_unlocked(struct snd_soc_component *component,
187                                            const char *pin)
188 {
189         return soc_component_pin(component, pin, snd_soc_dapm_disable_pin_unlocked);
190 }
191 EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin_unlocked);
192
193 int snd_soc_component_nc_pin(struct snd_soc_component *component,
194                              const char *pin)
195 {
196         return soc_component_pin(component, pin, snd_soc_dapm_nc_pin);
197 }
198 EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin);
199
200 int snd_soc_component_nc_pin_unlocked(struct snd_soc_component *component,
201                                       const char *pin)
202 {
203         return soc_component_pin(component, pin, snd_soc_dapm_nc_pin_unlocked);
204 }
205 EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin_unlocked);
206
207 int snd_soc_component_get_pin_status(struct snd_soc_component *component,
208                                      const char *pin)
209 {
210         return soc_component_pin(component, pin, snd_soc_dapm_get_pin_status);
211 }
212 EXPORT_SYMBOL_GPL(snd_soc_component_get_pin_status);
213
214 int snd_soc_component_force_enable_pin(struct snd_soc_component *component,
215                                        const char *pin)
216 {
217         return soc_component_pin(component, pin, snd_soc_dapm_force_enable_pin);
218 }
219 EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin);
220
221 int snd_soc_component_force_enable_pin_unlocked(
222         struct snd_soc_component *component,
223         const char *pin)
224 {
225         return soc_component_pin(component, pin, snd_soc_dapm_force_enable_pin_unlocked);
226 }
227 EXPORT_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  */
237 int snd_soc_component_set_jack(struct snd_soc_component *component,
238                                struct snd_soc_jack *jack, void *data)
239 {
240         int ret = -ENOTSUPP;
241
242         if (component->driver->set_jack)
243                 ret = component->driver->set_jack(component, jack, data);
244
245         return soc_component_ret(component, ret);
246 }
247 EXPORT_SYMBOL_GPL(snd_soc_component_set_jack);
248
249 int snd_soc_component_module_get(struct snd_soc_component *component,
250                                  struct snd_pcm_substream *substream,
251                                  int upon_open)
252 {
253         int ret = 0;
254
255         if (component->driver->module_get_upon_open == !!upon_open &&
256             !try_module_get(component->dev->driver->owner))
257                 ret = -ENODEV;
258
259         /* mark substream if succeeded */
260         if (ret == 0)
261                 soc_component_mark_push(component, substream, module);
262
263         return soc_component_ret(component, ret);
264 }
265
266 void snd_soc_component_module_put(struct snd_soc_component *component,
267                                   struct snd_pcm_substream *substream,
268                                   int upon_open, int rollback)
269 {
270         if (rollback && !soc_component_mark_match(component, substream, module))
271                 return;
272
273         if (component->driver->module_get_upon_open == !!upon_open)
274                 module_put(component->dev->driver->owner);
275
276         /* remove marked substream */
277         soc_component_mark_pop(component, substream, module);
278 }
279
280 int snd_soc_component_open(struct snd_soc_component *component,
281                            struct snd_pcm_substream *substream)
282 {
283         int ret = 0;
284
285         if (component->driver->open)
286                 ret = component->driver->open(component, substream);
287
288         /* mark substream if succeeded */
289         if (ret == 0)
290                 soc_component_mark_push(component, substream, open);
291
292         return soc_component_ret(component, ret);
293 }
294
295 int snd_soc_component_close(struct snd_soc_component *component,
296                             struct snd_pcm_substream *substream,
297                             int rollback)
298 {
299         int ret = 0;
300
301         if (rollback && !soc_component_mark_match(component, substream, open))
302                 return 0;
303
304         if (component->driver->close)
305                 ret = component->driver->close(component, substream);
306
307         /* remove marked substream */
308         soc_component_mark_pop(component, substream, open);
309
310         return soc_component_ret(component, ret);
311 }
312
313 void 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 }
319
320 void 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 }
326
327 int snd_soc_component_is_suspended(struct snd_soc_component *component)
328 {
329         return component->suspended;
330 }
331
332 int snd_soc_component_probe(struct snd_soc_component *component)
333 {
334         int ret = 0;
335
336         if (component->driver->probe)
337                 ret = component->driver->probe(component);
338
339         return soc_component_ret(component, ret);
340 }
341
342 void snd_soc_component_remove(struct snd_soc_component *component)
343 {
344         if (component->driver->remove)
345                 component->driver->remove(component);
346 }
347
348 int snd_soc_component_of_xlate_dai_id(struct snd_soc_component *component,
349                                       struct device_node *ep)
350 {
351         int ret = -ENOTSUPP;
352
353         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);
357 }
358
359 int 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)
364                 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;
372 }
373
374 void 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  */
396 void 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 }
402 EXPORT_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  */
415 void snd_soc_component_exit_regmap(struct snd_soc_component *component)
416 {
417         regmap_exit(component->regmap);
418         component->regmap = NULL;
419 }
420 EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
421
422 #endif
423
424 int snd_soc_component_compr_open(struct snd_compr_stream *cstream)
425 {
426         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
427         struct snd_soc_component *component;
428         int i, ret;
429
430         for_each_rtd_components(rtd, i, component) {
431                 if (component->driver->compress_ops &&
432                     component->driver->compress_ops->open) {
433                         ret = component->driver->compress_ops->open(component, cstream);
434                         if (ret < 0)
435                                 return soc_component_ret(component, ret);
436                 }
437                 soc_component_mark_push(component, cstream, compr_open);
438         }
439
440         return 0;
441 }
442 EXPORT_SYMBOL_GPL(snd_soc_component_compr_open);
443
444 void snd_soc_component_compr_free(struct snd_compr_stream *cstream,
445                                   int rollback)
446 {
447         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
448         struct snd_soc_component *component;
449         int i;
450
451         for_each_rtd_components(rtd, i, component) {
452                 if (rollback && !soc_component_mark_match(component, cstream, compr_open))
453                         continue;
454
455                 if (component->driver->compress_ops &&
456                     component->driver->compress_ops->free)
457                         component->driver->compress_ops->free(component, cstream);
458
459                 soc_component_mark_pop(component, cstream, compr_open);
460         }
461 }
462 EXPORT_SYMBOL_GPL(snd_soc_component_compr_free);
463
464 int snd_soc_component_compr_trigger(struct snd_compr_stream *cstream, int cmd)
465 {
466         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
467         struct snd_soc_component *component;
468         int i, ret;
469
470         for_each_rtd_components(rtd, i, component) {
471                 if (component->driver->compress_ops &&
472                     component->driver->compress_ops->trigger) {
473                         ret = component->driver->compress_ops->trigger(
474                                 component, cstream, cmd);
475                         if (ret < 0)
476                                 return soc_component_ret(component, ret);
477                 }
478         }
479
480         return 0;
481 }
482 EXPORT_SYMBOL_GPL(snd_soc_component_compr_trigger);
483
484 int snd_soc_component_compr_set_params(struct snd_compr_stream *cstream,
485                                        struct snd_compr_params *params)
486 {
487         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
488         struct snd_soc_component *component;
489         int i, ret;
490
491         for_each_rtd_components(rtd, i, component) {
492                 if (component->driver->compress_ops &&
493                     component->driver->compress_ops->set_params) {
494                         ret = component->driver->compress_ops->set_params(
495                                 component, cstream, params);
496                         if (ret < 0)
497                                 return soc_component_ret(component, ret);
498                 }
499         }
500
501         return 0;
502 }
503 EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_params);
504
505 int snd_soc_component_compr_get_params(struct snd_compr_stream *cstream,
506                                        struct snd_codec *params)
507 {
508         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
509         struct snd_soc_component *component;
510         int i, ret;
511
512         for_each_rtd_components(rtd, i, component) {
513                 if (component->driver->compress_ops &&
514                     component->driver->compress_ops->get_params) {
515                         ret = component->driver->compress_ops->get_params(
516                                 component, cstream, params);
517                         return soc_component_ret(component, ret);
518                 }
519         }
520
521         return 0;
522 }
523 EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_params);
524
525 int snd_soc_component_compr_get_caps(struct snd_compr_stream *cstream,
526                                      struct snd_compr_caps *caps)
527 {
528         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
529         struct snd_soc_component *component;
530         int i, ret = 0;
531
532         mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
533
534         for_each_rtd_components(rtd, i, component) {
535                 if (component->driver->compress_ops &&
536                     component->driver->compress_ops->get_caps) {
537                         ret = component->driver->compress_ops->get_caps(
538                                 component, cstream, caps);
539                         break;
540                 }
541         }
542
543         mutex_unlock(&rtd->card->pcm_mutex);
544
545         return soc_component_ret(component, ret);
546 }
547 EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_caps);
548
549 int snd_soc_component_compr_get_codec_caps(struct snd_compr_stream *cstream,
550                                            struct snd_compr_codec_caps *codec)
551 {
552         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
553         struct snd_soc_component *component;
554         int i, ret = 0;
555
556         mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
557
558         for_each_rtd_components(rtd, i, component) {
559                 if (component->driver->compress_ops &&
560                     component->driver->compress_ops->get_codec_caps) {
561                         ret = component->driver->compress_ops->get_codec_caps(
562                                 component, cstream, codec);
563                         break;
564                 }
565         }
566
567         mutex_unlock(&rtd->card->pcm_mutex);
568
569         return soc_component_ret(component, ret);
570 }
571 EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_codec_caps);
572
573 int snd_soc_component_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
574 {
575         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
576         struct snd_soc_component *component;
577         int i, ret;
578
579         for_each_rtd_components(rtd, i, component) {
580                 if (component->driver->compress_ops &&
581                     component->driver->compress_ops->ack) {
582                         ret = component->driver->compress_ops->ack(
583                                 component, cstream, bytes);
584                         if (ret < 0)
585                                 return soc_component_ret(component, ret);
586                 }
587         }
588
589         return 0;
590 }
591 EXPORT_SYMBOL_GPL(snd_soc_component_compr_ack);
592
593 int snd_soc_component_compr_pointer(struct snd_compr_stream *cstream,
594                                     struct snd_compr_tstamp *tstamp)
595 {
596         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
597         struct snd_soc_component *component;
598         int i, ret;
599
600         for_each_rtd_components(rtd, i, component) {
601                 if (component->driver->compress_ops &&
602                     component->driver->compress_ops->pointer) {
603                         ret = component->driver->compress_ops->pointer(
604                                 component, cstream, tstamp);
605                         return soc_component_ret(component, ret);
606                 }
607         }
608
609         return 0;
610 }
611 EXPORT_SYMBOL_GPL(snd_soc_component_compr_pointer);
612
613 int snd_soc_component_compr_copy(struct snd_compr_stream *cstream,
614                                  char __user *buf, size_t count)
615 {
616         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
617         struct snd_soc_component *component;
618         int i, ret = 0;
619
620         mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
621
622         for_each_rtd_components(rtd, i, component) {
623                 if (component->driver->compress_ops &&
624                     component->driver->compress_ops->copy) {
625                         ret = component->driver->compress_ops->copy(
626                                 component, cstream, buf, count);
627                         break;
628                 }
629         }
630
631         mutex_unlock(&rtd->card->pcm_mutex);
632
633         return soc_component_ret(component, ret);
634 }
635 EXPORT_SYMBOL_GPL(snd_soc_component_compr_copy);
636
637 int snd_soc_component_compr_set_metadata(struct snd_compr_stream *cstream,
638                                          struct snd_compr_metadata *metadata)
639 {
640         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
641         struct snd_soc_component *component;
642         int i, ret;
643
644         for_each_rtd_components(rtd, i, component) {
645                 if (component->driver->compress_ops &&
646                     component->driver->compress_ops->set_metadata) {
647                         ret = component->driver->compress_ops->set_metadata(
648                                 component, cstream, metadata);
649                         if (ret < 0)
650                                 return soc_component_ret(component, ret);
651                 }
652         }
653
654         return 0;
655 }
656 EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_metadata);
657
658 int snd_soc_component_compr_get_metadata(struct snd_compr_stream *cstream,
659                                          struct snd_compr_metadata *metadata)
660 {
661         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
662         struct snd_soc_component *component;
663         int i, ret;
664
665         for_each_rtd_components(rtd, i, component) {
666                 if (component->driver->compress_ops &&
667                     component->driver->compress_ops->get_metadata) {
668                         ret = component->driver->compress_ops->get_metadata(
669                                 component, cstream, metadata);
670                         return soc_component_ret(component, ret);
671                 }
672         }
673
674         return 0;
675 }
676 EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_metadata);
677
678 static unsigned int soc_component_read_no_lock(
679         struct snd_soc_component *component,
680         unsigned int reg)
681 {
682         int ret;
683         unsigned int val = 0;
684
685         if (component->regmap)
686                 ret = regmap_read(component->regmap, reg, &val);
687         else if (component->driver->read) {
688                 ret = 0;
689                 val = component->driver->read(component, reg);
690         }
691         else
692                 ret = -EIO;
693
694         if (ret < 0)
695                 return soc_component_ret(component, ret);
696
697         return val;
698 }
699
700 /**
701  * snd_soc_component_read() - Read register value
702  * @component: Component to read from
703  * @reg: Register to read
704  *
705  * Return: read value
706  */
707 unsigned int snd_soc_component_read(struct snd_soc_component *component,
708                                     unsigned int reg)
709 {
710         unsigned int val;
711
712         mutex_lock(&component->io_mutex);
713         val = soc_component_read_no_lock(component, reg);
714         mutex_unlock(&component->io_mutex);
715
716         return val;
717 }
718 EXPORT_SYMBOL_GPL(snd_soc_component_read);
719
720 static int soc_component_write_no_lock(
721         struct snd_soc_component *component,
722         unsigned int reg, unsigned int val)
723 {
724         int ret = -EIO;
725
726         if (component->regmap)
727                 ret = regmap_write(component->regmap, reg, val);
728         else if (component->driver->write)
729                 ret = component->driver->write(component, reg, val);
730
731         return soc_component_ret(component, ret);
732 }
733
734 /**
735  * snd_soc_component_write() - Write register value
736  * @component: Component to write to
737  * @reg: Register to write
738  * @val: Value to write to the register
739  *
740  * Return: 0 on success, a negative error code otherwise.
741  */
742 int snd_soc_component_write(struct snd_soc_component *component,
743                             unsigned int reg, unsigned int val)
744 {
745         int ret;
746
747         mutex_lock(&component->io_mutex);
748         ret = soc_component_write_no_lock(component, reg, val);
749         mutex_unlock(&component->io_mutex);
750
751         return ret;
752 }
753 EXPORT_SYMBOL_GPL(snd_soc_component_write);
754
755 static int snd_soc_component_update_bits_legacy(
756         struct snd_soc_component *component, unsigned int reg,
757         unsigned int mask, unsigned int val, bool *change)
758 {
759         unsigned int old, new;
760         int ret = 0;
761
762         mutex_lock(&component->io_mutex);
763
764         old = soc_component_read_no_lock(component, reg);
765
766         new = (old & ~mask) | (val & mask);
767         *change = old != new;
768         if (*change)
769                 ret = soc_component_write_no_lock(component, reg, new);
770
771         mutex_unlock(&component->io_mutex);
772
773         return soc_component_ret(component, ret);
774 }
775
776 /**
777  * snd_soc_component_update_bits() - Perform read/modify/write cycle
778  * @component: Component to update
779  * @reg: Register to update
780  * @mask: Mask that specifies which bits to update
781  * @val: New value for the bits specified by mask
782  *
783  * Return: 1 if the operation was successful and the value of the register
784  * changed, 0 if the operation was successful, but the value did not change.
785  * Returns a negative error code otherwise.
786  */
787 int snd_soc_component_update_bits(struct snd_soc_component *component,
788                                   unsigned int reg, unsigned int mask, unsigned int val)
789 {
790         bool change;
791         int ret;
792
793         if (component->regmap)
794                 ret = regmap_update_bits_check(component->regmap, reg, mask,
795                                                val, &change);
796         else
797                 ret = snd_soc_component_update_bits_legacy(component, reg,
798                                                            mask, val, &change);
799
800         if (ret < 0)
801                 return soc_component_ret(component, ret);
802         return change;
803 }
804 EXPORT_SYMBOL_GPL(snd_soc_component_update_bits);
805
806 /**
807  * snd_soc_component_update_bits_async() - Perform asynchronous
808  *  read/modify/write cycle
809  * @component: Component to update
810  * @reg: Register to update
811  * @mask: Mask that specifies which bits to update
812  * @val: New value for the bits specified by mask
813  *
814  * This function is similar to snd_soc_component_update_bits(), but the update
815  * operation is scheduled asynchronously. This means it may not be completed
816  * when the function returns. To make sure that all scheduled updates have been
817  * completed snd_soc_component_async_complete() must be called.
818  *
819  * Return: 1 if the operation was successful and the value of the register
820  * changed, 0 if the operation was successful, but the value did not change.
821  * Returns a negative error code otherwise.
822  */
823 int snd_soc_component_update_bits_async(struct snd_soc_component *component,
824                                         unsigned int reg, unsigned int mask, unsigned int val)
825 {
826         bool change;
827         int ret;
828
829         if (component->regmap)
830                 ret = regmap_update_bits_check_async(component->regmap, reg,
831                                                      mask, val, &change);
832         else
833                 ret = snd_soc_component_update_bits_legacy(component, reg,
834                                                            mask, val, &change);
835
836         if (ret < 0)
837                 return soc_component_ret(component, ret);
838         return change;
839 }
840 EXPORT_SYMBOL_GPL(snd_soc_component_update_bits_async);
841
842 /**
843  * snd_soc_component_async_complete() - Ensure asynchronous I/O has completed
844  * @component: Component for which to wait
845  *
846  * This function blocks until all asynchronous I/O which has previously been
847  * scheduled using snd_soc_component_update_bits_async() has completed.
848  */
849 void snd_soc_component_async_complete(struct snd_soc_component *component)
850 {
851         if (component->regmap)
852                 regmap_async_complete(component->regmap);
853 }
854 EXPORT_SYMBOL_GPL(snd_soc_component_async_complete);
855
856 /**
857  * snd_soc_component_test_bits - Test register for change
858  * @component: component
859  * @reg: Register to test
860  * @mask: Mask that specifies which bits to test
861  * @value: Value to test against
862  *
863  * Tests a register with a new value and checks if the new value is
864  * different from the old value.
865  *
866  * Return: 1 for change, otherwise 0.
867  */
868 int snd_soc_component_test_bits(struct snd_soc_component *component,
869                                 unsigned int reg, unsigned int mask, unsigned int value)
870 {
871         unsigned int old, new;
872
873         old = snd_soc_component_read(component, reg);
874         new = (old & ~mask) | value;
875         return old != new;
876 }
877 EXPORT_SYMBOL_GPL(snd_soc_component_test_bits);
878
879 int snd_soc_pcm_component_pointer(struct snd_pcm_substream *substream)
880 {
881         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
882         struct snd_soc_component *component;
883         int i;
884
885         /* FIXME: use 1st pointer */
886         for_each_rtd_components(rtd, i, component)
887                 if (component->driver->pointer)
888                         return component->driver->pointer(component, substream);
889
890         return 0;
891 }
892
893 int snd_soc_pcm_component_ioctl(struct snd_pcm_substream *substream,
894                                 unsigned int cmd, void *arg)
895 {
896         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
897         struct snd_soc_component *component;
898         int i;
899
900         /* FIXME: use 1st ioctl */
901         for_each_rtd_components(rtd, i, component)
902                 if (component->driver->ioctl)
903                         return soc_component_ret(
904                                 component,
905                                 component->driver->ioctl(component,
906                                                          substream, cmd, arg));
907
908         return snd_pcm_lib_ioctl(substream, cmd, arg);
909 }
910
911 int snd_soc_pcm_component_sync_stop(struct snd_pcm_substream *substream)
912 {
913         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
914         struct snd_soc_component *component;
915         int i, ret;
916
917         for_each_rtd_components(rtd, i, component) {
918                 if (component->driver->sync_stop) {
919                         ret = component->driver->sync_stop(component,
920                                                            substream);
921                         if (ret < 0)
922                                 return soc_component_ret(component, ret);
923                 }
924         }
925
926         return 0;
927 }
928
929 int snd_soc_pcm_component_copy_user(struct snd_pcm_substream *substream,
930                                     int channel, unsigned long pos,
931                                     void __user *buf, unsigned long bytes)
932 {
933         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
934         struct snd_soc_component *component;
935         int i;
936
937         /* FIXME. it returns 1st copy now */
938         for_each_rtd_components(rtd, i, component)
939                 if (component->driver->copy_user)
940                         return soc_component_ret(
941                                 component,
942                                 component->driver->copy_user(
943                                         component, substream, channel,
944                                         pos, buf, bytes));
945
946         return -EINVAL;
947 }
948
949 struct page *snd_soc_pcm_component_page(struct snd_pcm_substream *substream,
950                                         unsigned long offset)
951 {
952         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
953         struct snd_soc_component *component;
954         struct page *page;
955         int i;
956
957         /* FIXME. it returns 1st page now */
958         for_each_rtd_components(rtd, i, component) {
959                 if (component->driver->page) {
960                         page = component->driver->page(component,
961                                                        substream, offset);
962                         if (page)
963                                 return page;
964                 }
965         }
966
967         return NULL;
968 }
969
970 int snd_soc_pcm_component_mmap(struct snd_pcm_substream *substream,
971                                struct vm_area_struct *vma)
972 {
973         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
974         struct snd_soc_component *component;
975         int i;
976
977         /* FIXME. it returns 1st mmap now */
978         for_each_rtd_components(rtd, i, component)
979                 if (component->driver->mmap)
980                         return soc_component_ret(
981                                 component,
982                                 component->driver->mmap(component,
983                                                         substream, vma));
984
985         return -EINVAL;
986 }
987
988 int snd_soc_pcm_component_new(struct snd_soc_pcm_runtime *rtd)
989 {
990         struct snd_soc_component *component;
991         int ret;
992         int i;
993
994         for_each_rtd_components(rtd, i, component) {
995                 if (component->driver->pcm_construct) {
996                         ret = component->driver->pcm_construct(component, rtd);
997                         if (ret < 0)
998                                 return soc_component_ret(component, ret);
999                 }
1000         }
1001
1002         return 0;
1003 }
1004
1005 void snd_soc_pcm_component_free(struct snd_soc_pcm_runtime *rtd)
1006 {
1007         struct snd_soc_component *component;
1008         int i;
1009
1010         if (!rtd->pcm)
1011                 return;
1012
1013         for_each_rtd_components(rtd, i, component)
1014                 if (component->driver->pcm_destruct)
1015                         component->driver->pcm_destruct(component, rtd->pcm);
1016 }
1017
1018 int snd_soc_pcm_component_prepare(struct snd_pcm_substream *substream)
1019 {
1020         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1021         struct snd_soc_component *component;
1022         int i, ret;
1023
1024         for_each_rtd_components(rtd, i, component) {
1025                 if (component->driver->prepare) {
1026                         ret = component->driver->prepare(component, substream);
1027                         if (ret < 0)
1028                                 return soc_component_ret(component, ret);
1029                 }
1030         }
1031
1032         return 0;
1033 }
1034
1035 int snd_soc_pcm_component_hw_params(struct snd_pcm_substream *substream,
1036                                     struct snd_pcm_hw_params *params)
1037 {
1038         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1039         struct snd_soc_component *component;
1040         int i, ret;
1041
1042         for_each_rtd_components(rtd, i, component) {
1043                 if (component->driver->hw_params) {
1044                         ret = component->driver->hw_params(component,
1045                                                            substream, params);
1046                         if (ret < 0)
1047                                 return soc_component_ret(component, ret);
1048                 }
1049                 /* mark substream if succeeded */
1050                 soc_component_mark_push(component, substream, hw_params);
1051         }
1052
1053         return 0;
1054 }
1055
1056 void snd_soc_pcm_component_hw_free(struct snd_pcm_substream *substream,
1057                                    int rollback)
1058 {
1059         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1060         struct snd_soc_component *component;
1061         int i, ret;
1062
1063         for_each_rtd_components(rtd, i, component) {
1064                 if (rollback && !soc_component_mark_match(component, substream, hw_params))
1065                         continue;
1066
1067                 if (component->driver->hw_free) {
1068                         ret = component->driver->hw_free(component, substream);
1069                         if (ret < 0)
1070                                 soc_component_ret(component, ret);
1071                 }
1072
1073                 /* remove marked substream */
1074                 soc_component_mark_pop(component, substream, hw_params);
1075         }
1076 }
1077
1078 static int soc_component_trigger(struct snd_soc_component *component,
1079                                  struct snd_pcm_substream *substream,
1080                                  int cmd)
1081 {
1082         int ret = 0;
1083
1084         if (component->driver->trigger)
1085                 ret = component->driver->trigger(component, substream, cmd);
1086
1087         return soc_component_ret(component, ret);
1088 }
1089
1090 int snd_soc_pcm_component_trigger(struct snd_pcm_substream *substream,
1091                                   int cmd, int rollback)
1092 {
1093         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1094         struct snd_soc_component *component;
1095         int i, r, ret = 0;
1096
1097         switch (cmd) {
1098         case SNDRV_PCM_TRIGGER_START:
1099         case SNDRV_PCM_TRIGGER_RESUME:
1100         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1101                 for_each_rtd_components(rtd, i, component) {
1102                         ret = soc_component_trigger(component, substream, cmd);
1103                         if (ret < 0)
1104                                 break;
1105                         soc_component_mark_push(component, substream, trigger);
1106                 }
1107                 break;
1108         case SNDRV_PCM_TRIGGER_STOP:
1109         case SNDRV_PCM_TRIGGER_SUSPEND:
1110         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1111                 for_each_rtd_components(rtd, i, component) {
1112                         if (rollback && !soc_component_mark_match(component, substream, trigger))
1113                                 continue;
1114
1115                         r = soc_component_trigger(component, substream, cmd);
1116                         if (r < 0)
1117                                 ret = r; /* use last ret */
1118                         soc_component_mark_pop(component, substream, trigger);
1119                 }
1120         }
1121
1122         return ret;
1123 }
1124
1125 int snd_soc_pcm_component_pm_runtime_get(struct snd_soc_pcm_runtime *rtd,
1126                                          void *stream)
1127 {
1128         struct snd_soc_component *component;
1129         int i, ret;
1130
1131         for_each_rtd_components(rtd, i, component) {
1132                 ret = pm_runtime_get_sync(component->dev);
1133                 if (ret < 0 && ret != -EACCES) {
1134                         pm_runtime_put_noidle(component->dev);
1135                         return soc_component_ret(component, ret);
1136                 }
1137                 /* mark stream if succeeded */
1138                 soc_component_mark_push(component, stream, pm);
1139         }
1140
1141         return 0;
1142 }
1143
1144 void snd_soc_pcm_component_pm_runtime_put(struct snd_soc_pcm_runtime *rtd,
1145                                           void *stream, int rollback)
1146 {
1147         struct snd_soc_component *component;
1148         int i;
1149
1150         for_each_rtd_components(rtd, i, component) {
1151                 if (rollback && !soc_component_mark_match(component, stream, pm))
1152                         continue;
1153
1154                 pm_runtime_mark_last_busy(component->dev);
1155                 pm_runtime_put_autosuspend(component->dev);
1156
1157                 /* remove marked stream */
1158                 soc_component_mark_pop(component, stream, pm);
1159         }
1160 }