linux/sound/soc/soc-component.c
<<
>>
Prefs
   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#include <linux/bitops.h>
  15
  16#define soc_component_ret(dai, ret) _soc_component_ret(dai, __func__, ret)
  17static inline int _soc_component_ret(struct snd_soc_component *component,
  18                                     const char *func, int ret)
  19{
  20        /* Positive/Zero values are not errors */
  21        if (ret >= 0)
  22                return ret;
  23
  24        /* Negative values might be errors */
  25        switch (ret) {
  26        case -EPROBE_DEFER:
  27        case -ENOTSUPP:
  28                break;
  29        default:
  30                dev_err(component->dev,
  31                        "ASoC: error at %s on %s: %d\n",
  32                        func, component->name, ret);
  33        }
  34
  35        return ret;
  36}
  37
  38static inline int soc_component_field_shift(struct snd_soc_component *component,
  39                                            unsigned int mask)
  40{
  41        if (!mask) {
  42                dev_err(component->dev, "ASoC: error field mask is zero for %s\n",
  43                        component->name);
  44                return 0;
  45        }
  46
  47        return (ffs(mask) - 1);
  48}
  49
  50/*
  51 * We might want to check substream by using list.
  52 * In such case, we can update these macros.
  53 */
  54#define soc_component_mark_push(component, substream, tgt)      ((component)->mark_##tgt = substream)
  55#define soc_component_mark_pop(component, substream, tgt)       ((component)->mark_##tgt = NULL)
  56#define soc_component_mark_match(component, substream, tgt)     ((component)->mark_##tgt == substream)
  57
  58void snd_soc_component_set_aux(struct snd_soc_component *component,
  59                               struct snd_soc_aux_dev *aux)
  60{
  61        component->init = (aux) ? aux->init : NULL;
  62}
  63
  64int snd_soc_component_init(struct snd_soc_component *component)
  65{
  66        int ret = 0;
  67
  68        if (component->init)
  69                ret = component->init(component);
  70
  71        return soc_component_ret(component, ret);
  72}
  73
  74/**
  75 * snd_soc_component_set_sysclk - configure COMPONENT system or master clock.
  76 * @component: COMPONENT
  77 * @clk_id: DAI specific clock ID
  78 * @source: Source for the clock
  79 * @freq: new clock frequency in Hz
  80 * @dir: new clock direction - input/output.
  81 *
  82 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
  83 */
  84int snd_soc_component_set_sysclk(struct snd_soc_component *component,
  85                                 int clk_id, int source, unsigned int freq,
  86                                 int dir)
  87{
  88        int ret = -ENOTSUPP;
  89
  90        if (component->driver->set_sysclk)
  91                ret = component->driver->set_sysclk(component, clk_id, source,
  92                                                     freq, dir);
  93
  94        return soc_component_ret(component, ret);
  95}
  96EXPORT_SYMBOL_GPL(snd_soc_component_set_sysclk);
  97
  98/*
  99 * snd_soc_component_set_pll - configure component PLL.
 100 * @component: COMPONENT
 101 * @pll_id: DAI specific PLL ID
 102 * @source: DAI specific source for the PLL
 103 * @freq_in: PLL input clock frequency in Hz
 104 * @freq_out: requested PLL output clock frequency in Hz
 105 *
 106 * Configures and enables PLL to generate output clock based on input clock.
 107 */
 108int snd_soc_component_set_pll(struct snd_soc_component *component, int pll_id,
 109                              int source, unsigned int freq_in,
 110                              unsigned int freq_out)
 111{
 112        int ret = -EINVAL;
 113
 114        if (component->driver->set_pll)
 115                ret = component->driver->set_pll(component, pll_id, source,
 116                                                  freq_in, freq_out);
 117
 118        return soc_component_ret(component, ret);
 119}
 120EXPORT_SYMBOL_GPL(snd_soc_component_set_pll);
 121
 122void snd_soc_component_seq_notifier(struct snd_soc_component *component,
 123                                    enum snd_soc_dapm_type type, int subseq)
 124{
 125        if (component->driver->seq_notifier)
 126                component->driver->seq_notifier(component, type, subseq);
 127}
 128
 129int snd_soc_component_stream_event(struct snd_soc_component *component,
 130                                   int event)
 131{
 132        int ret = 0;
 133
 134        if (component->driver->stream_event)
 135                ret = component->driver->stream_event(component, event);
 136
 137        return soc_component_ret(component, ret);
 138}
 139
 140int snd_soc_component_set_bias_level(struct snd_soc_component *component,
 141                                     enum snd_soc_bias_level level)
 142{
 143        int ret = 0;
 144
 145        if (component->driver->set_bias_level)
 146                ret = component->driver->set_bias_level(component, level);
 147
 148        return soc_component_ret(component, ret);
 149}
 150
 151int snd_soc_component_enable_pin(struct snd_soc_component *component,
 152                                 const char *pin)
 153{
 154        struct snd_soc_dapm_context *dapm =
 155                snd_soc_component_get_dapm(component);
 156        return snd_soc_dapm_enable_pin(dapm, pin);
 157}
 158EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin);
 159
 160int snd_soc_component_enable_pin_unlocked(struct snd_soc_component *component,
 161                                          const char *pin)
 162{
 163        struct snd_soc_dapm_context *dapm =
 164                snd_soc_component_get_dapm(component);
 165        return snd_soc_dapm_enable_pin_unlocked(dapm, pin);
 166}
 167EXPORT_SYMBOL_GPL(snd_soc_component_enable_pin_unlocked);
 168
 169int snd_soc_component_disable_pin(struct snd_soc_component *component,
 170                                  const char *pin)
 171{
 172        struct snd_soc_dapm_context *dapm =
 173                snd_soc_component_get_dapm(component);
 174        return snd_soc_dapm_disable_pin(dapm, pin);
 175}
 176EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin);
 177
 178int snd_soc_component_disable_pin_unlocked(struct snd_soc_component *component,
 179                                           const char *pin)
 180{
 181        struct snd_soc_dapm_context *dapm = 
 182                snd_soc_component_get_dapm(component);
 183        return snd_soc_dapm_disable_pin_unlocked(dapm, pin);
 184}
 185EXPORT_SYMBOL_GPL(snd_soc_component_disable_pin_unlocked);
 186
 187int snd_soc_component_nc_pin(struct snd_soc_component *component,
 188                             const char *pin)
 189{
 190        struct snd_soc_dapm_context *dapm =
 191                snd_soc_component_get_dapm(component);
 192        return snd_soc_dapm_nc_pin(dapm, pin);
 193}
 194EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin);
 195
 196int snd_soc_component_nc_pin_unlocked(struct snd_soc_component *component,
 197                                      const char *pin)
 198{
 199        struct snd_soc_dapm_context *dapm =
 200                snd_soc_component_get_dapm(component);
 201        return snd_soc_dapm_nc_pin_unlocked(dapm, pin);
 202}
 203EXPORT_SYMBOL_GPL(snd_soc_component_nc_pin_unlocked);
 204
 205int snd_soc_component_get_pin_status(struct snd_soc_component *component,
 206                                     const char *pin)
 207{
 208        struct snd_soc_dapm_context *dapm =
 209                snd_soc_component_get_dapm(component);
 210        return snd_soc_dapm_get_pin_status(dapm, pin);
 211}
 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{
 217        struct snd_soc_dapm_context *dapm =
 218                snd_soc_component_get_dapm(component);
 219        return snd_soc_dapm_force_enable_pin(dapm, pin);
 220}
 221EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin);
 222
 223int snd_soc_component_force_enable_pin_unlocked(
 224        struct snd_soc_component *component,
 225        const char *pin)
 226{
 227        struct snd_soc_dapm_context *dapm =
 228                snd_soc_component_get_dapm(component);
 229        return snd_soc_dapm_force_enable_pin_unlocked(dapm, pin);
 230}
 231EXPORT_SYMBOL_GPL(snd_soc_component_force_enable_pin_unlocked);
 232
 233/**
 234 * snd_soc_component_set_jack - configure component jack.
 235 * @component: COMPONENTs
 236 * @jack: structure to use for the jack
 237 * @data: can be used if codec driver need extra data for configuring jack
 238 *
 239 * Configures and enables jack detection function.
 240 */
 241int snd_soc_component_set_jack(struct snd_soc_component *component,
 242                               struct snd_soc_jack *jack, void *data)
 243{
 244        int ret = -ENOTSUPP;
 245
 246        if (component->driver->set_jack)
 247                ret = component->driver->set_jack(component, jack, data);
 248
 249        return soc_component_ret(component, ret);
 250}
 251EXPORT_SYMBOL_GPL(snd_soc_component_set_jack);
 252
 253int snd_soc_component_module_get(struct snd_soc_component *component,
 254                                 struct snd_pcm_substream *substream,
 255                                 int upon_open)
 256{
 257        int ret = 0;
 258
 259        if (component->driver->module_get_upon_open == !!upon_open &&
 260            !try_module_get(component->dev->driver->owner))
 261                ret = -ENODEV;
 262
 263        /* mark substream if succeeded */
 264        if (ret == 0)
 265                soc_component_mark_push(component, substream, module);
 266
 267        return soc_component_ret(component, ret);
 268}
 269
 270void snd_soc_component_module_put(struct snd_soc_component *component,
 271                                  struct snd_pcm_substream *substream,
 272                                  int upon_open, int rollback)
 273{
 274        if (rollback && !soc_component_mark_match(component, substream, module))
 275                return;
 276
 277        if (component->driver->module_get_upon_open == !!upon_open)
 278                module_put(component->dev->driver->owner);
 279
 280        /* remove marked substream */
 281        soc_component_mark_pop(component, substream, module);
 282}
 283
 284int snd_soc_component_open(struct snd_soc_component *component,
 285                           struct snd_pcm_substream *substream)
 286{
 287        int ret = 0;
 288
 289        if (component->driver->open)
 290                ret = component->driver->open(component, substream);
 291
 292        /* mark substream if succeeded */
 293        if (ret == 0)
 294                soc_component_mark_push(component, substream, open);
 295
 296        return soc_component_ret(component, ret);
 297}
 298
 299int snd_soc_component_close(struct snd_soc_component *component,
 300                            struct snd_pcm_substream *substream,
 301                            int rollback)
 302{
 303        int ret = 0;
 304
 305        if (rollback && !soc_component_mark_match(component, substream, open))
 306                return 0;
 307
 308        if (component->driver->close)
 309                ret = component->driver->close(component, substream);
 310
 311        /* remove marked substream */
 312        soc_component_mark_pop(component, substream, open);
 313
 314        return soc_component_ret(component, ret);
 315}
 316
 317void snd_soc_component_suspend(struct snd_soc_component *component)
 318{
 319        if (component->driver->suspend)
 320                component->driver->suspend(component);
 321        component->suspended = 1;
 322}
 323
 324void snd_soc_component_resume(struct snd_soc_component *component)
 325{
 326        if (component->driver->resume)
 327                component->driver->resume(component);
 328        component->suspended = 0;
 329}
 330
 331int snd_soc_component_is_suspended(struct snd_soc_component *component)
 332{
 333        return component->suspended;
 334}
 335
 336int snd_soc_component_probe(struct snd_soc_component *component)
 337{
 338        int ret = 0;
 339
 340        if (component->driver->probe)
 341                ret = component->driver->probe(component);
 342
 343        return soc_component_ret(component, ret);
 344}
 345
 346void snd_soc_component_remove(struct snd_soc_component *component)
 347{
 348        if (component->driver->remove)
 349                component->driver->remove(component);
 350}
 351
 352int snd_soc_component_of_xlate_dai_id(struct snd_soc_component *component,
 353                                      struct device_node *ep)
 354{
 355        int ret = -ENOTSUPP;
 356
 357        if (component->driver->of_xlate_dai_id)
 358                ret = component->driver->of_xlate_dai_id(component, ep);
 359
 360        return soc_component_ret(component, ret);
 361}
 362
 363int snd_soc_component_of_xlate_dai_name(struct snd_soc_component *component,
 364                                        const struct of_phandle_args *args,
 365                                        const char **dai_name)
 366{
 367        if (component->driver->of_xlate_dai_name)
 368                return component->driver->of_xlate_dai_name(component,
 369                                                            args, dai_name);
 370        /*
 371         * Don't use soc_component_ret here because we may not want to report
 372         * the error just yet. If a device has more than one component, the
 373         * first may not match and we don't want spam the log with this.
 374         */
 375        return -ENOTSUPP;
 376}
 377
 378void snd_soc_component_setup_regmap(struct snd_soc_component *component)
 379{
 380        int val_bytes = regmap_get_val_bytes(component->regmap);
 381
 382        /* Errors are legitimate for non-integer byte multiples */
 383        if (val_bytes > 0)
 384                component->val_bytes = val_bytes;
 385}
 386
 387#ifdef CONFIG_REGMAP
 388
 389/**
 390 * snd_soc_component_init_regmap() - Initialize regmap instance for the
 391 *                                   component
 392 * @component: The component for which to initialize the regmap instance
 393 * @regmap: The regmap instance that should be used by the component
 394 *
 395 * This function allows deferred assignment of the regmap instance that is
 396 * associated with the component. Only use this if the regmap instance is not
 397 * yet ready when the component is registered. The function must also be called
 398 * before the first IO attempt of the component.
 399 */
 400void snd_soc_component_init_regmap(struct snd_soc_component *component,
 401                                   struct regmap *regmap)
 402{
 403        component->regmap = regmap;
 404        snd_soc_component_setup_regmap(component);
 405}
 406EXPORT_SYMBOL_GPL(snd_soc_component_init_regmap);
 407
 408/**
 409 * snd_soc_component_exit_regmap() - De-initialize regmap instance for the
 410 *                                   component
 411 * @component: The component for which to de-initialize the regmap instance
 412 *
 413 * Calls regmap_exit() on the regmap instance associated to the component and
 414 * removes the regmap instance from the component.
 415 *
 416 * This function should only be used if snd_soc_component_init_regmap() was used
 417 * to initialize the regmap instance.
 418 */
 419void snd_soc_component_exit_regmap(struct snd_soc_component *component)
 420{
 421        regmap_exit(component->regmap);
 422        component->regmap = NULL;
 423}
 424EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
 425
 426#endif
 427
 428int snd_soc_component_compr_open(struct snd_compr_stream *cstream)
 429{
 430        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 431        struct snd_soc_component *component;
 432        int i, ret;
 433
 434        for_each_rtd_components(rtd, i, component) {
 435                if (component->driver->compress_ops &&
 436                    component->driver->compress_ops->open) {
 437                        ret = component->driver->compress_ops->open(component, cstream);
 438                        if (ret < 0)
 439                                return soc_component_ret(component, ret);
 440                }
 441                soc_component_mark_push(component, cstream, compr_open);
 442        }
 443
 444        return 0;
 445}
 446EXPORT_SYMBOL_GPL(snd_soc_component_compr_open);
 447
 448void snd_soc_component_compr_free(struct snd_compr_stream *cstream,
 449                                  int rollback)
 450{
 451        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 452        struct snd_soc_component *component;
 453        int i;
 454
 455        for_each_rtd_components(rtd, i, component) {
 456                if (rollback && !soc_component_mark_match(component, cstream, compr_open))
 457                        continue;
 458
 459                if (component->driver->compress_ops &&
 460                    component->driver->compress_ops->free)
 461                        component->driver->compress_ops->free(component, cstream);
 462
 463                soc_component_mark_pop(component, cstream, compr_open);
 464        }
 465}
 466EXPORT_SYMBOL_GPL(snd_soc_component_compr_free);
 467
 468int snd_soc_component_compr_trigger(struct snd_compr_stream *cstream, int cmd)
 469{
 470        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 471        struct snd_soc_component *component;
 472        int i, ret;
 473
 474        for_each_rtd_components(rtd, i, component) {
 475                if (component->driver->compress_ops &&
 476                    component->driver->compress_ops->trigger) {
 477                        ret = component->driver->compress_ops->trigger(
 478                                component, cstream, cmd);
 479                        if (ret < 0)
 480                                return soc_component_ret(component, ret);
 481                }
 482        }
 483
 484        return 0;
 485}
 486EXPORT_SYMBOL_GPL(snd_soc_component_compr_trigger);
 487
 488int snd_soc_component_compr_set_params(struct snd_compr_stream *cstream,
 489                                       struct snd_compr_params *params)
 490{
 491        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 492        struct snd_soc_component *component;
 493        int i, ret;
 494
 495        for_each_rtd_components(rtd, i, component) {
 496                if (component->driver->compress_ops &&
 497                    component->driver->compress_ops->set_params) {
 498                        ret = component->driver->compress_ops->set_params(
 499                                component, cstream, params);
 500                        if (ret < 0)
 501                                return soc_component_ret(component, ret);
 502                }
 503        }
 504
 505        return 0;
 506}
 507EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_params);
 508
 509int snd_soc_component_compr_get_params(struct snd_compr_stream *cstream,
 510                                       struct snd_codec *params)
 511{
 512        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 513        struct snd_soc_component *component;
 514        int i, ret;
 515
 516        for_each_rtd_components(rtd, i, component) {
 517                if (component->driver->compress_ops &&
 518                    component->driver->compress_ops->get_params) {
 519                        ret = component->driver->compress_ops->get_params(
 520                                component, cstream, params);
 521                        return soc_component_ret(component, ret);
 522                }
 523        }
 524
 525        return 0;
 526}
 527EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_params);
 528
 529int snd_soc_component_compr_get_caps(struct snd_compr_stream *cstream,
 530                                     struct snd_compr_caps *caps)
 531{
 532        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 533        struct snd_soc_component *component;
 534        int i, ret = 0;
 535
 536        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 537
 538        for_each_rtd_components(rtd, i, component) {
 539                if (component->driver->compress_ops &&
 540                    component->driver->compress_ops->get_caps) {
 541                        ret = component->driver->compress_ops->get_caps(
 542                                component, cstream, caps);
 543                        break;
 544                }
 545        }
 546
 547        mutex_unlock(&rtd->card->pcm_mutex);
 548
 549        return soc_component_ret(component, ret);
 550}
 551EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_caps);
 552
 553int snd_soc_component_compr_get_codec_caps(struct snd_compr_stream *cstream,
 554                                           struct snd_compr_codec_caps *codec)
 555{
 556        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 557        struct snd_soc_component *component;
 558        int i, ret = 0;
 559
 560        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 561
 562        for_each_rtd_components(rtd, i, component) {
 563                if (component->driver->compress_ops &&
 564                    component->driver->compress_ops->get_codec_caps) {
 565                        ret = component->driver->compress_ops->get_codec_caps(
 566                                component, cstream, codec);
 567                        break;
 568                }
 569        }
 570
 571        mutex_unlock(&rtd->card->pcm_mutex);
 572
 573        return soc_component_ret(component, ret);
 574}
 575EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_codec_caps);
 576
 577int snd_soc_component_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
 578{
 579        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 580        struct snd_soc_component *component;
 581        int i, ret;
 582
 583        for_each_rtd_components(rtd, i, component) {
 584                if (component->driver->compress_ops &&
 585                    component->driver->compress_ops->ack) {
 586                        ret = component->driver->compress_ops->ack(
 587                                component, cstream, bytes);
 588                        if (ret < 0)
 589                                return soc_component_ret(component, ret);
 590                }
 591        }
 592
 593        return 0;
 594}
 595EXPORT_SYMBOL_GPL(snd_soc_component_compr_ack);
 596
 597int snd_soc_component_compr_pointer(struct snd_compr_stream *cstream,
 598                                    struct snd_compr_tstamp *tstamp)
 599{
 600        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 601        struct snd_soc_component *component;
 602        int i, ret;
 603
 604        for_each_rtd_components(rtd, i, component) {
 605                if (component->driver->compress_ops &&
 606                    component->driver->compress_ops->pointer) {
 607                        ret = component->driver->compress_ops->pointer(
 608                                component, cstream, tstamp);
 609                        return soc_component_ret(component, ret);
 610                }
 611        }
 612
 613        return 0;
 614}
 615EXPORT_SYMBOL_GPL(snd_soc_component_compr_pointer);
 616
 617int snd_soc_component_compr_copy(struct snd_compr_stream *cstream,
 618                                 char __user *buf, size_t count)
 619{
 620        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 621        struct snd_soc_component *component;
 622        int i, ret = 0;
 623
 624        mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
 625
 626        for_each_rtd_components(rtd, i, component) {
 627                if (component->driver->compress_ops &&
 628                    component->driver->compress_ops->copy) {
 629                        ret = component->driver->compress_ops->copy(
 630                                component, cstream, buf, count);
 631                        break;
 632                }
 633        }
 634
 635        mutex_unlock(&rtd->card->pcm_mutex);
 636
 637        return soc_component_ret(component, ret);
 638}
 639EXPORT_SYMBOL_GPL(snd_soc_component_compr_copy);
 640
 641int snd_soc_component_compr_set_metadata(struct snd_compr_stream *cstream,
 642                                         struct snd_compr_metadata *metadata)
 643{
 644        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 645        struct snd_soc_component *component;
 646        int i, ret;
 647
 648        for_each_rtd_components(rtd, i, component) {
 649                if (component->driver->compress_ops &&
 650                    component->driver->compress_ops->set_metadata) {
 651                        ret = component->driver->compress_ops->set_metadata(
 652                                component, cstream, metadata);
 653                        if (ret < 0)
 654                                return soc_component_ret(component, ret);
 655                }
 656        }
 657
 658        return 0;
 659}
 660EXPORT_SYMBOL_GPL(snd_soc_component_compr_set_metadata);
 661
 662int snd_soc_component_compr_get_metadata(struct snd_compr_stream *cstream,
 663                                         struct snd_compr_metadata *metadata)
 664{
 665        struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 666        struct snd_soc_component *component;
 667        int i, ret;
 668
 669        for_each_rtd_components(rtd, i, component) {
 670                if (component->driver->compress_ops &&
 671                    component->driver->compress_ops->get_metadata) {
 672                        ret = component->driver->compress_ops->get_metadata(
 673                                component, cstream, metadata);
 674                        return soc_component_ret(component, ret);
 675                }
 676        }
 677
 678        return 0;
 679}
 680EXPORT_SYMBOL_GPL(snd_soc_component_compr_get_metadata);
 681
 682static unsigned int soc_component_read_no_lock(
 683        struct snd_soc_component *component,
 684        unsigned int reg)
 685{
 686        int ret;
 687        unsigned int val = 0;
 688
 689        if (component->regmap)
 690                ret = regmap_read(component->regmap, reg, &val);
 691        else if (component->driver->read) {
 692                ret = 0;
 693                val = component->driver->read(component, reg);
 694        }
 695        else
 696                ret = -EIO;
 697
 698        if (ret < 0)
 699                return soc_component_ret(component, ret);
 700
 701        return val;
 702}
 703
 704/**
 705 * snd_soc_component_read() - Read register value
 706 * @component: Component to read from
 707 * @reg: Register to read
 708 *
 709 * Return: read value
 710 */
 711unsigned int snd_soc_component_read(struct snd_soc_component *component,
 712                                    unsigned int reg)
 713{
 714        unsigned int val;
 715
 716        mutex_lock(&component->io_mutex);
 717        val = soc_component_read_no_lock(component, reg);
 718        mutex_unlock(&component->io_mutex);
 719
 720        return val;
 721}
 722EXPORT_SYMBOL_GPL(snd_soc_component_read);
 723
 724static int soc_component_write_no_lock(
 725        struct snd_soc_component *component,
 726        unsigned int reg, unsigned int val)
 727{
 728        int ret = -EIO;
 729
 730        if (component->regmap)
 731                ret = regmap_write(component->regmap, reg, val);
 732        else if (component->driver->write)
 733                ret = component->driver->write(component, reg, val);
 734
 735        return soc_component_ret(component, ret);
 736}
 737
 738/**
 739 * snd_soc_component_write() - Write register value
 740 * @component: Component to write to
 741 * @reg: Register to write
 742 * @val: Value to write to the register
 743 *
 744 * Return: 0 on success, a negative error code otherwise.
 745 */
 746int snd_soc_component_write(struct snd_soc_component *component,
 747                            unsigned int reg, unsigned int val)
 748{
 749        int ret;
 750
 751        mutex_lock(&component->io_mutex);
 752        ret = soc_component_write_no_lock(component, reg, val);
 753        mutex_unlock(&component->io_mutex);
 754
 755        return ret;
 756}
 757EXPORT_SYMBOL_GPL(snd_soc_component_write);
 758
 759static int snd_soc_component_update_bits_legacy(
 760        struct snd_soc_component *component, unsigned int reg,
 761        unsigned int mask, unsigned int val, bool *change)
 762{
 763        unsigned int old, new;
 764        int ret = 0;
 765
 766        mutex_lock(&component->io_mutex);
 767
 768        old = soc_component_read_no_lock(component, reg);
 769
 770        new = (old & ~mask) | (val & mask);
 771        *change = old != new;
 772        if (*change)
 773                ret = soc_component_write_no_lock(component, reg, new);
 774
 775        mutex_unlock(&component->io_mutex);
 776
 777        return soc_component_ret(component, ret);
 778}
 779
 780/**
 781 * snd_soc_component_update_bits() - Perform read/modify/write cycle
 782 * @component: Component to update
 783 * @reg: Register to update
 784 * @mask: Mask that specifies which bits to update
 785 * @val: New value for the bits specified by mask
 786 *
 787 * Return: 1 if the operation was successful and the value of the register
 788 * changed, 0 if the operation was successful, but the value did not change.
 789 * Returns a negative error code otherwise.
 790 */
 791int snd_soc_component_update_bits(struct snd_soc_component *component,
 792                                  unsigned int reg, unsigned int mask, unsigned int val)
 793{
 794        bool change;
 795        int ret;
 796
 797        if (component->regmap)
 798                ret = regmap_update_bits_check(component->regmap, reg, mask,
 799                                               val, &change);
 800        else
 801                ret = snd_soc_component_update_bits_legacy(component, reg,
 802                                                           mask, val, &change);
 803
 804        if (ret < 0)
 805                return soc_component_ret(component, ret);
 806        return change;
 807}
 808EXPORT_SYMBOL_GPL(snd_soc_component_update_bits);
 809
 810/**
 811 * snd_soc_component_update_bits_async() - Perform asynchronous
 812 *  read/modify/write cycle
 813 * @component: Component to update
 814 * @reg: Register to update
 815 * @mask: Mask that specifies which bits to update
 816 * @val: New value for the bits specified by mask
 817 *
 818 * This function is similar to snd_soc_component_update_bits(), but the update
 819 * operation is scheduled asynchronously. This means it may not be completed
 820 * when the function returns. To make sure that all scheduled updates have been
 821 * completed snd_soc_component_async_complete() must be called.
 822 *
 823 * Return: 1 if the operation was successful and the value of the register
 824 * changed, 0 if the operation was successful, but the value did not change.
 825 * Returns a negative error code otherwise.
 826 */
 827int snd_soc_component_update_bits_async(struct snd_soc_component *component,
 828                                        unsigned int reg, unsigned int mask, unsigned int val)
 829{
 830        bool change;
 831        int ret;
 832
 833        if (component->regmap)
 834                ret = regmap_update_bits_check_async(component->regmap, reg,
 835                                                     mask, val, &change);
 836        else
 837                ret = snd_soc_component_update_bits_legacy(component, reg,
 838                                                           mask, val, &change);
 839
 840        if (ret < 0)
 841                return soc_component_ret(component, ret);
 842        return change;
 843}
 844EXPORT_SYMBOL_GPL(snd_soc_component_update_bits_async);
 845
 846/**
 847 * snd_soc_component_read_field() - Read register field value
 848 * @component: Component to read from
 849 * @reg: Register to read
 850 * @mask: mask of the register field
 851 *
 852 * Return: read value of register field.
 853 */
 854unsigned int snd_soc_component_read_field(struct snd_soc_component *component,
 855                                          unsigned int reg, unsigned int mask)
 856{
 857        unsigned int val;
 858
 859        val = snd_soc_component_read(component, reg);
 860
 861        val = (val & mask) >> soc_component_field_shift(component, mask);
 862
 863        return val;
 864}
 865EXPORT_SYMBOL_GPL(snd_soc_component_read_field);
 866
 867/**
 868 * snd_soc_component_write_field() - write to register field
 869 * @component: Component to write to
 870 * @reg: Register to write
 871 * @mask: mask of the register field to update
 872 * @val: value of the field to write
 873 *
 874 * Return: 1 for change, otherwise 0.
 875 */
 876int snd_soc_component_write_field(struct snd_soc_component *component,
 877                                  unsigned int reg, unsigned int mask,
 878                                  unsigned int val)
 879{
 880
 881        val = (val << soc_component_field_shift(component, mask)) & mask;
 882
 883        return snd_soc_component_update_bits(component, reg, mask, val);
 884}
 885EXPORT_SYMBOL_GPL(snd_soc_component_write_field);
 886
 887/**
 888 * snd_soc_component_async_complete() - Ensure asynchronous I/O has completed
 889 * @component: Component for which to wait
 890 *
 891 * This function blocks until all asynchronous I/O which has previously been
 892 * scheduled using snd_soc_component_update_bits_async() has completed.
 893 */
 894void snd_soc_component_async_complete(struct snd_soc_component *component)
 895{
 896        if (component->regmap)
 897                regmap_async_complete(component->regmap);
 898}
 899EXPORT_SYMBOL_GPL(snd_soc_component_async_complete);
 900
 901/**
 902 * snd_soc_component_test_bits - Test register for change
 903 * @component: component
 904 * @reg: Register to test
 905 * @mask: Mask that specifies which bits to test
 906 * @value: Value to test against
 907 *
 908 * Tests a register with a new value and checks if the new value is
 909 * different from the old value.
 910 *
 911 * Return: 1 for change, otherwise 0.
 912 */
 913int snd_soc_component_test_bits(struct snd_soc_component *component,
 914                                unsigned int reg, unsigned int mask, unsigned int value)
 915{
 916        unsigned int old, new;
 917
 918        old = snd_soc_component_read(component, reg);
 919        new = (old & ~mask) | value;
 920        return old != new;
 921}
 922EXPORT_SYMBOL_GPL(snd_soc_component_test_bits);
 923
 924int snd_soc_pcm_component_pointer(struct snd_pcm_substream *substream)
 925{
 926        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 927        struct snd_soc_component *component;
 928        int i;
 929
 930        /* FIXME: use 1st pointer */
 931        for_each_rtd_components(rtd, i, component)
 932                if (component->driver->pointer)
 933                        return component->driver->pointer(component, substream);
 934
 935        return 0;
 936}
 937
 938int snd_soc_pcm_component_ioctl(struct snd_pcm_substream *substream,
 939                                unsigned int cmd, void *arg)
 940{
 941        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 942        struct snd_soc_component *component;
 943        int i;
 944
 945        /* FIXME: use 1st ioctl */
 946        for_each_rtd_components(rtd, i, component)
 947                if (component->driver->ioctl)
 948                        return soc_component_ret(
 949                                component,
 950                                component->driver->ioctl(component,
 951                                                         substream, cmd, arg));
 952
 953        return snd_pcm_lib_ioctl(substream, cmd, arg);
 954}
 955
 956int snd_soc_pcm_component_sync_stop(struct snd_pcm_substream *substream)
 957{
 958        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 959        struct snd_soc_component *component;
 960        int i, ret;
 961
 962        for_each_rtd_components(rtd, i, component) {
 963                if (component->driver->sync_stop) {
 964                        ret = component->driver->sync_stop(component,
 965                                                           substream);
 966                        if (ret < 0)
 967                                return soc_component_ret(component, ret);
 968                }
 969        }
 970
 971        return 0;
 972}
 973
 974int snd_soc_pcm_component_copy_user(struct snd_pcm_substream *substream,
 975                                    int channel, unsigned long pos,
 976                                    void __user *buf, unsigned long bytes)
 977{
 978        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 979        struct snd_soc_component *component;
 980        int i;
 981
 982        /* FIXME. it returns 1st copy now */
 983        for_each_rtd_components(rtd, i, component)
 984                if (component->driver->copy_user)
 985                        return soc_component_ret(
 986                                component,
 987                                component->driver->copy_user(
 988                                        component, substream, channel,
 989                                        pos, buf, bytes));
 990
 991        return -EINVAL;
 992}
 993
 994struct page *snd_soc_pcm_component_page(struct snd_pcm_substream *substream,
 995                                        unsigned long offset)
 996{
 997        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
 998        struct snd_soc_component *component;
 999        struct page *page;
1000        int i;
1001
1002        /* FIXME. it returns 1st page now */
1003        for_each_rtd_components(rtd, i, component) {
1004                if (component->driver->page) {
1005                        page = component->driver->page(component,
1006                                                       substream, offset);
1007                        if (page)
1008                                return page;
1009                }
1010        }
1011
1012        return NULL;
1013}
1014
1015int snd_soc_pcm_component_mmap(struct snd_pcm_substream *substream,
1016                               struct vm_area_struct *vma)
1017{
1018        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1019        struct snd_soc_component *component;
1020        int i;
1021
1022        /* FIXME. it returns 1st mmap now */
1023        for_each_rtd_components(rtd, i, component)
1024                if (component->driver->mmap)
1025                        return soc_component_ret(
1026                                component,
1027                                component->driver->mmap(component,
1028                                                        substream, vma));
1029
1030        return -EINVAL;
1031}
1032
1033int snd_soc_pcm_component_new(struct snd_soc_pcm_runtime *rtd)
1034{
1035        struct snd_soc_component *component;
1036        int ret;
1037        int i;
1038
1039        for_each_rtd_components(rtd, i, component) {
1040                if (component->driver->pcm_construct) {
1041                        ret = component->driver->pcm_construct(component, rtd);
1042                        if (ret < 0)
1043                                return soc_component_ret(component, ret);
1044                }
1045        }
1046
1047        return 0;
1048}
1049
1050void snd_soc_pcm_component_free(struct snd_soc_pcm_runtime *rtd)
1051{
1052        struct snd_soc_component *component;
1053        int i;
1054
1055        if (!rtd->pcm)
1056                return;
1057
1058        for_each_rtd_components(rtd, i, component)
1059                if (component->driver->pcm_destruct)
1060                        component->driver->pcm_destruct(component, rtd->pcm);
1061}
1062
1063int snd_soc_pcm_component_prepare(struct snd_pcm_substream *substream)
1064{
1065        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1066        struct snd_soc_component *component;
1067        int i, ret;
1068
1069        for_each_rtd_components(rtd, i, component) {
1070                if (component->driver->prepare) {
1071                        ret = component->driver->prepare(component, substream);
1072                        if (ret < 0)
1073                                return soc_component_ret(component, ret);
1074                }
1075        }
1076
1077        return 0;
1078}
1079
1080int snd_soc_pcm_component_hw_params(struct snd_pcm_substream *substream,
1081                                    struct snd_pcm_hw_params *params)
1082{
1083        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1084        struct snd_soc_component *component;
1085        int i, ret;
1086
1087        for_each_rtd_components(rtd, i, component) {
1088                if (component->driver->hw_params) {
1089                        ret = component->driver->hw_params(component,
1090                                                           substream, params);
1091                        if (ret < 0)
1092                                return soc_component_ret(component, ret);
1093                }
1094                /* mark substream if succeeded */
1095                soc_component_mark_push(component, substream, hw_params);
1096        }
1097
1098        return 0;
1099}
1100
1101void snd_soc_pcm_component_hw_free(struct snd_pcm_substream *substream,
1102                                   int rollback)
1103{
1104        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1105        struct snd_soc_component *component;
1106        int i, ret;
1107
1108        for_each_rtd_components(rtd, i, component) {
1109                if (rollback && !soc_component_mark_match(component, substream, hw_params))
1110                        continue;
1111
1112                if (component->driver->hw_free) {
1113                        ret = component->driver->hw_free(component, substream);
1114                        if (ret < 0)
1115                                soc_component_ret(component, ret);
1116                }
1117
1118                /* remove marked substream */
1119                soc_component_mark_pop(component, substream, hw_params);
1120        }
1121}
1122
1123static int soc_component_trigger(struct snd_soc_component *component,
1124                                 struct snd_pcm_substream *substream,
1125                                 int cmd)
1126{
1127        int ret = 0;
1128
1129        if (component->driver->trigger)
1130                ret = component->driver->trigger(component, substream, cmd);
1131
1132        return soc_component_ret(component, ret);
1133}
1134
1135int snd_soc_pcm_component_trigger(struct snd_pcm_substream *substream,
1136                                  int cmd, int rollback)
1137{
1138        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1139        struct snd_soc_component *component;
1140        int i, r, ret = 0;
1141
1142        switch (cmd) {
1143        case SNDRV_PCM_TRIGGER_START:
1144        case SNDRV_PCM_TRIGGER_RESUME:
1145        case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1146                for_each_rtd_components(rtd, i, component) {
1147                        ret = soc_component_trigger(component, substream, cmd);
1148                        if (ret < 0)
1149                                break;
1150                        soc_component_mark_push(component, substream, trigger);
1151                }
1152                break;
1153        case SNDRV_PCM_TRIGGER_STOP:
1154        case SNDRV_PCM_TRIGGER_SUSPEND:
1155        case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1156                for_each_rtd_components(rtd, i, component) {
1157                        if (rollback && !soc_component_mark_match(component, substream, trigger))
1158                                continue;
1159
1160                        r = soc_component_trigger(component, substream, cmd);
1161                        if (r < 0)
1162                                ret = r; /* use last ret */
1163                        soc_component_mark_pop(component, substream, trigger);
1164                }
1165        }
1166
1167        return ret;
1168}
1169
1170int snd_soc_pcm_component_pm_runtime_get(struct snd_soc_pcm_runtime *rtd,
1171                                         void *stream)
1172{
1173        struct snd_soc_component *component;
1174        int i;
1175
1176        for_each_rtd_components(rtd, i, component) {
1177                int ret = pm_runtime_get_sync(component->dev);
1178                if (ret < 0 && ret != -EACCES) {
1179                        pm_runtime_put_noidle(component->dev);
1180                        return soc_component_ret(component, ret);
1181                }
1182                /* mark stream if succeeded */
1183                soc_component_mark_push(component, stream, pm);
1184        }
1185
1186        return 0;
1187}
1188
1189void snd_soc_pcm_component_pm_runtime_put(struct snd_soc_pcm_runtime *rtd,
1190                                          void *stream, int rollback)
1191{
1192        struct snd_soc_component *component;
1193        int i;
1194
1195        for_each_rtd_components(rtd, i, component) {
1196                if (rollback && !soc_component_mark_match(component, stream, pm))
1197                        continue;
1198
1199                pm_runtime_mark_last_busy(component->dev);
1200                pm_runtime_put_autosuspend(component->dev);
1201
1202                /* remove marked stream */
1203                soc_component_mark_pop(component, stream, pm);
1204        }
1205}
1206
1207int snd_soc_pcm_component_ack(struct snd_pcm_substream *substream)
1208{
1209        struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1210        struct snd_soc_component *component;
1211        int i;
1212
1213        /* FIXME: use 1st pointer */
1214        for_each_rtd_components(rtd, i, component)
1215                if (component->driver->ack)
1216                        return component->driver->ack(component, substream);
1217
1218        return 0;
1219}
1220