1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258 |
- // SPDX-License-Identifier: GPL-2.0
- //
- // soc-component.c
- //
- // Copyright 2009-2011 Wolfson Microelectronics PLC.
- // Copyright (C) 2019 Renesas Electronics Corp.
- //
- // Mark Brown <[email protected]>
- // Kuninori Morimoto <[email protected]>
- //
- #include <linux/module.h>
- #include <linux/pm_runtime.h>
- #include <sound/soc.h>
- #include <linux/bitops.h>
- #define soc_component_ret(dai, ret) _soc_component_ret(dai, __func__, ret, -1)
- #define soc_component_ret_reg_rw(dai, ret, reg) _soc_component_ret(dai, __func__, ret, reg)
- static inline int _soc_component_ret(struct snd_soc_component *component,
- const char *func, int ret, int reg)
- {
- /* Positive/Zero values are not errors */
- if (ret >= 0)
- return ret;
- /* Negative values might be errors */
- switch (ret) {
- case -EPROBE_DEFER:
- case -ENOTSUPP:
- break;
- default:
- if (reg == -1)
- dev_err(component->dev,
- "ASoC: error at %s on %s: %d\n",
- func, component->name, ret);
- else
- dev_err(component->dev,
- "ASoC: error at %s on %s for register: [0x%08x] %d\n",
- func, component->name, reg, ret);
- }
- return ret;
- }
- static inline int soc_component_field_shift(struct snd_soc_component *component,
- unsigned int mask)
- {
- if (!mask) {
- dev_err(component->dev, "ASoC: error field mask is zero for %s\n",
- component->name);
- return 0;
- }
- return (ffs(mask) - 1);
- }
- /*
- * We might want to check substream by using list.
- * In such case, we can update these macros.
- */
- #define soc_component_mark_push(component, substream, tgt) ((component)->mark_##tgt = substream)
- #define soc_component_mark_pop(component, substream, tgt) ((component)->mark_##tgt = NULL)
- #define soc_component_mark_match(component, substream, tgt) ((component)->mark_##tgt == substream)
- void snd_soc_component_set_aux(struct snd_soc_component *component,
- struct snd_soc_aux_dev *aux)
- {
- component->init = (aux) ? aux->init : NULL;
- }
- int snd_soc_component_init(struct snd_soc_component *component)
- {
- int ret = 0;
- if (component->init)
- ret = component->init(component);
- return soc_component_ret(component, ret);
- }
- /**
- * snd_soc_component_set_sysclk - configure COMPONENT system or master clock.
- * @component: COMPONENT
- * @clk_id: DAI specific clock ID
- * @source: Source for the clock
- * @freq: new clock frequency in Hz
- * @dir: new clock direction - input/output.
- *
- * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
- */
- int snd_soc_component_set_sysclk(struct snd_soc_component *component,
- int clk_id, int source, unsigned int freq,
- int dir)
- {
- int ret = -ENOTSUPP;
- if (component->driver->set_sysclk)
- ret = component->driver->set_sysclk(component, clk_id, source,
- freq, dir);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_set_sysclk);
- /*
- * snd_soc_component_set_pll - configure component PLL.
- * @component: COMPONENT
- * @pll_id: DAI specific PLL ID
- * @source: DAI specific source for the PLL
- * @freq_in: PLL input clock frequency in Hz
- * @freq_out: requested PLL output clock frequency in Hz
- *
- * Configures and enables PLL to generate output clock based on input clock.
- */
- int snd_soc_component_set_pll(struct snd_soc_component *component, int pll_id,
- int source, unsigned int freq_in,
- unsigned int freq_out)
- {
- int ret = -EINVAL;
- if (component->driver->set_pll)
- ret = component->driver->set_pll(component, pll_id, source,
- freq_in, freq_out);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_set_pll);
- void snd_soc_component_seq_notifier(struct snd_soc_component *component,
- enum snd_soc_dapm_type type, int subseq)
- {
- if (component->driver->seq_notifier)
- component->driver->seq_notifier(component, type, subseq);
- }
- int snd_soc_component_stream_event(struct snd_soc_component *component,
- int event)
- {
- int ret = 0;
- if (component->driver->stream_event)
- ret = component->driver->stream_event(component, event);
- return soc_component_ret(component, ret);
- }
- int snd_soc_component_set_bias_level(struct snd_soc_component *component,
- enum snd_soc_bias_level level)
- {
- int ret = 0;
- if (component->driver->set_bias_level)
- ret = component->driver->set_bias_level(component, level);
- return soc_component_ret(component, ret);
- }
- int snd_soc_component_enable_pin(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_enable_pin(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin);
- int snd_soc_component_enable_pin_unlocked(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_enable_pin_unlocked(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin_unlocked);
- int snd_soc_component_disable_pin(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_disable_pin(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin);
- int snd_soc_component_disable_pin_unlocked(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_disable_pin_unlocked(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin_unlocked);
- int snd_soc_component_nc_pin(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_nc_pin(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin);
- int snd_soc_component_nc_pin_unlocked(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_nc_pin_unlocked(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin_unlocked);
- int snd_soc_component_get_pin_status(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_get_pin_status(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_get_pin_status);
- int snd_soc_component_force_enable_pin(struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_force_enable_pin(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin);
- int snd_soc_component_force_enable_pin_unlocked(
- struct snd_soc_component *component,
- const char *pin)
- {
- struct snd_soc_dapm_context *dapm =
- snd_soc_component_get_dapm(component);
- return snd_soc_dapm_force_enable_pin_unlocked(dapm, pin);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin_unlocked);
- /**
- * snd_soc_component_set_jack - configure component jack.
- * @component: COMPONENTs
- * @jack: structure to use for the jack
- * @data: can be used if codec driver need extra data for configuring jack
- *
- * Configures and enables jack detection function.
- */
- int snd_soc_component_set_jack(struct snd_soc_component *component,
- struct snd_soc_jack *jack, void *data)
- {
- int ret = -ENOTSUPP;
- if (component->driver->set_jack)
- ret = component->driver->set_jack(component, jack, data);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_set_jack);
- int snd_soc_component_module_get(struct snd_soc_component *component,
- void *mark, int upon_open)
- {
- int ret = 0;
- if (component->driver->module_get_upon_open == !!upon_open &&
- !try_module_get(component->dev->driver->owner))
- ret = -ENODEV;
- /* mark module if succeeded */
- if (ret == 0)
- soc_component_mark_push(component, mark, module);
- return soc_component_ret(component, ret);
- }
- void snd_soc_component_module_put(struct snd_soc_component *component,
- void *mark, int upon_open, int rollback)
- {
- if (rollback && !soc_component_mark_match(component, mark, module))
- return;
- if (component->driver->module_get_upon_open == !!upon_open)
- module_put(component->dev->driver->owner);
- /* remove the mark from module */
- soc_component_mark_pop(component, mark, module);
- }
- int snd_soc_component_open(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- int ret = 0;
- if (component->driver->open)
- ret = component->driver->open(component, substream);
- /* mark substream if succeeded */
- if (ret == 0)
- soc_component_mark_push(component, substream, open);
- return soc_component_ret(component, ret);
- }
- int snd_soc_component_close(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- int rollback)
- {
- int ret = 0;
- if (rollback && !soc_component_mark_match(component, substream, open))
- return 0;
- if (component->driver->close)
- ret = component->driver->close(component, substream);
- /* remove marked substream */
- soc_component_mark_pop(component, substream, open);
- return soc_component_ret(component, ret);
- }
- void snd_soc_component_suspend(struct snd_soc_component *component)
- {
- if (component->driver->suspend)
- component->driver->suspend(component);
- component->suspended = 1;
- }
- void snd_soc_component_resume(struct snd_soc_component *component)
- {
- if (component->driver->resume)
- component->driver->resume(component);
- component->suspended = 0;
- }
- int snd_soc_component_is_suspended(struct snd_soc_component *component)
- {
- return component->suspended;
- }
- int snd_soc_component_probe(struct snd_soc_component *component)
- {
- int ret = 0;
- if (component->driver->probe)
- ret = component->driver->probe(component);
- return soc_component_ret(component, ret);
- }
- void snd_soc_component_remove(struct snd_soc_component *component)
- {
- if (component->driver->remove)
- component->driver->remove(component);
- }
- int snd_soc_component_of_xlate_dai_id(struct snd_soc_component *component,
- struct device_node *ep)
- {
- int ret = -ENOTSUPP;
- if (component->driver->of_xlate_dai_id)
- ret = component->driver->of_xlate_dai_id(component, ep);
- return soc_component_ret(component, ret);
- }
- int snd_soc_component_of_xlate_dai_name(struct snd_soc_component *component,
- const struct of_phandle_args *args,
- const char **dai_name)
- {
- if (component->driver->of_xlate_dai_name)
- return component->driver->of_xlate_dai_name(component,
- args, dai_name);
- /*
- * Don't use soc_component_ret here because we may not want to report
- * the error just yet. If a device has more than one component, the
- * first may not match and we don't want spam the log with this.
- */
- return -ENOTSUPP;
- }
- void snd_soc_component_setup_regmap(struct snd_soc_component *component)
- {
- int val_bytes = regmap_get_val_bytes(component->regmap);
- /* Errors are legitimate for non-integer byte multiples */
- if (val_bytes > 0)
- component->val_bytes = val_bytes;
- }
- #ifdef CONFIG_REGMAP
- /**
- * snd_soc_component_init_regmap() - Initialize regmap instance for the
- * component
- * @component: The component for which to initialize the regmap instance
- * @regmap: The regmap instance that should be used by the component
- *
- * This function allows deferred assignment of the regmap instance that is
- * associated with the component. Only use this if the regmap instance is not
- * yet ready when the component is registered. The function must also be called
- * before the first IO attempt of the component.
- */
- void snd_soc_component_init_regmap(struct snd_soc_component *component,
- struct regmap *regmap)
- {
- component->regmap = regmap;
- snd_soc_component_setup_regmap(component);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_init_regmap);
- /**
- * snd_soc_component_exit_regmap() - De-initialize regmap instance for the
- * component
- * @component: The component for which to de-initialize the regmap instance
- *
- * Calls regmap_exit() on the regmap instance associated to the component and
- * removes the regmap instance from the component.
- *
- * This function should only be used if snd_soc_component_init_regmap() was used
- * to initialize the regmap instance.
- */
- void snd_soc_component_exit_regmap(struct snd_soc_component *component)
- {
- regmap_exit(component->regmap);
- component->regmap = NULL;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
- #endif
- int snd_soc_component_compr_open(struct snd_soc_component *component,
- struct snd_compr_stream *cstream)
- {
- int ret = 0;
- if (component->driver->compress_ops &&
- component->driver->compress_ops->open)
- ret = component->driver->compress_ops->open(component, cstream);
- /* mark substream if succeeded */
- if (ret == 0)
- soc_component_mark_push(component, cstream, compr_open);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_open);
- void snd_soc_component_compr_free(struct snd_soc_component *component,
- struct snd_compr_stream *cstream,
- int rollback)
- {
- if (rollback && !soc_component_mark_match(component, cstream, compr_open))
- return;
- if (component->driver->compress_ops &&
- component->driver->compress_ops->free)
- component->driver->compress_ops->free(component, cstream);
- /* remove marked substream */
- soc_component_mark_pop(component, cstream, compr_open);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_free);
- int snd_soc_component_compr_trigger(struct snd_compr_stream *cstream, int cmd)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->trigger) {
- ret = component->driver->compress_ops->trigger(
- component, cstream, cmd);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_trigger);
- int snd_soc_component_compr_set_params(struct snd_compr_stream *cstream,
- struct snd_compr_params *params)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->set_params) {
- ret = component->driver->compress_ops->set_params(
- component, cstream, params);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_params);
- int snd_soc_component_compr_get_params(struct snd_compr_stream *cstream,
- struct snd_codec *params)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->get_params) {
- ret = component->driver->compress_ops->get_params(
- component, cstream, params);
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_params);
- int snd_soc_component_compr_get_caps(struct snd_compr_stream *cstream,
- struct snd_compr_caps *caps)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret = 0;
- snd_soc_dpcm_mutex_lock(rtd);
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->get_caps) {
- ret = component->driver->compress_ops->get_caps(
- component, cstream, caps);
- break;
- }
- }
- snd_soc_dpcm_mutex_unlock(rtd);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_caps);
- int snd_soc_component_compr_get_codec_caps(struct snd_compr_stream *cstream,
- struct snd_compr_codec_caps *codec)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret = 0;
- snd_soc_dpcm_mutex_lock(rtd);
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->get_codec_caps) {
- ret = component->driver->compress_ops->get_codec_caps(
- component, cstream, codec);
- break;
- }
- }
- snd_soc_dpcm_mutex_unlock(rtd);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_codec_caps);
- int snd_soc_component_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->ack) {
- ret = component->driver->compress_ops->ack(
- component, cstream, bytes);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_ack);
- int snd_soc_component_compr_pointer(struct snd_compr_stream *cstream,
- struct snd_compr_tstamp *tstamp)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->pointer) {
- ret = component->driver->compress_ops->pointer(
- component, cstream, tstamp);
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_pointer);
- int snd_soc_component_compr_copy(struct snd_compr_stream *cstream,
- char __user *buf, size_t count)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret = 0;
- snd_soc_dpcm_mutex_lock(rtd);
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->copy) {
- ret = component->driver->compress_ops->copy(
- component, cstream, buf, count);
- break;
- }
- }
- snd_soc_dpcm_mutex_unlock(rtd);
- return soc_component_ret(component, ret);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_copy);
- int snd_soc_component_compr_set_metadata(struct snd_compr_stream *cstream,
- struct snd_compr_metadata *metadata)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->set_metadata) {
- ret = component->driver->compress_ops->set_metadata(
- component, cstream, metadata);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_metadata);
- int snd_soc_component_compr_get_metadata(struct snd_compr_stream *cstream,
- struct snd_compr_metadata *metadata)
- {
- struct snd_soc_pcm_runtime *rtd = cstream->private_data;
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->compress_ops &&
- component->driver->compress_ops->get_metadata) {
- ret = component->driver->compress_ops->get_metadata(
- component, cstream, metadata);
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_metadata);
- static unsigned int soc_component_read_no_lock(
- struct snd_soc_component *component,
- unsigned int reg)
- {
- int ret;
- unsigned int val = 0;
- if (component->regmap)
- ret = regmap_read(component->regmap, reg, &val);
- else if (component->driver->read) {
- ret = 0;
- val = component->driver->read(component, reg);
- }
- else
- ret = -EIO;
- if (ret < 0)
- return soc_component_ret_reg_rw(component, ret, reg);
- return val;
- }
- /**
- * snd_soc_component_read() - Read register value
- * @component: Component to read from
- * @reg: Register to read
- *
- * Return: read value
- */
- unsigned int snd_soc_component_read(struct snd_soc_component *component,
- unsigned int reg)
- {
- unsigned int val;
- mutex_lock(&component->io_mutex);
- val = soc_component_read_no_lock(component, reg);
- mutex_unlock(&component->io_mutex);
- return val;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_read);
- static int soc_component_write_no_lock(
- struct snd_soc_component *component,
- unsigned int reg, unsigned int val)
- {
- int ret = -EIO;
- if (component->regmap)
- ret = regmap_write(component->regmap, reg, val);
- else if (component->driver->write)
- ret = component->driver->write(component, reg, val);
- return soc_component_ret_reg_rw(component, ret, reg);
- }
- /**
- * snd_soc_component_write() - Write register value
- * @component: Component to write to
- * @reg: Register to write
- * @val: Value to write to the register
- *
- * Return: 0 on success, a negative error code otherwise.
- */
- int snd_soc_component_write(struct snd_soc_component *component,
- unsigned int reg, unsigned int val)
- {
- int ret;
- mutex_lock(&component->io_mutex);
- ret = soc_component_write_no_lock(component, reg, val);
- mutex_unlock(&component->io_mutex);
- return ret;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_write);
- static int snd_soc_component_update_bits_legacy(
- struct snd_soc_component *component, unsigned int reg,
- unsigned int mask, unsigned int val, bool *change)
- {
- unsigned int old, new;
- int ret = 0;
- mutex_lock(&component->io_mutex);
- old = soc_component_read_no_lock(component, reg);
- new = (old & ~mask) | (val & mask);
- *change = old != new;
- if (*change)
- ret = soc_component_write_no_lock(component, reg, new);
- mutex_unlock(&component->io_mutex);
- return soc_component_ret_reg_rw(component, ret, reg);
- }
- /**
- * snd_soc_component_update_bits() - Perform read/modify/write cycle
- * @component: Component to update
- * @reg: Register to update
- * @mask: Mask that specifies which bits to update
- * @val: New value for the bits specified by mask
- *
- * Return: 1 if the operation was successful and the value of the register
- * changed, 0 if the operation was successful, but the value did not change.
- * Returns a negative error code otherwise.
- */
- int snd_soc_component_update_bits(struct snd_soc_component *component,
- unsigned int reg, unsigned int mask, unsigned int val)
- {
- bool change;
- int ret;
- if (component->regmap)
- ret = regmap_update_bits_check(component->regmap, reg, mask,
- val, &change);
- else
- ret = snd_soc_component_update_bits_legacy(component, reg,
- mask, val, &change);
- if (ret < 0)
- return soc_component_ret_reg_rw(component, ret, reg);
- return change;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_update_bits);
- /**
- * snd_soc_component_update_bits_async() - Perform asynchronous
- * read/modify/write cycle
- * @component: Component to update
- * @reg: Register to update
- * @mask: Mask that specifies which bits to update
- * @val: New value for the bits specified by mask
- *
- * This function is similar to snd_soc_component_update_bits(), but the update
- * operation is scheduled asynchronously. This means it may not be completed
- * when the function returns. To make sure that all scheduled updates have been
- * completed snd_soc_component_async_complete() must be called.
- *
- * Return: 1 if the operation was successful and the value of the register
- * changed, 0 if the operation was successful, but the value did not change.
- * Returns a negative error code otherwise.
- */
- int snd_soc_component_update_bits_async(struct snd_soc_component *component,
- unsigned int reg, unsigned int mask, unsigned int val)
- {
- bool change;
- int ret;
- if (component->regmap)
- ret = regmap_update_bits_check_async(component->regmap, reg,
- mask, val, &change);
- else
- ret = snd_soc_component_update_bits_legacy(component, reg,
- mask, val, &change);
- if (ret < 0)
- return soc_component_ret_reg_rw(component, ret, reg);
- return change;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_update_bits_async);
- /**
- * snd_soc_component_read_field() - Read register field value
- * @component: Component to read from
- * @reg: Register to read
- * @mask: mask of the register field
- *
- * Return: read value of register field.
- */
- unsigned int snd_soc_component_read_field(struct snd_soc_component *component,
- unsigned int reg, unsigned int mask)
- {
- unsigned int val;
- val = snd_soc_component_read(component, reg);
- val = (val & mask) >> soc_component_field_shift(component, mask);
- return val;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_read_field);
- /**
- * snd_soc_component_write_field() - write to register field
- * @component: Component to write to
- * @reg: Register to write
- * @mask: mask of the register field to update
- * @val: value of the field to write
- *
- * Return: 1 for change, otherwise 0.
- */
- int snd_soc_component_write_field(struct snd_soc_component *component,
- unsigned int reg, unsigned int mask,
- unsigned int val)
- {
- val = (val << soc_component_field_shift(component, mask)) & mask;
- return snd_soc_component_update_bits(component, reg, mask, val);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_write_field);
- /**
- * snd_soc_component_async_complete() - Ensure asynchronous I/O has completed
- * @component: Component for which to wait
- *
- * This function blocks until all asynchronous I/O which has previously been
- * scheduled using snd_soc_component_update_bits_async() has completed.
- */
- void snd_soc_component_async_complete(struct snd_soc_component *component)
- {
- if (component->regmap)
- regmap_async_complete(component->regmap);
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_async_complete);
- /**
- * snd_soc_component_test_bits - Test register for change
- * @component: component
- * @reg: Register to test
- * @mask: Mask that specifies which bits to test
- * @value: Value to test against
- *
- * Tests a register with a new value and checks if the new value is
- * different from the old value.
- *
- * Return: 1 for change, otherwise 0.
- */
- int snd_soc_component_test_bits(struct snd_soc_component *component,
- unsigned int reg, unsigned int mask, unsigned int value)
- {
- unsigned int old, new;
- old = snd_soc_component_read(component, reg);
- new = (old & ~mask) | value;
- return old != new;
- }
- EXPORT_SYMBOL_GPL(snd_soc_component_test_bits);
- int snd_soc_pcm_component_pointer(struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i;
- /* FIXME: use 1st pointer */
- for_each_rtd_components(rtd, i, component)
- if (component->driver->pointer)
- return component->driver->pointer(component, substream);
- return 0;
- }
- static bool snd_soc_component_is_codec_on_rtd(struct snd_soc_pcm_runtime *rtd,
- struct snd_soc_component *component)
- {
- struct snd_soc_dai *dai;
- int i;
- for_each_rtd_codec_dais(rtd, i, dai) {
- if (dai->component == component)
- return true;
- }
- return false;
- }
- void snd_soc_pcm_component_delay(struct snd_pcm_substream *substream,
- snd_pcm_sframes_t *cpu_delay,
- snd_pcm_sframes_t *codec_delay)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- snd_pcm_sframes_t delay;
- int i;
- /*
- * We're looking for the delay through the full audio path so it needs to
- * be the maximum of the Components doing transmit and the maximum of the
- * Components doing receive (ie, all CPUs and all CODECs) rather than
- * just the maximum of all Components.
- */
- for_each_rtd_components(rtd, i, component) {
- if (!component->driver->delay)
- continue;
- delay = component->driver->delay(component, substream);
- if (snd_soc_component_is_codec_on_rtd(rtd, component))
- *codec_delay = max(*codec_delay, delay);
- else
- *cpu_delay = max(*cpu_delay, delay);
- }
- }
- int snd_soc_pcm_component_ioctl(struct snd_pcm_substream *substream,
- unsigned int cmd, void *arg)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i;
- /* FIXME: use 1st ioctl */
- for_each_rtd_components(rtd, i, component)
- if (component->driver->ioctl)
- return soc_component_ret(
- component,
- component->driver->ioctl(component,
- substream, cmd, arg));
- return snd_pcm_lib_ioctl(substream, cmd, arg);
- }
- int snd_soc_pcm_component_sync_stop(struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->sync_stop) {
- ret = component->driver->sync_stop(component,
- substream);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- int snd_soc_pcm_component_copy_user(struct snd_pcm_substream *substream,
- int channel, unsigned long pos,
- void __user *buf, unsigned long bytes)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i;
- /* FIXME. it returns 1st copy now */
- for_each_rtd_components(rtd, i, component)
- if (component->driver->copy_user)
- return soc_component_ret(
- component,
- component->driver->copy_user(
- component, substream, channel,
- pos, buf, bytes));
- return -EINVAL;
- }
- struct page *snd_soc_pcm_component_page(struct snd_pcm_substream *substream,
- unsigned long offset)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- struct page *page;
- int i;
- /* FIXME. it returns 1st page now */
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->page) {
- page = component->driver->page(component,
- substream, offset);
- if (page)
- return page;
- }
- }
- return NULL;
- }
- int snd_soc_pcm_component_mmap(struct snd_pcm_substream *substream,
- struct vm_area_struct *vma)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i;
- /* FIXME. it returns 1st mmap now */
- for_each_rtd_components(rtd, i, component)
- if (component->driver->mmap)
- return soc_component_ret(
- component,
- component->driver->mmap(component,
- substream, vma));
- return -EINVAL;
- }
- int snd_soc_pcm_component_new(struct snd_soc_pcm_runtime *rtd)
- {
- struct snd_soc_component *component;
- int ret;
- int i;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->pcm_construct) {
- ret = component->driver->pcm_construct(component, rtd);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- void snd_soc_pcm_component_free(struct snd_soc_pcm_runtime *rtd)
- {
- struct snd_soc_component *component;
- int i;
- if (!rtd->pcm)
- return;
- for_each_rtd_components(rtd, i, component)
- if (component->driver->pcm_destruct)
- component->driver->pcm_destruct(component, rtd->pcm);
- }
- int snd_soc_pcm_component_prepare(struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->prepare) {
- ret = component->driver->prepare(component, substream);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- }
- return 0;
- }
- int snd_soc_pcm_component_hw_params(struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *params)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (component->driver->hw_params) {
- ret = component->driver->hw_params(component,
- substream, params);
- if (ret < 0)
- return soc_component_ret(component, ret);
- }
- /* mark substream if succeeded */
- soc_component_mark_push(component, substream, hw_params);
- }
- return 0;
- }
- void snd_soc_pcm_component_hw_free(struct snd_pcm_substream *substream,
- int rollback)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i, ret;
- for_each_rtd_components(rtd, i, component) {
- if (rollback && !soc_component_mark_match(component, substream, hw_params))
- continue;
- if (component->driver->hw_free) {
- ret = component->driver->hw_free(component, substream);
- if (ret < 0)
- soc_component_ret(component, ret);
- }
- /* remove marked substream */
- soc_component_mark_pop(component, substream, hw_params);
- }
- }
- static int soc_component_trigger(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- int cmd)
- {
- int ret = 0;
- if (component->driver->trigger)
- ret = component->driver->trigger(component, substream, cmd);
- return soc_component_ret(component, ret);
- }
- int snd_soc_pcm_component_trigger(struct snd_pcm_substream *substream,
- int cmd, int rollback)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i, r, ret = 0;
- switch (cmd) {
- case SNDRV_PCM_TRIGGER_START:
- case SNDRV_PCM_TRIGGER_RESUME:
- case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
- for_each_rtd_components(rtd, i, component) {
- ret = soc_component_trigger(component, substream, cmd);
- if (ret < 0)
- break;
- soc_component_mark_push(component, substream, trigger);
- }
- break;
- case SNDRV_PCM_TRIGGER_STOP:
- case SNDRV_PCM_TRIGGER_SUSPEND:
- case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
- for_each_rtd_components(rtd, i, component) {
- if (rollback && !soc_component_mark_match(component, substream, trigger))
- continue;
- r = soc_component_trigger(component, substream, cmd);
- if (r < 0)
- ret = r; /* use last ret */
- soc_component_mark_pop(component, substream, trigger);
- }
- }
- return ret;
- }
- int snd_soc_pcm_component_pm_runtime_get(struct snd_soc_pcm_runtime *rtd,
- void *stream)
- {
- struct snd_soc_component *component;
- int i;
- for_each_rtd_components(rtd, i, component) {
- int ret = pm_runtime_get_sync(component->dev);
- if (ret < 0 && ret != -EACCES) {
- pm_runtime_put_noidle(component->dev);
- return soc_component_ret(component, ret);
- }
- /* mark stream if succeeded */
- soc_component_mark_push(component, stream, pm);
- }
- return 0;
- }
- void snd_soc_pcm_component_pm_runtime_put(struct snd_soc_pcm_runtime *rtd,
- void *stream, int rollback)
- {
- struct snd_soc_component *component;
- int i;
- for_each_rtd_components(rtd, i, component) {
- if (rollback && !soc_component_mark_match(component, stream, pm))
- continue;
- pm_runtime_mark_last_busy(component->dev);
- pm_runtime_put_autosuspend(component->dev);
- /* remove marked stream */
- soc_component_mark_pop(component, stream, pm);
- }
- }
- int snd_soc_pcm_component_ack(struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
- struct snd_soc_component *component;
- int i;
- /* FIXME: use 1st pointer */
- for_each_rtd_components(rtd, i, component)
- if (component->driver->ack)
- return component->driver->ack(component, substream);
- return 0;
- }
|