linux/sound/soc/intel/skylake/skl-topology.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 *  skl-topology.c - Implements Platform component ALSA controls/widget
   4 *  handlers.
   5 *
   6 *  Copyright (C) 2014-2015 Intel Corp
   7 *  Author: Jeeja KP <jeeja.kp@intel.com>
   8 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
   9 */
  10
  11#include <linux/slab.h>
  12#include <linux/types.h>
  13#include <linux/firmware.h>
  14#include <linux/uuid.h>
  15#include <sound/intel-nhlt.h>
  16#include <sound/soc.h>
  17#include <sound/soc-acpi.h>
  18#include <sound/soc-topology.h>
  19#include <uapi/sound/snd_sst_tokens.h>
  20#include <uapi/sound/skl-tplg-interface.h>
  21#include "skl-sst-dsp.h"
  22#include "skl-sst-ipc.h"
  23#include "skl-topology.h"
  24#include "skl.h"
  25#include "../common/sst-dsp.h"
  26#include "../common/sst-dsp-priv.h"
  27
  28#define SKL_CH_FIXUP_MASK               (1 << 0)
  29#define SKL_RATE_FIXUP_MASK             (1 << 1)
  30#define SKL_FMT_FIXUP_MASK              (1 << 2)
  31#define SKL_IN_DIR_BIT_MASK             BIT(0)
  32#define SKL_PIN_COUNT_MASK              GENMASK(7, 4)
  33
  34static const int mic_mono_list[] = {
  350, 1, 2, 3,
  36};
  37static const int mic_stereo_list[][SKL_CH_STEREO] = {
  38{0, 1}, {0, 2}, {0, 3}, {1, 2}, {1, 3}, {2, 3},
  39};
  40static const int mic_trio_list[][SKL_CH_TRIO] = {
  41{0, 1, 2}, {0, 1, 3}, {0, 2, 3}, {1, 2, 3},
  42};
  43static const int mic_quatro_list[][SKL_CH_QUATRO] = {
  44{0, 1, 2, 3},
  45};
  46
  47#define CHECK_HW_PARAMS(ch, freq, bps, prm_ch, prm_freq, prm_bps) \
  48        ((ch == prm_ch) && (bps == prm_bps) && (freq == prm_freq))
  49
  50void skl_tplg_d0i3_get(struct skl_dev *skl, enum d0i3_capability caps)
  51{
  52        struct skl_d0i3_data *d0i3 =  &skl->d0i3;
  53
  54        switch (caps) {
  55        case SKL_D0I3_NONE:
  56                d0i3->non_d0i3++;
  57                break;
  58
  59        case SKL_D0I3_STREAMING:
  60                d0i3->streaming++;
  61                break;
  62
  63        case SKL_D0I3_NON_STREAMING:
  64                d0i3->non_streaming++;
  65                break;
  66        }
  67}
  68
  69void skl_tplg_d0i3_put(struct skl_dev *skl, enum d0i3_capability caps)
  70{
  71        struct skl_d0i3_data *d0i3 =  &skl->d0i3;
  72
  73        switch (caps) {
  74        case SKL_D0I3_NONE:
  75                d0i3->non_d0i3--;
  76                break;
  77
  78        case SKL_D0I3_STREAMING:
  79                d0i3->streaming--;
  80                break;
  81
  82        case SKL_D0I3_NON_STREAMING:
  83                d0i3->non_streaming--;
  84                break;
  85        }
  86}
  87
  88/*
  89 * SKL DSP driver modelling uses only few DAPM widgets so for rest we will
  90 * ignore. This helpers checks if the SKL driver handles this widget type
  91 */
  92static int is_skl_dsp_widget_type(struct snd_soc_dapm_widget *w,
  93                                  struct device *dev)
  94{
  95        if (w->dapm->dev != dev)
  96                return false;
  97
  98        switch (w->id) {
  99        case snd_soc_dapm_dai_link:
 100        case snd_soc_dapm_dai_in:
 101        case snd_soc_dapm_aif_in:
 102        case snd_soc_dapm_aif_out:
 103        case snd_soc_dapm_dai_out:
 104        case snd_soc_dapm_switch:
 105        case snd_soc_dapm_output:
 106        case snd_soc_dapm_mux:
 107
 108                return false;
 109        default:
 110                return true;
 111        }
 112}
 113
 114static void skl_dump_mconfig(struct skl_dev *skl, struct skl_module_cfg *mcfg)
 115{
 116        struct skl_module_iface *iface = &mcfg->module->formats[mcfg->fmt_idx];
 117
 118        dev_dbg(skl->dev, "Dumping config\n");
 119        dev_dbg(skl->dev, "Input Format:\n");
 120        dev_dbg(skl->dev, "channels = %d\n", iface->inputs[0].fmt.channels);
 121        dev_dbg(skl->dev, "s_freq = %d\n", iface->inputs[0].fmt.s_freq);
 122        dev_dbg(skl->dev, "ch_cfg = %d\n", iface->inputs[0].fmt.ch_cfg);
 123        dev_dbg(skl->dev, "valid bit depth = %d\n",
 124                                iface->inputs[0].fmt.valid_bit_depth);
 125        dev_dbg(skl->dev, "Output Format:\n");
 126        dev_dbg(skl->dev, "channels = %d\n", iface->outputs[0].fmt.channels);
 127        dev_dbg(skl->dev, "s_freq = %d\n", iface->outputs[0].fmt.s_freq);
 128        dev_dbg(skl->dev, "valid bit depth = %d\n",
 129                                iface->outputs[0].fmt.valid_bit_depth);
 130        dev_dbg(skl->dev, "ch_cfg = %d\n", iface->outputs[0].fmt.ch_cfg);
 131}
 132
 133static void skl_tplg_update_chmap(struct skl_module_fmt *fmt, int chs)
 134{
 135        int slot_map = 0xFFFFFFFF;
 136        int start_slot = 0;
 137        int i;
 138
 139        for (i = 0; i < chs; i++) {
 140                /*
 141                 * For 2 channels with starting slot as 0, slot map will
 142                 * look like 0xFFFFFF10.
 143                 */
 144                slot_map &= (~(0xF << (4 * i)) | (start_slot << (4 * i)));
 145                start_slot++;
 146        }
 147        fmt->ch_map = slot_map;
 148}
 149
 150static void skl_tplg_update_params(struct skl_module_fmt *fmt,
 151                        struct skl_pipe_params *params, int fixup)
 152{
 153        if (fixup & SKL_RATE_FIXUP_MASK)
 154                fmt->s_freq = params->s_freq;
 155        if (fixup & SKL_CH_FIXUP_MASK) {
 156                fmt->channels = params->ch;
 157                skl_tplg_update_chmap(fmt, fmt->channels);
 158        }
 159        if (fixup & SKL_FMT_FIXUP_MASK) {
 160                fmt->valid_bit_depth = skl_get_bit_depth(params->s_fmt);
 161
 162                /*
 163                 * 16 bit is 16 bit container whereas 24 bit is in 32 bit
 164                 * container so update bit depth accordingly
 165                 */
 166                switch (fmt->valid_bit_depth) {
 167                case SKL_DEPTH_16BIT:
 168                        fmt->bit_depth = fmt->valid_bit_depth;
 169                        break;
 170
 171                default:
 172                        fmt->bit_depth = SKL_DEPTH_32BIT;
 173                        break;
 174                }
 175        }
 176
 177}
 178
 179/*
 180 * A pipeline may have modules which impact the pcm parameters, like SRC,
 181 * channel converter, format converter.
 182 * We need to calculate the output params by applying the 'fixup'
 183 * Topology will tell driver which type of fixup is to be applied by
 184 * supplying the fixup mask, so based on that we calculate the output
 185 *
 186 * Now In FE the pcm hw_params is source/target format. Same is applicable
 187 * for BE with its hw_params invoked.
 188 * here based on FE, BE pipeline and direction we calculate the input and
 189 * outfix and then apply that for a module
 190 */
 191static void skl_tplg_update_params_fixup(struct skl_module_cfg *m_cfg,
 192                struct skl_pipe_params *params, bool is_fe)
 193{
 194        int in_fixup, out_fixup;
 195        struct skl_module_fmt *in_fmt, *out_fmt;
 196
 197        /* Fixups will be applied to pin 0 only */
 198        in_fmt = &m_cfg->module->formats[m_cfg->fmt_idx].inputs[0].fmt;
 199        out_fmt = &m_cfg->module->formats[m_cfg->fmt_idx].outputs[0].fmt;
 200
 201        if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 202                if (is_fe) {
 203                        in_fixup = m_cfg->params_fixup;
 204                        out_fixup = (~m_cfg->converter) &
 205                                        m_cfg->params_fixup;
 206                } else {
 207                        out_fixup = m_cfg->params_fixup;
 208                        in_fixup = (~m_cfg->converter) &
 209                                        m_cfg->params_fixup;
 210                }
 211        } else {
 212                if (is_fe) {
 213                        out_fixup = m_cfg->params_fixup;
 214                        in_fixup = (~m_cfg->converter) &
 215                                        m_cfg->params_fixup;
 216                } else {
 217                        in_fixup = m_cfg->params_fixup;
 218                        out_fixup = (~m_cfg->converter) &
 219                                        m_cfg->params_fixup;
 220                }
 221        }
 222
 223        skl_tplg_update_params(in_fmt, params, in_fixup);
 224        skl_tplg_update_params(out_fmt, params, out_fixup);
 225}
 226
 227/*
 228 * A module needs input and output buffers, which are dependent upon pcm
 229 * params, so once we have calculate params, we need buffer calculation as
 230 * well.
 231 */
 232static void skl_tplg_update_buffer_size(struct skl_dev *skl,
 233                                struct skl_module_cfg *mcfg)
 234{
 235        int multiplier = 1;
 236        struct skl_module_fmt *in_fmt, *out_fmt;
 237        struct skl_module_res *res;
 238
 239        /* Since fixups is applied to pin 0 only, ibs, obs needs
 240         * change for pin 0 only
 241         */
 242        res = &mcfg->module->resources[mcfg->res_idx];
 243        in_fmt = &mcfg->module->formats[mcfg->fmt_idx].inputs[0].fmt;
 244        out_fmt = &mcfg->module->formats[mcfg->fmt_idx].outputs[0].fmt;
 245
 246        if (mcfg->m_type == SKL_MODULE_TYPE_SRCINT)
 247                multiplier = 5;
 248
 249        res->ibs = DIV_ROUND_UP(in_fmt->s_freq, 1000) *
 250                        in_fmt->channels * (in_fmt->bit_depth >> 3) *
 251                        multiplier;
 252
 253        res->obs = DIV_ROUND_UP(out_fmt->s_freq, 1000) *
 254                        out_fmt->channels * (out_fmt->bit_depth >> 3) *
 255                        multiplier;
 256}
 257
 258static u8 skl_tplg_be_dev_type(int dev_type)
 259{
 260        int ret;
 261
 262        switch (dev_type) {
 263        case SKL_DEVICE_BT:
 264                ret = NHLT_DEVICE_BT;
 265                break;
 266
 267        case SKL_DEVICE_DMIC:
 268                ret = NHLT_DEVICE_DMIC;
 269                break;
 270
 271        case SKL_DEVICE_I2S:
 272                ret = NHLT_DEVICE_I2S;
 273                break;
 274
 275        default:
 276                ret = NHLT_DEVICE_INVALID;
 277                break;
 278        }
 279
 280        return ret;
 281}
 282
 283static int skl_tplg_update_be_blob(struct snd_soc_dapm_widget *w,
 284                                                struct skl_dev *skl)
 285{
 286        struct skl_module_cfg *m_cfg = w->priv;
 287        int link_type, dir;
 288        u32 ch, s_freq, s_fmt;
 289        struct nhlt_specific_cfg *cfg;
 290        u8 dev_type = skl_tplg_be_dev_type(m_cfg->dev_type);
 291        int fmt_idx = m_cfg->fmt_idx;
 292        struct skl_module_iface *m_iface = &m_cfg->module->formats[fmt_idx];
 293
 294        /* check if we already have blob */
 295        if (m_cfg->formats_config[SKL_PARAM_INIT].caps_size > 0)
 296                return 0;
 297
 298        dev_dbg(skl->dev, "Applying default cfg blob\n");
 299        switch (m_cfg->dev_type) {
 300        case SKL_DEVICE_DMIC:
 301                link_type = NHLT_LINK_DMIC;
 302                dir = SNDRV_PCM_STREAM_CAPTURE;
 303                s_freq = m_iface->inputs[0].fmt.s_freq;
 304                s_fmt = m_iface->inputs[0].fmt.bit_depth;
 305                ch = m_iface->inputs[0].fmt.channels;
 306                break;
 307
 308        case SKL_DEVICE_I2S:
 309                link_type = NHLT_LINK_SSP;
 310                if (m_cfg->hw_conn_type == SKL_CONN_SOURCE) {
 311                        dir = SNDRV_PCM_STREAM_PLAYBACK;
 312                        s_freq = m_iface->outputs[0].fmt.s_freq;
 313                        s_fmt = m_iface->outputs[0].fmt.bit_depth;
 314                        ch = m_iface->outputs[0].fmt.channels;
 315                } else {
 316                        dir = SNDRV_PCM_STREAM_CAPTURE;
 317                        s_freq = m_iface->inputs[0].fmt.s_freq;
 318                        s_fmt = m_iface->inputs[0].fmt.bit_depth;
 319                        ch = m_iface->inputs[0].fmt.channels;
 320                }
 321                break;
 322
 323        default:
 324                return -EINVAL;
 325        }
 326
 327        /* update the blob based on virtual bus_id and default params */
 328        cfg = skl_get_ep_blob(skl, m_cfg->vbus_id, link_type,
 329                                        s_fmt, ch, s_freq, dir, dev_type);
 330        if (cfg) {
 331                m_cfg->formats_config[SKL_PARAM_INIT].caps_size = cfg->size;
 332                m_cfg->formats_config[SKL_PARAM_INIT].caps = (u32 *)&cfg->caps;
 333        } else {
 334                dev_err(skl->dev, "Blob NULL for id %x type %d dirn %d\n",
 335                                        m_cfg->vbus_id, link_type, dir);
 336                dev_err(skl->dev, "PCM: ch %d, freq %d, fmt %d\n",
 337                                        ch, s_freq, s_fmt);
 338                return -EIO;
 339        }
 340
 341        return 0;
 342}
 343
 344static void skl_tplg_update_module_params(struct snd_soc_dapm_widget *w,
 345                                                        struct skl_dev *skl)
 346{
 347        struct skl_module_cfg *m_cfg = w->priv;
 348        struct skl_pipe_params *params = m_cfg->pipe->p_params;
 349        int p_conn_type = m_cfg->pipe->conn_type;
 350        bool is_fe;
 351
 352        if (!m_cfg->params_fixup)
 353                return;
 354
 355        dev_dbg(skl->dev, "Mconfig for widget=%s BEFORE updation\n",
 356                                w->name);
 357
 358        skl_dump_mconfig(skl, m_cfg);
 359
 360        if (p_conn_type == SKL_PIPE_CONN_TYPE_FE)
 361                is_fe = true;
 362        else
 363                is_fe = false;
 364
 365        skl_tplg_update_params_fixup(m_cfg, params, is_fe);
 366        skl_tplg_update_buffer_size(skl, m_cfg);
 367
 368        dev_dbg(skl->dev, "Mconfig for widget=%s AFTER updation\n",
 369                                w->name);
 370
 371        skl_dump_mconfig(skl, m_cfg);
 372}
 373
 374/*
 375 * some modules can have multiple params set from user control and
 376 * need to be set after module is initialized. If set_param flag is
 377 * set module params will be done after module is initialised.
 378 */
 379static int skl_tplg_set_module_params(struct snd_soc_dapm_widget *w,
 380                                                struct skl_dev *skl)
 381{
 382        int i, ret;
 383        struct skl_module_cfg *mconfig = w->priv;
 384        const struct snd_kcontrol_new *k;
 385        struct soc_bytes_ext *sb;
 386        struct skl_algo_data *bc;
 387        struct skl_specific_cfg *sp_cfg;
 388
 389        if (mconfig->formats_config[SKL_PARAM_SET].caps_size > 0 &&
 390            mconfig->formats_config[SKL_PARAM_SET].set_params == SKL_PARAM_SET) {
 391                sp_cfg = &mconfig->formats_config[SKL_PARAM_SET];
 392                ret = skl_set_module_params(skl, sp_cfg->caps,
 393                                        sp_cfg->caps_size,
 394                                        sp_cfg->param_id, mconfig);
 395                if (ret < 0)
 396                        return ret;
 397        }
 398
 399        for (i = 0; i < w->num_kcontrols; i++) {
 400                k = &w->kcontrol_news[i];
 401                if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
 402                        sb = (void *) k->private_value;
 403                        bc = (struct skl_algo_data *)sb->dobj.private;
 404
 405                        if (bc->set_params == SKL_PARAM_SET) {
 406                                ret = skl_set_module_params(skl,
 407                                                (u32 *)bc->params, bc->size,
 408                                                bc->param_id, mconfig);
 409                                if (ret < 0)
 410                                        return ret;
 411                        }
 412                }
 413        }
 414
 415        return 0;
 416}
 417
 418/*
 419 * some module param can set from user control and this is required as
 420 * when module is initailzed. if module param is required in init it is
 421 * identifed by set_param flag. if set_param flag is not set, then this
 422 * parameter needs to set as part of module init.
 423 */
 424static int skl_tplg_set_module_init_data(struct snd_soc_dapm_widget *w)
 425{
 426        const struct snd_kcontrol_new *k;
 427        struct soc_bytes_ext *sb;
 428        struct skl_algo_data *bc;
 429        struct skl_module_cfg *mconfig = w->priv;
 430        int i;
 431
 432        for (i = 0; i < w->num_kcontrols; i++) {
 433                k = &w->kcontrol_news[i];
 434                if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
 435                        sb = (struct soc_bytes_ext *)k->private_value;
 436                        bc = (struct skl_algo_data *)sb->dobj.private;
 437
 438                        if (bc->set_params != SKL_PARAM_INIT)
 439                                continue;
 440
 441                        mconfig->formats_config[SKL_PARAM_INIT].caps =
 442                                                        (u32 *)bc->params;
 443                        mconfig->formats_config[SKL_PARAM_INIT].caps_size =
 444                                                                bc->size;
 445
 446                        break;
 447                }
 448        }
 449
 450        return 0;
 451}
 452
 453static int skl_tplg_module_prepare(struct skl_dev *skl, struct skl_pipe *pipe,
 454                struct snd_soc_dapm_widget *w, struct skl_module_cfg *mcfg)
 455{
 456        switch (mcfg->dev_type) {
 457        case SKL_DEVICE_HDAHOST:
 458                return skl_pcm_host_dma_prepare(skl->dev, pipe->p_params);
 459
 460        case SKL_DEVICE_HDALINK:
 461                return skl_pcm_link_dma_prepare(skl->dev, pipe->p_params);
 462        }
 463
 464        return 0;
 465}
 466
 467/*
 468 * Inside a pipe instance, we can have various modules. These modules need
 469 * to instantiated in DSP by invoking INIT_MODULE IPC, which is achieved by
 470 * skl_init_module() routine, so invoke that for all modules in a pipeline
 471 */
 472static int
 473skl_tplg_init_pipe_modules(struct skl_dev *skl, struct skl_pipe *pipe)
 474{
 475        struct skl_pipe_module *w_module;
 476        struct snd_soc_dapm_widget *w;
 477        struct skl_module_cfg *mconfig;
 478        u8 cfg_idx;
 479        int ret = 0;
 480
 481        list_for_each_entry(w_module, &pipe->w_list, node) {
 482                guid_t *uuid_mod;
 483                w = w_module->w;
 484                mconfig = w->priv;
 485
 486                /* check if module ids are populated */
 487                if (mconfig->id.module_id < 0) {
 488                        dev_err(skl->dev,
 489                                        "module %pUL id not populated\n",
 490                                        (guid_t *)mconfig->guid);
 491                        return -EIO;
 492                }
 493
 494                cfg_idx = mconfig->pipe->cur_config_idx;
 495                mconfig->fmt_idx = mconfig->mod_cfg[cfg_idx].fmt_idx;
 496                mconfig->res_idx = mconfig->mod_cfg[cfg_idx].res_idx;
 497
 498                if (mconfig->module->loadable && skl->dsp->fw_ops.load_mod) {
 499                        ret = skl->dsp->fw_ops.load_mod(skl->dsp,
 500                                mconfig->id.module_id, mconfig->guid);
 501                        if (ret < 0)
 502                                return ret;
 503                }
 504
 505                /* prepare the DMA if the module is gateway cpr */
 506                ret = skl_tplg_module_prepare(skl, pipe, w, mconfig);
 507                if (ret < 0)
 508                        return ret;
 509
 510                /* update blob if blob is null for be with default value */
 511                skl_tplg_update_be_blob(w, skl);
 512
 513                /*
 514                 * apply fix/conversion to module params based on
 515                 * FE/BE params
 516                 */
 517                skl_tplg_update_module_params(w, skl);
 518                uuid_mod = (guid_t *)mconfig->guid;
 519                mconfig->id.pvt_id = skl_get_pvt_id(skl, uuid_mod,
 520                                                mconfig->id.instance_id);
 521                if (mconfig->id.pvt_id < 0)
 522                        return ret;
 523                skl_tplg_set_module_init_data(w);
 524
 525                ret = skl_dsp_get_core(skl->dsp, mconfig->core_id);
 526                if (ret < 0) {
 527                        dev_err(skl->dev, "Failed to wake up core %d ret=%d\n",
 528                                                mconfig->core_id, ret);
 529                        return ret;
 530                }
 531
 532                ret = skl_init_module(skl, mconfig);
 533                if (ret < 0) {
 534                        skl_put_pvt_id(skl, uuid_mod, &mconfig->id.pvt_id);
 535                        goto err;
 536                }
 537
 538                ret = skl_tplg_set_module_params(w, skl);
 539                if (ret < 0)
 540                        goto err;
 541        }
 542
 543        return 0;
 544err:
 545        skl_dsp_put_core(skl->dsp, mconfig->core_id);
 546        return ret;
 547}
 548
 549static int skl_tplg_unload_pipe_modules(struct skl_dev *skl,
 550         struct skl_pipe *pipe)
 551{
 552        int ret = 0;
 553        struct skl_pipe_module *w_module;
 554        struct skl_module_cfg *mconfig;
 555
 556        list_for_each_entry(w_module, &pipe->w_list, node) {
 557                guid_t *uuid_mod;
 558                mconfig  = w_module->w->priv;
 559                uuid_mod = (guid_t *)mconfig->guid;
 560
 561                if (mconfig->module->loadable && skl->dsp->fw_ops.unload_mod) {
 562                        ret = skl->dsp->fw_ops.unload_mod(skl->dsp,
 563                                                mconfig->id.module_id);
 564                        if (ret < 0)
 565                                return -EIO;
 566                }
 567                skl_put_pvt_id(skl, uuid_mod, &mconfig->id.pvt_id);
 568
 569                ret = skl_dsp_put_core(skl->dsp, mconfig->core_id);
 570                if (ret < 0) {
 571                        /* don't return; continue with other modules */
 572                        dev_err(skl->dev, "Failed to sleep core %d ret=%d\n",
 573                                mconfig->core_id, ret);
 574                }
 575        }
 576
 577        /* no modules to unload in this path, so return */
 578        return ret;
 579}
 580
 581static bool skl_tplg_is_multi_fmt(struct skl_dev *skl, struct skl_pipe *pipe)
 582{
 583        struct skl_pipe_fmt *cur_fmt;
 584        struct skl_pipe_fmt *next_fmt;
 585        int i;
 586
 587        if (pipe->nr_cfgs <= 1)
 588                return false;
 589
 590        if (pipe->conn_type != SKL_PIPE_CONN_TYPE_FE)
 591                return true;
 592
 593        for (i = 0; i < pipe->nr_cfgs - 1; i++) {
 594                if (pipe->direction == SNDRV_PCM_STREAM_PLAYBACK) {
 595                        cur_fmt = &pipe->configs[i].out_fmt;
 596                        next_fmt = &pipe->configs[i + 1].out_fmt;
 597                } else {
 598                        cur_fmt = &pipe->configs[i].in_fmt;
 599                        next_fmt = &pipe->configs[i + 1].in_fmt;
 600                }
 601
 602                if (!CHECK_HW_PARAMS(cur_fmt->channels, cur_fmt->freq,
 603                                     cur_fmt->bps,
 604                                     next_fmt->channels,
 605                                     next_fmt->freq,
 606                                     next_fmt->bps))
 607                        return true;
 608        }
 609
 610        return false;
 611}
 612
 613/*
 614 * Here, we select pipe format based on the pipe type and pipe
 615 * direction to determine the current config index for the pipeline.
 616 * The config index is then used to select proper module resources.
 617 * Intermediate pipes currently have a fixed format hence we select the
 618 * 0th configuratation by default for such pipes.
 619 */
 620static int
 621skl_tplg_get_pipe_config(struct skl_dev *skl, struct skl_module_cfg *mconfig)
 622{
 623        struct skl_pipe *pipe = mconfig->pipe;
 624        struct skl_pipe_params *params = pipe->p_params;
 625        struct skl_path_config *pconfig = &pipe->configs[0];
 626        struct skl_pipe_fmt *fmt = NULL;
 627        bool in_fmt = false;
 628        int i;
 629
 630        if (pipe->nr_cfgs == 0) {
 631                pipe->cur_config_idx = 0;
 632                return 0;
 633        }
 634
 635        if (skl_tplg_is_multi_fmt(skl, pipe)) {
 636                pipe->cur_config_idx = pipe->pipe_config_idx;
 637                pipe->memory_pages = pconfig->mem_pages;
 638                dev_dbg(skl->dev, "found pipe config idx:%d\n",
 639                        pipe->cur_config_idx);
 640                return 0;
 641        }
 642
 643        if (pipe->conn_type == SKL_PIPE_CONN_TYPE_NONE || pipe->nr_cfgs == 1) {
 644                dev_dbg(skl->dev, "No conn_type or just 1 pathcfg, taking 0th for %d\n",
 645                        pipe->ppl_id);
 646                pipe->cur_config_idx = 0;
 647                pipe->memory_pages = pconfig->mem_pages;
 648
 649                return 0;
 650        }
 651
 652        if ((pipe->conn_type == SKL_PIPE_CONN_TYPE_FE &&
 653             pipe->direction == SNDRV_PCM_STREAM_PLAYBACK) ||
 654             (pipe->conn_type == SKL_PIPE_CONN_TYPE_BE &&
 655             pipe->direction == SNDRV_PCM_STREAM_CAPTURE))
 656                in_fmt = true;
 657
 658        for (i = 0; i < pipe->nr_cfgs; i++) {
 659                pconfig = &pipe->configs[i];
 660                if (in_fmt)
 661                        fmt = &pconfig->in_fmt;
 662                else
 663                        fmt = &pconfig->out_fmt;
 664
 665                if (CHECK_HW_PARAMS(params->ch, params->s_freq, params->s_fmt,
 666                                    fmt->channels, fmt->freq, fmt->bps)) {
 667                        pipe->cur_config_idx = i;
 668                        pipe->memory_pages = pconfig->mem_pages;
 669                        dev_dbg(skl->dev, "Using pipe config: %d\n", i);
 670
 671                        return 0;
 672                }
 673        }
 674
 675        dev_err(skl->dev, "Invalid pipe config: %d %d %d for pipe: %d\n",
 676                params->ch, params->s_freq, params->s_fmt, pipe->ppl_id);
 677        return -EINVAL;
 678}
 679
 680/*
 681 * Mixer module represents a pipeline. So in the Pre-PMU event of mixer we
 682 * need create the pipeline. So we do following:
 683 *   - Create the pipeline
 684 *   - Initialize the modules in pipeline
 685 *   - finally bind all modules together
 686 */
 687static int skl_tplg_mixer_dapm_pre_pmu_event(struct snd_soc_dapm_widget *w,
 688                                                        struct skl_dev *skl)
 689{
 690        int ret;
 691        struct skl_module_cfg *mconfig = w->priv;
 692        struct skl_pipe_module *w_module;
 693        struct skl_pipe *s_pipe = mconfig->pipe;
 694        struct skl_module_cfg *src_module = NULL, *dst_module, *module;
 695        struct skl_module_deferred_bind *modules;
 696
 697        ret = skl_tplg_get_pipe_config(skl, mconfig);
 698        if (ret < 0)
 699                return ret;
 700
 701        /*
 702         * Create a list of modules for pipe.
 703         * This list contains modules from source to sink
 704         */
 705        ret = skl_create_pipeline(skl, mconfig->pipe);
 706        if (ret < 0)
 707                return ret;
 708
 709        /* Init all pipe modules from source to sink */
 710        ret = skl_tplg_init_pipe_modules(skl, s_pipe);
 711        if (ret < 0)
 712                return ret;
 713
 714        /* Bind modules from source to sink */
 715        list_for_each_entry(w_module, &s_pipe->w_list, node) {
 716                dst_module = w_module->w->priv;
 717
 718                if (src_module == NULL) {
 719                        src_module = dst_module;
 720                        continue;
 721                }
 722
 723                ret = skl_bind_modules(skl, src_module, dst_module);
 724                if (ret < 0)
 725                        return ret;
 726
 727                src_module = dst_module;
 728        }
 729
 730        /*
 731         * When the destination module is initialized, check for these modules
 732         * in deferred bind list. If found, bind them.
 733         */
 734        list_for_each_entry(w_module, &s_pipe->w_list, node) {
 735                if (list_empty(&skl->bind_list))
 736                        break;
 737
 738                list_for_each_entry(modules, &skl->bind_list, node) {
 739                        module = w_module->w->priv;
 740                        if (modules->dst == module)
 741                                skl_bind_modules(skl, modules->src,
 742                                                        modules->dst);
 743                }
 744        }
 745
 746        return 0;
 747}
 748
 749static int skl_fill_sink_instance_id(struct skl_dev *skl, u32 *params,
 750                                int size, struct skl_module_cfg *mcfg)
 751{
 752        int i, pvt_id;
 753
 754        if (mcfg->m_type == SKL_MODULE_TYPE_KPB) {
 755                struct skl_kpb_params *kpb_params =
 756                                (struct skl_kpb_params *)params;
 757                struct skl_mod_inst_map *inst = kpb_params->u.map;
 758
 759                for (i = 0; i < kpb_params->num_modules; i++) {
 760                        pvt_id = skl_get_pvt_instance_id_map(skl, inst->mod_id,
 761                                                                inst->inst_id);
 762                        if (pvt_id < 0)
 763                                return -EINVAL;
 764
 765                        inst->inst_id = pvt_id;
 766                        inst++;
 767                }
 768        }
 769
 770        return 0;
 771}
 772/*
 773 * Some modules require params to be set after the module is bound to
 774 * all pins connected.
 775 *
 776 * The module provider initializes set_param flag for such modules and we
 777 * send params after binding
 778 */
 779static int skl_tplg_set_module_bind_params(struct snd_soc_dapm_widget *w,
 780                        struct skl_module_cfg *mcfg, struct skl_dev *skl)
 781{
 782        int i, ret;
 783        struct skl_module_cfg *mconfig = w->priv;
 784        const struct snd_kcontrol_new *k;
 785        struct soc_bytes_ext *sb;
 786        struct skl_algo_data *bc;
 787        struct skl_specific_cfg *sp_cfg;
 788        u32 *params;
 789
 790        /*
 791         * check all out/in pins are in bind state.
 792         * if so set the module param
 793         */
 794        for (i = 0; i < mcfg->module->max_output_pins; i++) {
 795                if (mcfg->m_out_pin[i].pin_state != SKL_PIN_BIND_DONE)
 796                        return 0;
 797        }
 798
 799        for (i = 0; i < mcfg->module->max_input_pins; i++) {
 800                if (mcfg->m_in_pin[i].pin_state != SKL_PIN_BIND_DONE)
 801                        return 0;
 802        }
 803
 804        if (mconfig->formats_config[SKL_PARAM_BIND].caps_size > 0 &&
 805            mconfig->formats_config[SKL_PARAM_BIND].set_params ==
 806                                                                SKL_PARAM_BIND) {
 807                sp_cfg = &mconfig->formats_config[SKL_PARAM_BIND];
 808                ret = skl_set_module_params(skl, sp_cfg->caps,
 809                                        sp_cfg->caps_size,
 810                                        sp_cfg->param_id, mconfig);
 811                if (ret < 0)
 812                        return ret;
 813        }
 814
 815        for (i = 0; i < w->num_kcontrols; i++) {
 816                k = &w->kcontrol_news[i];
 817                if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
 818                        sb = (void *) k->private_value;
 819                        bc = (struct skl_algo_data *)sb->dobj.private;
 820
 821                        if (bc->set_params == SKL_PARAM_BIND) {
 822                                params = kmemdup(bc->params, bc->max, GFP_KERNEL);
 823                                if (!params)
 824                                        return -ENOMEM;
 825
 826                                skl_fill_sink_instance_id(skl, params, bc->max,
 827                                                                mconfig);
 828
 829                                ret = skl_set_module_params(skl, params,
 830                                                bc->max, bc->param_id, mconfig);
 831                                kfree(params);
 832
 833                                if (ret < 0)
 834                                        return ret;
 835                        }
 836                }
 837        }
 838
 839        return 0;
 840}
 841
 842static int skl_get_module_id(struct skl_dev *skl, guid_t *uuid)
 843{
 844        struct uuid_module *module;
 845
 846        list_for_each_entry(module, &skl->uuid_list, list) {
 847                if (guid_equal(uuid, &module->uuid))
 848                        return module->id;
 849        }
 850
 851        return -EINVAL;
 852}
 853
 854static int skl_tplg_find_moduleid_from_uuid(struct skl_dev *skl,
 855                                        const struct snd_kcontrol_new *k)
 856{
 857        struct soc_bytes_ext *sb = (void *) k->private_value;
 858        struct skl_algo_data *bc = (struct skl_algo_data *)sb->dobj.private;
 859        struct skl_kpb_params *uuid_params, *params;
 860        struct hdac_bus *bus = skl_to_bus(skl);
 861        int i, size, module_id;
 862
 863        if (bc->set_params == SKL_PARAM_BIND && bc->max) {
 864                uuid_params = (struct skl_kpb_params *)bc->params;
 865                size = struct_size(params, u.map, uuid_params->num_modules);
 866
 867                params = devm_kzalloc(bus->dev, size, GFP_KERNEL);
 868                if (!params)
 869                        return -ENOMEM;
 870
 871                params->num_modules = uuid_params->num_modules;
 872
 873                for (i = 0; i < uuid_params->num_modules; i++) {
 874                        module_id = skl_get_module_id(skl,
 875                                &uuid_params->u.map_uuid[i].mod_uuid);
 876                        if (module_id < 0) {
 877                                devm_kfree(bus->dev, params);
 878                                return -EINVAL;
 879                        }
 880
 881                        params->u.map[i].mod_id = module_id;
 882                        params->u.map[i].inst_id =
 883                                uuid_params->u.map_uuid[i].inst_id;
 884                }
 885
 886                devm_kfree(bus->dev, bc->params);
 887                bc->params = (char *)params;
 888                bc->max = size;
 889        }
 890
 891        return 0;
 892}
 893
 894/*
 895 * Retrieve the module id from UUID mentioned in the
 896 * post bind params
 897 */
 898void skl_tplg_add_moduleid_in_bind_params(struct skl_dev *skl,
 899                                struct snd_soc_dapm_widget *w)
 900{
 901        struct skl_module_cfg *mconfig = w->priv;
 902        int i;
 903
 904        /*
 905         * Post bind params are used for only for KPB
 906         * to set copier instances to drain the data
 907         * in fast mode
 908         */
 909        if (mconfig->m_type != SKL_MODULE_TYPE_KPB)
 910                return;
 911
 912        for (i = 0; i < w->num_kcontrols; i++)
 913                if ((w->kcontrol_news[i].access &
 914                        SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) &&
 915                        (skl_tplg_find_moduleid_from_uuid(skl,
 916                        &w->kcontrol_news[i]) < 0))
 917                        dev_err(skl->dev,
 918                                "%s: invalid kpb post bind params\n",
 919                                __func__);
 920}
 921
 922static int skl_tplg_module_add_deferred_bind(struct skl_dev *skl,
 923        struct skl_module_cfg *src, struct skl_module_cfg *dst)
 924{
 925        struct skl_module_deferred_bind *m_list, *modules;
 926        int i;
 927
 928        /* only supported for module with static pin connection */
 929        for (i = 0; i < dst->module->max_input_pins; i++) {
 930                struct skl_module_pin *pin = &dst->m_in_pin[i];
 931
 932                if (pin->is_dynamic)
 933                        continue;
 934
 935                if ((pin->id.module_id  == src->id.module_id) &&
 936                        (pin->id.instance_id  == src->id.instance_id)) {
 937
 938                        if (!list_empty(&skl->bind_list)) {
 939                                list_for_each_entry(modules, &skl->bind_list, node) {
 940                                        if (modules->src == src && modules->dst == dst)
 941                                                return 0;
 942                                }
 943                        }
 944
 945                        m_list = kzalloc(sizeof(*m_list), GFP_KERNEL);
 946                        if (!m_list)
 947                                return -ENOMEM;
 948
 949                        m_list->src = src;
 950                        m_list->dst = dst;
 951
 952                        list_add(&m_list->node, &skl->bind_list);
 953                }
 954        }
 955
 956        return 0;
 957}
 958
 959static int skl_tplg_bind_sinks(struct snd_soc_dapm_widget *w,
 960                                struct skl_dev *skl,
 961                                struct snd_soc_dapm_widget *src_w,
 962                                struct skl_module_cfg *src_mconfig)
 963{
 964        struct snd_soc_dapm_path *p;
 965        struct snd_soc_dapm_widget *sink = NULL, *next_sink = NULL;
 966        struct skl_module_cfg *sink_mconfig;
 967        int ret;
 968
 969        snd_soc_dapm_widget_for_each_sink_path(w, p) {
 970                if (!p->connect)
 971                        continue;
 972
 973                dev_dbg(skl->dev,
 974                        "%s: src widget=%s\n", __func__, w->name);
 975                dev_dbg(skl->dev,
 976                        "%s: sink widget=%s\n", __func__, p->sink->name);
 977
 978                next_sink = p->sink;
 979
 980                if (!is_skl_dsp_widget_type(p->sink, skl->dev))
 981                        return skl_tplg_bind_sinks(p->sink, skl, src_w, src_mconfig);
 982
 983                /*
 984                 * here we will check widgets in sink pipelines, so that
 985                 * can be any widgets type and we are only interested if
 986                 * they are ones used for SKL so check that first
 987                 */
 988                if ((p->sink->priv != NULL) &&
 989                                is_skl_dsp_widget_type(p->sink, skl->dev)) {
 990
 991                        sink = p->sink;
 992                        sink_mconfig = sink->priv;
 993
 994                        /*
 995                         * Modules other than PGA leaf can be connected
 996                         * directly or via switch to a module in another
 997                         * pipeline. EX: reference path
 998                         * when the path is enabled, the dst module that needs
 999                         * to be bound may not be initialized. if the module is
1000                         * not initialized, add these modules in the deferred
1001                         * bind list and when the dst module is initialised,
1002                         * bind this module to the dst_module in deferred list.
1003                         */
1004                        if (((src_mconfig->m_state == SKL_MODULE_INIT_DONE)
1005                                && (sink_mconfig->m_state == SKL_MODULE_UNINIT))) {
1006
1007                                ret = skl_tplg_module_add_deferred_bind(skl,
1008                                                src_mconfig, sink_mconfig);
1009
1010                                if (ret < 0)
1011                                        return ret;
1012
1013                        }
1014
1015
1016                        if (src_mconfig->m_state == SKL_MODULE_UNINIT ||
1017                                sink_mconfig->m_state == SKL_MODULE_UNINIT)
1018                                continue;
1019
1020                        /* Bind source to sink, mixin is always source */
1021                        ret = skl_bind_modules(skl, src_mconfig, sink_mconfig);
1022                        if (ret)
1023                                return ret;
1024
1025                        /* set module params after bind */
1026                        skl_tplg_set_module_bind_params(src_w,
1027                                        src_mconfig, skl);
1028                        skl_tplg_set_module_bind_params(sink,
1029                                        sink_mconfig, skl);
1030
1031                        /* Start sinks pipe first */
1032                        if (sink_mconfig->pipe->state != SKL_PIPE_STARTED) {
1033                                if (sink_mconfig->pipe->conn_type !=
1034                                                        SKL_PIPE_CONN_TYPE_FE)
1035                                        ret = skl_run_pipe(skl,
1036                                                        sink_mconfig->pipe);
1037                                if (ret)
1038                                        return ret;
1039                        }
1040                }
1041        }
1042
1043        if (!sink && next_sink)
1044                return skl_tplg_bind_sinks(next_sink, skl, src_w, src_mconfig);
1045
1046        return 0;
1047}
1048
1049/*
1050 * A PGA represents a module in a pipeline. So in the Pre-PMU event of PGA
1051 * we need to do following:
1052 *   - Bind to sink pipeline
1053 *      Since the sink pipes can be running and we don't get mixer event on
1054 *      connect for already running mixer, we need to find the sink pipes
1055 *      here and bind to them. This way dynamic connect works.
1056 *   - Start sink pipeline, if not running
1057 *   - Then run current pipe
1058 */
1059static int skl_tplg_pga_dapm_pre_pmu_event(struct snd_soc_dapm_widget *w,
1060                                                        struct skl_dev *skl)
1061{
1062        struct skl_module_cfg *src_mconfig;
1063        int ret = 0;
1064
1065        src_mconfig = w->priv;
1066
1067        /*
1068         * find which sink it is connected to, bind with the sink,
1069         * if sink is not started, start sink pipe first, then start
1070         * this pipe
1071         */
1072        ret = skl_tplg_bind_sinks(w, skl, w, src_mconfig);
1073        if (ret)
1074                return ret;
1075
1076        /* Start source pipe last after starting all sinks */
1077        if (src_mconfig->pipe->conn_type != SKL_PIPE_CONN_TYPE_FE)
1078                return skl_run_pipe(skl, src_mconfig->pipe);
1079
1080        return 0;
1081}
1082
1083static struct snd_soc_dapm_widget *skl_get_src_dsp_widget(
1084                struct snd_soc_dapm_widget *w, struct skl_dev *skl)
1085{
1086        struct snd_soc_dapm_path *p;
1087        struct snd_soc_dapm_widget *src_w = NULL;
1088
1089        snd_soc_dapm_widget_for_each_source_path(w, p) {
1090                src_w = p->source;
1091                if (!p->connect)
1092                        continue;
1093
1094                dev_dbg(skl->dev, "sink widget=%s\n", w->name);
1095                dev_dbg(skl->dev, "src widget=%s\n", p->source->name);
1096
1097                /*
1098                 * here we will check widgets in sink pipelines, so that can
1099                 * be any widgets type and we are only interested if they are
1100                 * ones used for SKL so check that first
1101                 */
1102                if ((p->source->priv != NULL) &&
1103                                is_skl_dsp_widget_type(p->source, skl->dev)) {
1104                        return p->source;
1105                }
1106        }
1107
1108        if (src_w != NULL)
1109                return skl_get_src_dsp_widget(src_w, skl);
1110
1111        return NULL;
1112}
1113
1114/*
1115 * in the Post-PMU event of mixer we need to do following:
1116 *   - Check if this pipe is running
1117 *   - if not, then
1118 *      - bind this pipeline to its source pipeline
1119 *        if source pipe is already running, this means it is a dynamic
1120 *        connection and we need to bind only to that pipe
1121 *      - start this pipeline
1122 */
1123static int skl_tplg_mixer_dapm_post_pmu_event(struct snd_soc_dapm_widget *w,
1124                                                        struct skl_dev *skl)
1125{
1126        int ret = 0;
1127        struct snd_soc_dapm_widget *source, *sink;
1128        struct skl_module_cfg *src_mconfig, *sink_mconfig;
1129        int src_pipe_started = 0;
1130
1131        sink = w;
1132        sink_mconfig = sink->priv;
1133
1134        /*
1135         * If source pipe is already started, that means source is driving
1136         * one more sink before this sink got connected, Since source is
1137         * started, bind this sink to source and start this pipe.
1138         */
1139        source = skl_get_src_dsp_widget(w, skl);
1140        if (source != NULL) {
1141                src_mconfig = source->priv;
1142                sink_mconfig = sink->priv;
1143                src_pipe_started = 1;
1144
1145                /*
1146                 * check pipe state, then no need to bind or start the
1147                 * pipe
1148                 */
1149                if (src_mconfig->pipe->state != SKL_PIPE_STARTED)
1150                        src_pipe_started = 0;
1151        }
1152
1153        if (src_pipe_started) {
1154                ret = skl_bind_modules(skl, src_mconfig, sink_mconfig);
1155                if (ret)
1156                        return ret;
1157
1158                /* set module params after bind */
1159                skl_tplg_set_module_bind_params(source, src_mconfig, skl);
1160                skl_tplg_set_module_bind_params(sink, sink_mconfig, skl);
1161
1162                if (sink_mconfig->pipe->conn_type != SKL_PIPE_CONN_TYPE_FE)
1163                        ret = skl_run_pipe(skl, sink_mconfig->pipe);
1164        }
1165
1166        return ret;
1167}
1168
1169/*
1170 * in the Pre-PMD event of mixer we need to do following:
1171 *   - Stop the pipe
1172 *   - find the source connections and remove that from dapm_path_list
1173 *   - unbind with source pipelines if still connected
1174 */
1175static int skl_tplg_mixer_dapm_pre_pmd_event(struct snd_soc_dapm_widget *w,
1176                                                        struct skl_dev *skl)
1177{
1178        struct skl_module_cfg *src_mconfig, *sink_mconfig;
1179        int ret = 0, i;
1180
1181        sink_mconfig = w->priv;
1182
1183        /* Stop the pipe */
1184        ret = skl_stop_pipe(skl, sink_mconfig->pipe);
1185        if (ret)
1186                return ret;
1187
1188        for (i = 0; i < sink_mconfig->module->max_input_pins; i++) {
1189                if (sink_mconfig->m_in_pin[i].pin_state == SKL_PIN_BIND_DONE) {
1190                        src_mconfig = sink_mconfig->m_in_pin[i].tgt_mcfg;
1191                        if (!src_mconfig)
1192                                continue;
1193
1194                        ret = skl_unbind_modules(skl,
1195                                                src_mconfig, sink_mconfig);
1196                }
1197        }
1198
1199        return ret;
1200}
1201
1202/*
1203 * in the Post-PMD event of mixer we need to do following:
1204 *   - Unbind the modules within the pipeline
1205 *   - Delete the pipeline (modules are not required to be explicitly
1206 *     deleted, pipeline delete is enough here
1207 */
1208static int skl_tplg_mixer_dapm_post_pmd_event(struct snd_soc_dapm_widget *w,
1209                                                        struct skl_dev *skl)
1210{
1211        struct skl_module_cfg *mconfig = w->priv;
1212        struct skl_pipe_module *w_module;
1213        struct skl_module_cfg *src_module = NULL, *dst_module;
1214        struct skl_pipe *s_pipe = mconfig->pipe;
1215        struct skl_module_deferred_bind *modules, *tmp;
1216
1217        if (s_pipe->state == SKL_PIPE_INVALID)
1218                return -EINVAL;
1219
1220        list_for_each_entry(w_module, &s_pipe->w_list, node) {
1221                if (list_empty(&skl->bind_list))
1222                        break;
1223
1224                src_module = w_module->w->priv;
1225
1226                list_for_each_entry_safe(modules, tmp, &skl->bind_list, node) {
1227                        /*
1228                         * When the destination module is deleted, Unbind the
1229                         * modules from deferred bind list.
1230                         */
1231                        if (modules->dst == src_module) {
1232                                skl_unbind_modules(skl, modules->src,
1233                                                modules->dst);
1234                        }
1235
1236                        /*
1237                         * When the source module is deleted, remove this entry
1238                         * from the deferred bind list.
1239                         */
1240                        if (modules->src == src_module) {
1241                                list_del(&modules->node);
1242                                modules->src = NULL;
1243                                modules->dst = NULL;
1244                                kfree(modules);
1245                        }
1246                }
1247        }
1248
1249        list_for_each_entry(w_module, &s_pipe->w_list, node) {
1250                dst_module = w_module->w->priv;
1251
1252                if (src_module == NULL) {
1253                        src_module = dst_module;
1254                        continue;
1255                }
1256
1257                skl_unbind_modules(skl, src_module, dst_module);
1258                src_module = dst_module;
1259        }
1260
1261        skl_delete_pipe(skl, mconfig->pipe);
1262
1263        list_for_each_entry(w_module, &s_pipe->w_list, node) {
1264                src_module = w_module->w->priv;
1265                src_module->m_state = SKL_MODULE_UNINIT;
1266        }
1267
1268        return skl_tplg_unload_pipe_modules(skl, s_pipe);
1269}
1270
1271/*
1272 * in the Post-PMD event of PGA we need to do following:
1273 *   - Stop the pipeline
1274 *   - In source pipe is connected, unbind with source pipelines
1275 */
1276static int skl_tplg_pga_dapm_post_pmd_event(struct snd_soc_dapm_widget *w,
1277                                                        struct skl_dev *skl)
1278{
1279        struct skl_module_cfg *src_mconfig, *sink_mconfig;
1280        int ret = 0, i;
1281
1282        src_mconfig = w->priv;
1283
1284        /* Stop the pipe since this is a mixin module */
1285        ret = skl_stop_pipe(skl, src_mconfig->pipe);
1286        if (ret)
1287                return ret;
1288
1289        for (i = 0; i < src_mconfig->module->max_output_pins; i++) {
1290                if (src_mconfig->m_out_pin[i].pin_state == SKL_PIN_BIND_DONE) {
1291                        sink_mconfig = src_mconfig->m_out_pin[i].tgt_mcfg;
1292                        if (!sink_mconfig)
1293                                continue;
1294                        /*
1295                         * This is a connecter and if path is found that means
1296                         * unbind between source and sink has not happened yet
1297                         */
1298                        ret = skl_unbind_modules(skl, src_mconfig,
1299                                                        sink_mconfig);
1300                }
1301        }
1302
1303        return ret;
1304}
1305
1306/*
1307 * In modelling, we assume there will be ONLY one mixer in a pipeline. If a
1308 * second one is required that is created as another pipe entity.
1309 * The mixer is responsible for pipe management and represent a pipeline
1310 * instance
1311 */
1312static int skl_tplg_mixer_event(struct snd_soc_dapm_widget *w,
1313                                struct snd_kcontrol *k, int event)
1314{
1315        struct snd_soc_dapm_context *dapm = w->dapm;
1316        struct skl_dev *skl = get_skl_ctx(dapm->dev);
1317
1318        switch (event) {
1319        case SND_SOC_DAPM_PRE_PMU:
1320                return skl_tplg_mixer_dapm_pre_pmu_event(w, skl);
1321
1322        case SND_SOC_DAPM_POST_PMU:
1323                return skl_tplg_mixer_dapm_post_pmu_event(w, skl);
1324
1325        case SND_SOC_DAPM_PRE_PMD:
1326                return skl_tplg_mixer_dapm_pre_pmd_event(w, skl);
1327
1328        case SND_SOC_DAPM_POST_PMD:
1329                return skl_tplg_mixer_dapm_post_pmd_event(w, skl);
1330        }
1331
1332        return 0;
1333}
1334
1335/*
1336 * In modelling, we assumed rest of the modules in pipeline are PGA. But we
1337 * are interested in last PGA (leaf PGA) in a pipeline to disconnect with
1338 * the sink when it is running (two FE to one BE or one FE to two BE)
1339 * scenarios
1340 */
1341static int skl_tplg_pga_event(struct snd_soc_dapm_widget *w,
1342                        struct snd_kcontrol *k, int event)
1343
1344{
1345        struct snd_soc_dapm_context *dapm = w->dapm;
1346        struct skl_dev *skl = get_skl_ctx(dapm->dev);
1347
1348        switch (event) {
1349        case SND_SOC_DAPM_PRE_PMU:
1350                return skl_tplg_pga_dapm_pre_pmu_event(w, skl);
1351
1352        case SND_SOC_DAPM_POST_PMD:
1353                return skl_tplg_pga_dapm_post_pmd_event(w, skl);
1354        }
1355
1356        return 0;
1357}
1358
1359static int skl_tplg_multi_config_set_get(struct snd_kcontrol *kcontrol,
1360                                         struct snd_ctl_elem_value *ucontrol,
1361                                         bool is_set)
1362{
1363        struct snd_soc_component *component =
1364                snd_soc_kcontrol_component(kcontrol);
1365        struct hdac_bus *bus = snd_soc_component_get_drvdata(component);
1366        struct skl_dev *skl = bus_to_skl(bus);
1367        struct skl_pipeline *ppl;
1368        struct skl_pipe *pipe = NULL;
1369        struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1370        u32 *pipe_id;
1371
1372        if (!ec)
1373                return -EINVAL;
1374
1375        if (is_set && ucontrol->value.enumerated.item[0] > ec->items)
1376                return -EINVAL;
1377
1378        pipe_id = ec->dobj.private;
1379
1380        list_for_each_entry(ppl, &skl->ppl_list, node) {
1381                if (ppl->pipe->ppl_id == *pipe_id) {
1382                        pipe = ppl->pipe;
1383                        break;
1384                }
1385        }
1386        if (!pipe)
1387                return -EIO;
1388
1389        if (is_set)
1390                pipe->pipe_config_idx = ucontrol->value.enumerated.item[0];
1391        else
1392                ucontrol->value.enumerated.item[0]  =  pipe->pipe_config_idx;
1393
1394        return 0;
1395}
1396
1397static int skl_tplg_multi_config_get(struct snd_kcontrol *kcontrol,
1398                                     struct snd_ctl_elem_value *ucontrol)
1399{
1400        return skl_tplg_multi_config_set_get(kcontrol, ucontrol, false);
1401}
1402
1403static int skl_tplg_multi_config_set(struct snd_kcontrol *kcontrol,
1404                                     struct snd_ctl_elem_value *ucontrol)
1405{
1406        return skl_tplg_multi_config_set_get(kcontrol, ucontrol, true);
1407}
1408
1409static int skl_tplg_multi_config_get_dmic(struct snd_kcontrol *kcontrol,
1410                                          struct snd_ctl_elem_value *ucontrol)
1411{
1412        return skl_tplg_multi_config_set_get(kcontrol, ucontrol, false);
1413}
1414
1415static int skl_tplg_multi_config_set_dmic(struct snd_kcontrol *kcontrol,
1416                                          struct snd_ctl_elem_value *ucontrol)
1417{
1418        return skl_tplg_multi_config_set_get(kcontrol, ucontrol, true);
1419}
1420
1421static int skl_tplg_tlv_control_get(struct snd_kcontrol *kcontrol,
1422                        unsigned int __user *data, unsigned int size)
1423{
1424        struct soc_bytes_ext *sb =
1425                        (struct soc_bytes_ext *)kcontrol->private_value;
1426        struct skl_algo_data *bc = (struct skl_algo_data *)sb->dobj.private;
1427        struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1428        struct skl_module_cfg *mconfig = w->priv;
1429        struct skl_dev *skl = get_skl_ctx(w->dapm->dev);
1430
1431        if (w->power)
1432                skl_get_module_params(skl, (u32 *)bc->params,
1433                                      bc->size, bc->param_id, mconfig);
1434
1435        /* decrement size for TLV header */
1436        size -= 2 * sizeof(u32);
1437
1438        /* check size as we don't want to send kernel data */
1439        if (size > bc->max)
1440                size = bc->max;
1441
1442        if (bc->params) {
1443                if (copy_to_user(data, &bc->param_id, sizeof(u32)))
1444                        return -EFAULT;
1445                if (copy_to_user(data + 1, &size, sizeof(u32)))
1446                        return -EFAULT;
1447                if (copy_to_user(data + 2, bc->params, size))
1448                        return -EFAULT;
1449        }
1450
1451        return 0;
1452}
1453
1454#define SKL_PARAM_VENDOR_ID 0xff
1455
1456static int skl_tplg_tlv_control_set(struct snd_kcontrol *kcontrol,
1457                        const unsigned int __user *data, unsigned int size)
1458{
1459        struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1460        struct skl_module_cfg *mconfig = w->priv;
1461        struct soc_bytes_ext *sb =
1462                        (struct soc_bytes_ext *)kcontrol->private_value;
1463        struct skl_algo_data *ac = (struct skl_algo_data *)sb->dobj.private;
1464        struct skl_dev *skl = get_skl_ctx(w->dapm->dev);
1465
1466        if (ac->params) {
1467                if (size > ac->max)
1468                        return -EINVAL;
1469                ac->size = size;
1470
1471                if (copy_from_user(ac->params, data, size))
1472                        return -EFAULT;
1473
1474                if (w->power)
1475                        return skl_set_module_params(skl,
1476                                                (u32 *)ac->params, ac->size,
1477                                                ac->param_id, mconfig);
1478        }
1479
1480        return 0;
1481}
1482
1483static int skl_tplg_mic_control_get(struct snd_kcontrol *kcontrol,
1484                struct snd_ctl_elem_value *ucontrol)
1485{
1486        struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1487        struct skl_module_cfg *mconfig = w->priv;
1488        struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1489        u32 ch_type = *((u32 *)ec->dobj.private);
1490
1491        if (mconfig->dmic_ch_type == ch_type)
1492                ucontrol->value.enumerated.item[0] =
1493                                        mconfig->dmic_ch_combo_index;
1494        else
1495                ucontrol->value.enumerated.item[0] = 0;
1496
1497        return 0;
1498}
1499
1500static int skl_fill_mic_sel_params(struct skl_module_cfg *mconfig,
1501        struct skl_mic_sel_config *mic_cfg, struct device *dev)
1502{
1503        struct skl_specific_cfg *sp_cfg =
1504                                &mconfig->formats_config[SKL_PARAM_INIT];
1505
1506        sp_cfg->caps_size = sizeof(struct skl_mic_sel_config);
1507        sp_cfg->set_params = SKL_PARAM_SET;
1508        sp_cfg->param_id = 0x00;
1509        if (!sp_cfg->caps) {
1510                sp_cfg->caps = devm_kzalloc(dev, sp_cfg->caps_size, GFP_KERNEL);
1511                if (!sp_cfg->caps)
1512                        return -ENOMEM;
1513        }
1514
1515        mic_cfg->mic_switch = SKL_MIC_SEL_SWITCH;
1516        mic_cfg->flags = 0;
1517        memcpy(sp_cfg->caps, mic_cfg, sp_cfg->caps_size);
1518
1519        return 0;
1520}
1521
1522static int skl_tplg_mic_control_set(struct snd_kcontrol *kcontrol,
1523                        struct snd_ctl_elem_value *ucontrol)
1524{
1525        struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1526        struct skl_module_cfg *mconfig = w->priv;
1527        struct skl_mic_sel_config mic_cfg = {0};
1528        struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1529        u32 ch_type = *((u32 *)ec->dobj.private);
1530        const int *list;
1531        u8 in_ch, out_ch, index;
1532
1533        mconfig->dmic_ch_type = ch_type;
1534        mconfig->dmic_ch_combo_index = ucontrol->value.enumerated.item[0];
1535
1536        /* enum control index 0 is INVALID, so no channels to be set */
1537        if (mconfig->dmic_ch_combo_index == 0)
1538                return 0;
1539
1540        /* No valid channel selection map for index 0, so offset by 1 */
1541        index = mconfig->dmic_ch_combo_index - 1;
1542
1543        switch (ch_type) {
1544        case SKL_CH_MONO:
1545                if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_mono_list))
1546                        return -EINVAL;
1547
1548                list = &mic_mono_list[index];
1549                break;
1550
1551        case SKL_CH_STEREO:
1552                if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_stereo_list))
1553                        return -EINVAL;
1554
1555                list = mic_stereo_list[index];
1556                break;
1557
1558        case SKL_CH_TRIO:
1559                if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_trio_list))
1560                        return -EINVAL;
1561
1562                list = mic_trio_list[index];
1563                break;
1564
1565        case SKL_CH_QUATRO:
1566                if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_quatro_list))
1567                        return -EINVAL;
1568
1569                list = mic_quatro_list[index];
1570                break;
1571
1572        default:
1573                dev_err(w->dapm->dev,
1574                                "Invalid channel %d for mic_select module\n",
1575                                ch_type);
1576                return -EINVAL;
1577
1578        }
1579
1580        /* channel type enum map to number of chanels for that type */
1581        for (out_ch = 0; out_ch < ch_type; out_ch++) {
1582                in_ch = list[out_ch];
1583                mic_cfg.blob[out_ch][in_ch] = SKL_DEFAULT_MIC_SEL_GAIN;
1584        }
1585
1586        return skl_fill_mic_sel_params(mconfig, &mic_cfg, w->dapm->dev);
1587}
1588
1589/*
1590 * Fill the dma id for host and link. In case of passthrough
1591 * pipeline, this will both host and link in the same
1592 * pipeline, so need to copy the link and host based on dev_type
1593 */
1594static void skl_tplg_fill_dma_id(struct skl_module_cfg *mcfg,
1595                                struct skl_pipe_params *params)
1596{
1597        struct skl_pipe *pipe = mcfg->pipe;
1598
1599        if (pipe->passthru) {
1600                switch (mcfg->dev_type) {
1601                case SKL_DEVICE_HDALINK:
1602                        pipe->p_params->link_dma_id = params->link_dma_id;
1603                        pipe->p_params->link_index = params->link_index;
1604                        pipe->p_params->link_bps = params->link_bps;
1605                        break;
1606
1607                case SKL_DEVICE_HDAHOST:
1608                        pipe->p_params->host_dma_id = params->host_dma_id;
1609                        pipe->p_params->host_bps = params->host_bps;
1610                        break;
1611
1612                default:
1613                        break;
1614                }
1615                pipe->p_params->s_fmt = params->s_fmt;
1616                pipe->p_params->ch = params->ch;
1617                pipe->p_params->s_freq = params->s_freq;
1618                pipe->p_params->stream = params->stream;
1619                pipe->p_params->format = params->format;
1620
1621        } else {
1622                memcpy(pipe->p_params, params, sizeof(*params));
1623        }
1624}
1625
1626/*
1627 * The FE params are passed by hw_params of the DAI.
1628 * On hw_params, the params are stored in Gateway module of the FE and we
1629 * need to calculate the format in DSP module configuration, that
1630 * conversion is done here
1631 */
1632int skl_tplg_update_pipe_params(struct device *dev,
1633                        struct skl_module_cfg *mconfig,
1634                        struct skl_pipe_params *params)
1635{
1636        struct skl_module_res *res;
1637        struct skl_dev *skl = get_skl_ctx(dev);
1638        struct skl_module_fmt *format = NULL;
1639        u8 cfg_idx = mconfig->pipe->cur_config_idx;
1640
1641        res = &mconfig->module->resources[mconfig->res_idx];
1642        skl_tplg_fill_dma_id(mconfig, params);
1643        mconfig->fmt_idx = mconfig->mod_cfg[cfg_idx].fmt_idx;
1644        mconfig->res_idx = mconfig->mod_cfg[cfg_idx].res_idx;
1645
1646        if (skl->nr_modules)
1647                return 0;
1648
1649        if (params->stream == SNDRV_PCM_STREAM_PLAYBACK)
1650                format = &mconfig->module->formats[mconfig->fmt_idx].inputs[0].fmt;
1651        else
1652                format = &mconfig->module->formats[mconfig->fmt_idx].outputs[0].fmt;
1653
1654        /* set the hw_params */
1655        format->s_freq = params->s_freq;
1656        format->channels = params->ch;
1657        format->valid_bit_depth = skl_get_bit_depth(params->s_fmt);
1658
1659        /*
1660         * 16 bit is 16 bit container whereas 24 bit is in 32 bit
1661         * container so update bit depth accordingly
1662         */
1663        switch (format->valid_bit_depth) {
1664        case SKL_DEPTH_16BIT:
1665                format->bit_depth = format->valid_bit_depth;
1666                break;
1667
1668        case SKL_DEPTH_24BIT:
1669        case SKL_DEPTH_32BIT:
1670                format->bit_depth = SKL_DEPTH_32BIT;
1671                break;
1672
1673        default:
1674                dev_err(dev, "Invalid bit depth %x for pipe\n",
1675                                format->valid_bit_depth);
1676                return -EINVAL;
1677        }
1678
1679        if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1680                res->ibs = (format->s_freq / 1000) *
1681                                (format->channels) *
1682                                (format->bit_depth >> 3);
1683        } else {
1684                res->obs = (format->s_freq / 1000) *
1685                                (format->channels) *
1686                                (format->bit_depth >> 3);
1687        }
1688
1689        return 0;
1690}
1691
1692/*
1693 * Query the module config for the FE DAI
1694 * This is used to find the hw_params set for that DAI and apply to FE
1695 * pipeline
1696 */
1697struct skl_module_cfg *
1698skl_tplg_fe_get_cpr_module(struct snd_soc_dai *dai, int stream)
1699{
1700        struct snd_soc_dapm_widget *w;
1701        struct snd_soc_dapm_path *p = NULL;
1702
1703        if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1704                w = dai->playback_widget;
1705                snd_soc_dapm_widget_for_each_sink_path(w, p) {
1706                        if (p->connect && p->sink->power &&
1707                                !is_skl_dsp_widget_type(p->sink, dai->dev))
1708                                continue;
1709
1710                        if (p->sink->priv) {
1711                                dev_dbg(dai->dev, "set params for %s\n",
1712                                                p->sink->name);
1713                                return p->sink->priv;
1714                        }
1715                }
1716        } else {
1717                w = dai->capture_widget;
1718                snd_soc_dapm_widget_for_each_source_path(w, p) {
1719                        if (p->connect && p->source->power &&
1720                                !is_skl_dsp_widget_type(p->source, dai->dev))
1721                                continue;
1722
1723                        if (p->source->priv) {
1724                                dev_dbg(dai->dev, "set params for %s\n",
1725                                                p->source->name);
1726                                return p->source->priv;
1727                        }
1728                }
1729        }
1730
1731        return NULL;
1732}
1733
1734static struct skl_module_cfg *skl_get_mconfig_pb_cpr(
1735                struct snd_soc_dai *dai, struct snd_soc_dapm_widget *w)
1736{
1737        struct snd_soc_dapm_path *p;
1738        struct skl_module_cfg *mconfig = NULL;
1739
1740        snd_soc_dapm_widget_for_each_source_path(w, p) {
1741                if (w->endpoints[SND_SOC_DAPM_DIR_OUT] > 0) {
1742                        if (p->connect &&
1743                                    (p->sink->id == snd_soc_dapm_aif_out) &&
1744                                    p->source->priv) {
1745                                mconfig = p->source->priv;
1746                                return mconfig;
1747                        }
1748                        mconfig = skl_get_mconfig_pb_cpr(dai, p->source);
1749                        if (mconfig)
1750                                return mconfig;
1751                }
1752        }
1753        return mconfig;
1754}
1755
1756static struct skl_module_cfg *skl_get_mconfig_cap_cpr(
1757                struct snd_soc_dai *dai, struct snd_soc_dapm_widget *w)
1758{
1759        struct snd_soc_dapm_path *p;
1760        struct skl_module_cfg *mconfig = NULL;
1761
1762        snd_soc_dapm_widget_for_each_sink_path(w, p) {
1763                if (w->endpoints[SND_SOC_DAPM_DIR_IN] > 0) {
1764                        if (p->connect &&
1765                                    (p->source->id == snd_soc_dapm_aif_in) &&
1766                                    p->sink->priv) {
1767                                mconfig = p->sink->priv;
1768                                return mconfig;
1769                        }
1770                        mconfig = skl_get_mconfig_cap_cpr(dai, p->sink);
1771                        if (mconfig)
1772                                return mconfig;
1773                }
1774        }
1775        return mconfig;
1776}
1777
1778struct skl_module_cfg *
1779skl_tplg_be_get_cpr_module(struct snd_soc_dai *dai, int stream)
1780{
1781        struct snd_soc_dapm_widget *w;
1782        struct skl_module_cfg *mconfig;
1783
1784        if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1785                w = dai->playback_widget;
1786                mconfig = skl_get_mconfig_pb_cpr(dai, w);
1787        } else {
1788                w = dai->capture_widget;
1789                mconfig = skl_get_mconfig_cap_cpr(dai, w);
1790        }
1791        return mconfig;
1792}
1793
1794static u8 skl_tplg_be_link_type(int dev_type)
1795{
1796        int ret;
1797
1798        switch (dev_type) {
1799        case SKL_DEVICE_BT:
1800                ret = NHLT_LINK_SSP;
1801                break;
1802
1803        case SKL_DEVICE_DMIC:
1804                ret = NHLT_LINK_DMIC;
1805                break;
1806
1807        case SKL_DEVICE_I2S:
1808                ret = NHLT_LINK_SSP;
1809                break;
1810
1811        case SKL_DEVICE_HDALINK:
1812                ret = NHLT_LINK_HDA;
1813                break;
1814
1815        default:
1816                ret = NHLT_LINK_INVALID;
1817                break;
1818        }
1819
1820        return ret;
1821}
1822
1823/*
1824 * Fill the BE gateway parameters
1825 * The BE gateway expects a blob of parameters which are kept in the ACPI
1826 * NHLT blob, so query the blob for interface type (i2s/pdm) and instance.
1827 * The port can have multiple settings so pick based on the pipeline
1828 * parameters
1829 */
1830static int skl_tplg_be_fill_pipe_params(struct snd_soc_dai *dai,
1831                                struct skl_module_cfg *mconfig,
1832                                struct skl_pipe_params *params)
1833{
1834        struct nhlt_specific_cfg *cfg;
1835        struct skl_pipe *pipe = mconfig->pipe;
1836        struct skl_pipe_fmt *pipe_fmt;
1837        struct skl_dev *skl = get_skl_ctx(dai->dev);
1838        int link_type = skl_tplg_be_link_type(mconfig->dev_type);
1839        u8 dev_type = skl_tplg_be_dev_type(mconfig->dev_type);
1840
1841        skl_tplg_fill_dma_id(mconfig, params);
1842
1843        if (link_type == NHLT_LINK_HDA)
1844                return 0;
1845
1846        if (pipe->direction == SNDRV_PCM_STREAM_PLAYBACK)
1847                pipe_fmt = &pipe->configs[pipe->pipe_config_idx].out_fmt;
1848        else
1849                pipe_fmt = &pipe->configs[pipe->pipe_config_idx].in_fmt;
1850
1851        /* update the blob based on virtual bus_id*/
1852        cfg = skl_get_ep_blob(skl, mconfig->vbus_id, link_type,
1853                                        pipe_fmt->bps, pipe_fmt->channels,
1854                                        pipe_fmt->freq, pipe->direction,
1855                                        dev_type);
1856        if (cfg) {
1857                mconfig->formats_config[SKL_PARAM_INIT].caps_size = cfg->size;
1858                mconfig->formats_config[SKL_PARAM_INIT].caps = (u32 *)&cfg->caps;
1859        } else {
1860                dev_err(dai->dev, "Blob NULL for id:%d type:%d dirn:%d ch:%d, freq:%d, fmt:%d\n",
1861                        mconfig->vbus_id, link_type, params->stream,
1862                        params->ch, params->s_freq, params->s_fmt);
1863                return -EINVAL;
1864        }
1865
1866        return 0;
1867}
1868
1869static int skl_tplg_be_set_src_pipe_params(struct snd_soc_dai *dai,
1870                                struct snd_soc_dapm_widget *w,
1871                                struct skl_pipe_params *params)
1872{
1873        struct snd_soc_dapm_path *p;
1874        int ret = -EIO;
1875
1876        snd_soc_dapm_widget_for_each_source_path(w, p) {
1877                if (p->connect && is_skl_dsp_widget_type(p->source, dai->dev) &&
1878                                                p->source->priv) {
1879
1880                        ret = skl_tplg_be_fill_pipe_params(dai,
1881                                                p->source->priv, params);
1882                        if (ret < 0)
1883                                return ret;
1884                } else {
1885                        ret = skl_tplg_be_set_src_pipe_params(dai,
1886                                                p->source, params);
1887                        if (ret < 0)
1888                                return ret;
1889                }
1890        }
1891
1892        return ret;
1893}
1894
1895static int skl_tplg_be_set_sink_pipe_params(struct snd_soc_dai *dai,
1896        struct snd_soc_dapm_widget *w, struct skl_pipe_params *params)
1897{
1898        struct snd_soc_dapm_path *p;
1899        int ret = -EIO;
1900
1901        snd_soc_dapm_widget_for_each_sink_path(w, p) {
1902                if (p->connect && is_skl_dsp_widget_type(p->sink, dai->dev) &&
1903                                                p->sink->priv) {
1904
1905                        ret = skl_tplg_be_fill_pipe_params(dai,
1906                                                p->sink->priv, params);
1907                        if (ret < 0)
1908                                return ret;
1909                } else {
1910                        ret = skl_tplg_be_set_sink_pipe_params(
1911                                                dai, p->sink, params);
1912                        if (ret < 0)
1913                                return ret;
1914                }
1915        }
1916
1917        return ret;
1918}
1919
1920/*
1921 * BE hw_params can be a source parameters (capture) or sink parameters
1922 * (playback). Based on sink and source we need to either find the source
1923 * list or the sink list and set the pipeline parameters
1924 */
1925int skl_tplg_be_update_params(struct snd_soc_dai *dai,
1926                                struct skl_pipe_params *params)
1927{
1928        struct snd_soc_dapm_widget *w;
1929
1930        if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1931                w = dai->playback_widget;
1932
1933                return skl_tplg_be_set_src_pipe_params(dai, w, params);
1934
1935        } else {
1936                w = dai->capture_widget;
1937
1938                return skl_tplg_be_set_sink_pipe_params(dai, w, params);
1939        }
1940
1941        return 0;
1942}
1943
1944static const struct snd_soc_tplg_widget_events skl_tplg_widget_ops[] = {
1945        {SKL_MIXER_EVENT, skl_tplg_mixer_event},
1946        {SKL_VMIXER_EVENT, skl_tplg_mixer_event},
1947        {SKL_PGA_EVENT, skl_tplg_pga_event},
1948};
1949
1950static const struct snd_soc_tplg_bytes_ext_ops skl_tlv_ops[] = {
1951        {SKL_CONTROL_TYPE_BYTE_TLV, skl_tplg_tlv_control_get,
1952                                        skl_tplg_tlv_control_set},
1953};
1954
1955static const struct snd_soc_tplg_kcontrol_ops skl_tplg_kcontrol_ops[] = {
1956        {
1957                .id = SKL_CONTROL_TYPE_MIC_SELECT,
1958                .get = skl_tplg_mic_control_get,
1959                .put = skl_tplg_mic_control_set,
1960        },
1961        {
1962                .id = SKL_CONTROL_TYPE_MULTI_IO_SELECT,
1963                .get = skl_tplg_multi_config_get,
1964                .put = skl_tplg_multi_config_set,
1965        },
1966        {
1967                .id = SKL_CONTROL_TYPE_MULTI_IO_SELECT_DMIC,
1968                .get = skl_tplg_multi_config_get_dmic,
1969                .put = skl_tplg_multi_config_set_dmic,
1970        }
1971};
1972
1973static int skl_tplg_fill_pipe_cfg(struct device *dev,
1974                        struct skl_pipe *pipe, u32 tkn,
1975                        u32 tkn_val, int conf_idx, int dir)
1976{
1977        struct skl_pipe_fmt *fmt;
1978        struct skl_path_config *config;
1979
1980        switch (dir) {
1981        case SKL_DIR_IN:
1982                fmt = &pipe->configs[conf_idx].in_fmt;
1983                break;
1984
1985        case SKL_DIR_OUT:
1986                fmt = &pipe->configs[conf_idx].out_fmt;
1987                break;
1988
1989        default:
1990                dev_err(dev, "Invalid direction: %d\n", dir);
1991                return -EINVAL;
1992        }
1993
1994        config = &pipe->configs[conf_idx];
1995
1996        switch (tkn) {
1997        case SKL_TKN_U32_CFG_FREQ:
1998                fmt->freq = tkn_val;
1999                break;
2000
2001        case SKL_TKN_U8_CFG_CHAN:
2002                fmt->channels = tkn_val;
2003                break;
2004
2005        case SKL_TKN_U8_CFG_BPS:
2006                fmt->bps = tkn_val;
2007                break;
2008
2009        case SKL_TKN_U32_PATH_MEM_PGS:
2010                config->mem_pages = tkn_val;
2011                break;
2012
2013        default:
2014                dev_err(dev, "Invalid token config: %d\n", tkn);
2015                return -EINVAL;
2016        }
2017
2018        return 0;
2019}
2020
2021static int skl_tplg_fill_pipe_tkn(struct device *dev,
2022                        struct skl_pipe *pipe, u32 tkn,
2023                        u32 tkn_val)
2024{
2025
2026        switch (tkn) {
2027        case SKL_TKN_U32_PIPE_CONN_TYPE:
2028                pipe->conn_type = tkn_val;
2029                break;
2030
2031        case SKL_TKN_U32_PIPE_PRIORITY:
2032                pipe->pipe_priority = tkn_val;
2033                break;
2034
2035        case SKL_TKN_U32_PIPE_MEM_PGS:
2036                pipe->memory_pages = tkn_val;
2037                break;
2038
2039        case SKL_TKN_U32_PMODE:
2040                pipe->lp_mode = tkn_val;
2041                break;
2042
2043        case SKL_TKN_U32_PIPE_DIRECTION:
2044                pipe->direction = tkn_val;
2045                break;
2046
2047        case SKL_TKN_U32_NUM_CONFIGS:
2048                pipe->nr_cfgs = tkn_val;
2049                break;
2050
2051        default:
2052                dev_err(dev, "Token not handled %d\n", tkn);
2053                return -EINVAL;
2054        }
2055
2056        return 0;
2057}
2058
2059/*
2060 * Add pipeline by parsing the relevant tokens
2061 * Return an existing pipe if the pipe already exists.
2062 */
2063static int skl_tplg_add_pipe(struct device *dev,
2064                struct skl_module_cfg *mconfig, struct skl_dev *skl,
2065                struct snd_soc_tplg_vendor_value_elem *tkn_elem)
2066{
2067        struct skl_pipeline *ppl;
2068        struct skl_pipe *pipe;
2069        struct skl_pipe_params *params;
2070
2071        list_for_each_entry(ppl, &skl->ppl_list, node) {
2072                if (ppl->pipe->ppl_id == tkn_elem->value) {
2073                        mconfig->pipe = ppl->pipe;
2074                        return -EEXIST;
2075                }
2076        }
2077
2078        ppl = devm_kzalloc(dev, sizeof(*ppl), GFP_KERNEL);
2079        if (!ppl)
2080                return -ENOMEM;
2081
2082        pipe = devm_kzalloc(dev, sizeof(*pipe), GFP_KERNEL);
2083        if (!pipe)
2084                return -ENOMEM;
2085
2086        params = devm_kzalloc(dev, sizeof(*params), GFP_KERNEL);
2087        if (!params)
2088                return -ENOMEM;
2089
2090        pipe->p_params = params;
2091        pipe->ppl_id = tkn_elem->value;
2092        INIT_LIST_HEAD(&pipe->w_list);
2093
2094        ppl->pipe = pipe;
2095        list_add(&ppl->node, &skl->ppl_list);
2096
2097        mconfig->pipe = pipe;
2098        mconfig->pipe->state = SKL_PIPE_INVALID;
2099
2100        return 0;
2101}
2102
2103static int skl_tplg_get_uuid(struct device *dev, guid_t *guid,
2104              struct snd_soc_tplg_vendor_uuid_elem *uuid_tkn)
2105{
2106        if (uuid_tkn->token == SKL_TKN_UUID) {
2107                import_guid(guid, uuid_tkn->uuid);
2108                return 0;
2109        }
2110
2111        dev_err(dev, "Not an UUID token %d\n", uuid_tkn->token);
2112
2113        return -EINVAL;
2114}
2115
2116static int skl_tplg_fill_pin(struct device *dev,
2117                        struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2118                        struct skl_module_pin *m_pin,
2119                        int pin_index)
2120{
2121        int ret;
2122
2123        switch (tkn_elem->token) {
2124        case SKL_TKN_U32_PIN_MOD_ID:
2125                m_pin[pin_index].id.module_id = tkn_elem->value;
2126                break;
2127
2128        case SKL_TKN_U32_PIN_INST_ID:
2129                m_pin[pin_index].id.instance_id = tkn_elem->value;
2130                break;
2131
2132        case SKL_TKN_UUID:
2133                ret = skl_tplg_get_uuid(dev, &m_pin[pin_index].id.mod_uuid,
2134                        (struct snd_soc_tplg_vendor_uuid_elem *)tkn_elem);
2135                if (ret < 0)
2136                        return ret;
2137
2138                break;
2139
2140        default:
2141                dev_err(dev, "%d Not a pin token\n", tkn_elem->token);
2142                return -EINVAL;
2143        }
2144
2145        return 0;
2146}
2147
2148/*
2149 * Parse for pin config specific tokens to fill up the
2150 * module private data
2151 */
2152static int skl_tplg_fill_pins_info(struct device *dev,
2153                struct skl_module_cfg *mconfig,
2154                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2155                int dir, int pin_count)
2156{
2157        int ret;
2158        struct skl_module_pin *m_pin;
2159
2160        switch (dir) {
2161        case SKL_DIR_IN:
2162                m_pin = mconfig->m_in_pin;
2163                break;
2164
2165        case SKL_DIR_OUT:
2166                m_pin = mconfig->m_out_pin;
2167                break;
2168
2169        default:
2170                dev_err(dev, "Invalid direction value\n");
2171                return -EINVAL;
2172        }
2173
2174        ret = skl_tplg_fill_pin(dev, tkn_elem, m_pin, pin_count);
2175        if (ret < 0)
2176                return ret;
2177
2178        m_pin[pin_count].in_use = false;
2179        m_pin[pin_count].pin_state = SKL_PIN_UNBIND;
2180
2181        return 0;
2182}
2183
2184/*
2185 * Fill up input/output module config format based
2186 * on the direction
2187 */
2188static int skl_tplg_fill_fmt(struct device *dev,
2189                struct skl_module_fmt *dst_fmt,
2190                u32 tkn, u32 value)
2191{
2192        switch (tkn) {
2193        case SKL_TKN_U32_FMT_CH:
2194                dst_fmt->channels  = value;
2195                break;
2196
2197        case SKL_TKN_U32_FMT_FREQ:
2198                dst_fmt->s_freq = value;
2199                break;
2200
2201        case SKL_TKN_U32_FMT_BIT_DEPTH:
2202                dst_fmt->bit_depth = value;
2203                break;
2204
2205        case SKL_TKN_U32_FMT_SAMPLE_SIZE:
2206                dst_fmt->valid_bit_depth = value;
2207                break;
2208
2209        case SKL_TKN_U32_FMT_CH_CONFIG:
2210                dst_fmt->ch_cfg = value;
2211                break;
2212
2213        case SKL_TKN_U32_FMT_INTERLEAVE:
2214                dst_fmt->interleaving_style = value;
2215                break;
2216
2217        case SKL_TKN_U32_FMT_SAMPLE_TYPE:
2218                dst_fmt->sample_type = value;
2219                break;
2220
2221        case SKL_TKN_U32_FMT_CH_MAP:
2222                dst_fmt->ch_map = value;
2223                break;
2224
2225        default:
2226                dev_err(dev, "Invalid token %d\n", tkn);
2227                return -EINVAL;
2228        }
2229
2230        return 0;
2231}
2232
2233static int skl_tplg_widget_fill_fmt(struct device *dev,
2234                struct skl_module_iface *fmt,
2235                u32 tkn, u32 val, u32 dir, int fmt_idx)
2236{
2237        struct skl_module_fmt *dst_fmt;
2238
2239        if (!fmt)
2240                return -EINVAL;
2241
2242        switch (dir) {
2243        case SKL_DIR_IN:
2244                dst_fmt = &fmt->inputs[fmt_idx].fmt;
2245                break;
2246
2247        case SKL_DIR_OUT:
2248                dst_fmt = &fmt->outputs[fmt_idx].fmt;
2249                break;
2250
2251        default:
2252                dev_err(dev, "Invalid direction: %d\n", dir);
2253                return -EINVAL;
2254        }
2255
2256        return skl_tplg_fill_fmt(dev, dst_fmt, tkn, val);
2257}
2258
2259static void skl_tplg_fill_pin_dynamic_val(
2260                struct skl_module_pin *mpin, u32 pin_count, u32 value)
2261{
2262        int i;
2263
2264        for (i = 0; i < pin_count; i++)
2265                mpin[i].is_dynamic = value;
2266}
2267
2268/*
2269 * Resource table in the manifest has pin specific resources
2270 * like pin and pin buffer size
2271 */
2272static int skl_tplg_manifest_pin_res_tkn(struct device *dev,
2273                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2274                struct skl_module_res *res, int pin_idx, int dir)
2275{
2276        struct skl_module_pin_resources *m_pin;
2277
2278        switch (dir) {
2279        case SKL_DIR_IN:
2280                m_pin = &res->input[pin_idx];
2281                break;
2282
2283        case SKL_DIR_OUT:
2284                m_pin = &res->output[pin_idx];
2285                break;
2286
2287        default:
2288                dev_err(dev, "Invalid pin direction: %d\n", dir);
2289                return -EINVAL;
2290        }
2291
2292        switch (tkn_elem->token) {
2293        case SKL_TKN_MM_U32_RES_PIN_ID:
2294                m_pin->pin_index = tkn_elem->value;
2295                break;
2296
2297        case SKL_TKN_MM_U32_PIN_BUF:
2298                m_pin->buf_size = tkn_elem->value;
2299                break;
2300
2301        default:
2302                dev_err(dev, "Invalid token: %d\n", tkn_elem->token);
2303                return -EINVAL;
2304        }
2305
2306        return 0;
2307}
2308
2309/*
2310 * Fill module specific resources from the manifest's resource
2311 * table like CPS, DMA size, mem_pages.
2312 */
2313static int skl_tplg_fill_res_tkn(struct device *dev,
2314                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2315                struct skl_module_res *res,
2316                int pin_idx, int dir)
2317{
2318        int ret, tkn_count = 0;
2319
2320        if (!res)
2321                return -EINVAL;
2322
2323        switch (tkn_elem->token) {
2324        case SKL_TKN_MM_U32_DMA_SIZE:
2325                res->dma_buffer_size = tkn_elem->value;
2326                break;
2327
2328        case SKL_TKN_MM_U32_CPC:
2329                res->cpc = tkn_elem->value;
2330                break;
2331
2332        case SKL_TKN_U32_MEM_PAGES:
2333                res->is_pages = tkn_elem->value;
2334                break;
2335
2336        case SKL_TKN_U32_OBS:
2337                res->obs = tkn_elem->value;
2338                break;
2339
2340        case SKL_TKN_U32_IBS:
2341                res->ibs = tkn_elem->value;
2342                break;
2343
2344        case SKL_TKN_MM_U32_RES_PIN_ID:
2345        case SKL_TKN_MM_U32_PIN_BUF:
2346                ret = skl_tplg_manifest_pin_res_tkn(dev, tkn_elem, res,
2347                                                    pin_idx, dir);
2348                if (ret < 0)
2349                        return ret;
2350                break;
2351
2352        case SKL_TKN_MM_U32_CPS:
2353        case SKL_TKN_U32_MAX_MCPS:
2354                /* ignore unused tokens */
2355                break;
2356
2357        default:
2358                dev_err(dev, "Not a res type token: %d", tkn_elem->token);
2359                return -EINVAL;
2360
2361        }
2362        tkn_count++;
2363
2364        return tkn_count;
2365}
2366
2367/*
2368 * Parse tokens to fill up the module private data
2369 */
2370static int skl_tplg_get_token(struct device *dev,
2371                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2372                struct skl_dev *skl, struct skl_module_cfg *mconfig)
2373{
2374        int tkn_count = 0;
2375        int ret;
2376        static int is_pipe_exists;
2377        static int pin_index, dir, conf_idx;
2378        struct skl_module_iface *iface = NULL;
2379        struct skl_module_res *res = NULL;
2380        int res_idx = mconfig->res_idx;
2381        int fmt_idx = mconfig->fmt_idx;
2382
2383        /*
2384         * If the manifest structure contains no modules, fill all
2385         * the module data to 0th index.
2386         * res_idx and fmt_idx are default set to 0.
2387         */
2388        if (skl->nr_modules == 0) {
2389                res = &mconfig->module->resources[res_idx];
2390                iface = &mconfig->module->formats[fmt_idx];
2391        }
2392
2393        if (tkn_elem->token > SKL_TKN_MAX)
2394                return -EINVAL;
2395
2396        switch (tkn_elem->token) {
2397        case SKL_TKN_U8_IN_QUEUE_COUNT:
2398                mconfig->module->max_input_pins = tkn_elem->value;
2399                break;
2400
2401        case SKL_TKN_U8_OUT_QUEUE_COUNT:
2402                mconfig->module->max_output_pins = tkn_elem->value;
2403                break;
2404
2405        case SKL_TKN_U8_DYN_IN_PIN:
2406                if (!mconfig->m_in_pin)
2407                        mconfig->m_in_pin =
2408                                devm_kcalloc(dev, MAX_IN_QUEUE,
2409                                             sizeof(*mconfig->m_in_pin),
2410                                             GFP_KERNEL);
2411                if (!mconfig->m_in_pin)
2412                        return -ENOMEM;
2413
2414                skl_tplg_fill_pin_dynamic_val(mconfig->m_in_pin, MAX_IN_QUEUE,
2415                                              tkn_elem->value);
2416                break;
2417
2418        case SKL_TKN_U8_DYN_OUT_PIN:
2419                if (!mconfig->m_out_pin)
2420                        mconfig->m_out_pin =
2421                                devm_kcalloc(dev, MAX_IN_QUEUE,
2422                                             sizeof(*mconfig->m_in_pin),
2423                                             GFP_KERNEL);
2424                if (!mconfig->m_out_pin)
2425                        return -ENOMEM;
2426
2427                skl_tplg_fill_pin_dynamic_val(mconfig->m_out_pin, MAX_OUT_QUEUE,
2428                                              tkn_elem->value);
2429                break;
2430
2431        case SKL_TKN_U8_TIME_SLOT:
2432                mconfig->time_slot = tkn_elem->value;
2433                break;
2434
2435        case SKL_TKN_U8_CORE_ID:
2436                mconfig->core_id = tkn_elem->value;
2437                break;
2438
2439        case SKL_TKN_U8_MOD_TYPE:
2440                mconfig->m_type = tkn_elem->value;
2441                break;
2442
2443        case SKL_TKN_U8_DEV_TYPE:
2444                mconfig->dev_type = tkn_elem->value;
2445                break;
2446
2447        case SKL_TKN_U8_HW_CONN_TYPE:
2448                mconfig->hw_conn_type = tkn_elem->value;
2449                break;
2450
2451        case SKL_TKN_U16_MOD_INST_ID:
2452                mconfig->id.instance_id =
2453                tkn_elem->value;
2454                break;
2455
2456        case SKL_TKN_U32_MEM_PAGES:
2457        case SKL_TKN_U32_MAX_MCPS:
2458        case SKL_TKN_U32_OBS:
2459        case SKL_TKN_U32_IBS:
2460                ret = skl_tplg_fill_res_tkn(dev, tkn_elem, res, pin_index, dir);
2461                if (ret < 0)
2462                        return ret;
2463
2464                break;
2465
2466        case SKL_TKN_U32_VBUS_ID:
2467                mconfig->vbus_id = tkn_elem->value;
2468                break;
2469
2470        case SKL_TKN_U32_PARAMS_FIXUP:
2471                mconfig->params_fixup = tkn_elem->value;
2472                break;
2473
2474        case SKL_TKN_U32_CONVERTER:
2475                mconfig->converter = tkn_elem->value;
2476                break;
2477
2478        case SKL_TKN_U32_D0I3_CAPS:
2479                mconfig->d0i3_caps = tkn_elem->value;
2480                break;
2481
2482        case SKL_TKN_U32_PIPE_ID:
2483                ret = skl_tplg_add_pipe(dev,
2484                                mconfig, skl, tkn_elem);
2485
2486                if (ret < 0) {
2487                        if (ret == -EEXIST) {
2488                                is_pipe_exists = 1;
2489                                break;
2490                        }
2491                        return is_pipe_exists;
2492                }
2493
2494                break;
2495
2496        case SKL_TKN_U32_PIPE_CONFIG_ID:
2497                conf_idx = tkn_elem->value;
2498                break;
2499
2500        case SKL_TKN_U32_PIPE_CONN_TYPE:
2501        case SKL_TKN_U32_PIPE_PRIORITY:
2502        case SKL_TKN_U32_PIPE_MEM_PGS:
2503        case SKL_TKN_U32_PMODE:
2504        case SKL_TKN_U32_PIPE_DIRECTION:
2505        case SKL_TKN_U32_NUM_CONFIGS:
2506                if (is_pipe_exists) {
2507                        ret = skl_tplg_fill_pipe_tkn(dev, mconfig->pipe,
2508                                        tkn_elem->token, tkn_elem->value);
2509                        if (ret < 0)
2510                                return ret;
2511                }
2512
2513                break;
2514
2515        case SKL_TKN_U32_PATH_MEM_PGS:
2516        case SKL_TKN_U32_CFG_FREQ:
2517        case SKL_TKN_U8_CFG_CHAN:
2518        case SKL_TKN_U8_CFG_BPS:
2519                if (mconfig->pipe->nr_cfgs) {
2520                        ret = skl_tplg_fill_pipe_cfg(dev, mconfig->pipe,
2521                                        tkn_elem->token, tkn_elem->value,
2522                                        conf_idx, dir);
2523                        if (ret < 0)
2524                                return ret;
2525                }
2526                break;
2527
2528        case SKL_TKN_CFG_MOD_RES_ID:
2529                mconfig->mod_cfg[conf_idx].res_idx = tkn_elem->value;
2530                break;
2531
2532        case SKL_TKN_CFG_MOD_FMT_ID:
2533                mconfig->mod_cfg[conf_idx].fmt_idx = tkn_elem->value;
2534                break;
2535
2536        /*
2537         * SKL_TKN_U32_DIR_PIN_COUNT token has the value for both
2538         * direction and the pin count. The first four bits represent
2539         * direction and next four the pin count.
2540         */
2541        case SKL_TKN_U32_DIR_PIN_COUNT:
2542                dir = tkn_elem->value & SKL_IN_DIR_BIT_MASK;
2543                pin_index = (tkn_elem->value &
2544                        SKL_PIN_COUNT_MASK) >> 4;
2545
2546                break;
2547
2548        case SKL_TKN_U32_FMT_CH:
2549        case SKL_TKN_U32_FMT_FREQ:
2550        case SKL_TKN_U32_FMT_BIT_DEPTH:
2551        case SKL_TKN_U32_FMT_SAMPLE_SIZE:
2552        case SKL_TKN_U32_FMT_CH_CONFIG:
2553        case SKL_TKN_U32_FMT_INTERLEAVE:
2554        case SKL_TKN_U32_FMT_SAMPLE_TYPE:
2555        case SKL_TKN_U32_FMT_CH_MAP:
2556                ret = skl_tplg_widget_fill_fmt(dev, iface, tkn_elem->token,
2557                                tkn_elem->value, dir, pin_index);
2558
2559                if (ret < 0)
2560                        return ret;
2561
2562                break;
2563
2564        case SKL_TKN_U32_PIN_MOD_ID:
2565        case SKL_TKN_U32_PIN_INST_ID:
2566        case SKL_TKN_UUID:
2567                ret = skl_tplg_fill_pins_info(dev,
2568                                mconfig, tkn_elem, dir,
2569                                pin_index);
2570                if (ret < 0)
2571                        return ret;
2572
2573                break;
2574
2575        case SKL_TKN_U32_FMT_CFG_IDX:
2576                if (tkn_elem->value > SKL_MAX_PARAMS_TYPES)
2577                        return -EINVAL;
2578
2579                mconfig->fmt_cfg_idx = tkn_elem->value;
2580                break;
2581
2582        case SKL_TKN_U32_CAPS_SIZE:
2583                mconfig->formats_config[mconfig->fmt_cfg_idx].caps_size =
2584                        tkn_elem->value;
2585
2586                break;
2587
2588        case SKL_TKN_U32_CAPS_SET_PARAMS:
2589                mconfig->formats_config[mconfig->fmt_cfg_idx].set_params =
2590                                tkn_elem->value;
2591                break;
2592
2593        case SKL_TKN_U32_CAPS_PARAMS_ID:
2594                mconfig->formats_config[mconfig->fmt_cfg_idx].param_id =
2595                                tkn_elem->value;
2596                break;
2597
2598        case SKL_TKN_U32_PROC_DOMAIN:
2599                mconfig->domain =
2600                        tkn_elem->value;
2601
2602                break;
2603
2604        case SKL_TKN_U32_DMA_BUF_SIZE:
2605                mconfig->dma_buffer_size = tkn_elem->value;
2606                break;
2607
2608        case SKL_TKN_U8_IN_PIN_TYPE:
2609        case SKL_TKN_U8_OUT_PIN_TYPE:
2610        case SKL_TKN_U8_CONN_TYPE:
2611                break;
2612
2613        default:
2614                dev_err(dev, "Token %d not handled\n",
2615                                tkn_elem->token);
2616                return -EINVAL;
2617        }
2618
2619        tkn_count++;
2620
2621        return tkn_count;
2622}
2623
2624/*
2625 * Parse the vendor array for specific tokens to construct
2626 * module private data
2627 */
2628static int skl_tplg_get_tokens(struct device *dev,
2629                char *pvt_data, struct skl_dev *skl,
2630                struct skl_module_cfg *mconfig, int block_size)
2631{
2632        struct snd_soc_tplg_vendor_array *array;
2633        struct snd_soc_tplg_vendor_value_elem *tkn_elem;
2634        int tkn_count = 0, ret;
2635        int off = 0, tuple_size = 0;
2636        bool is_module_guid = true;
2637
2638        if (block_size <= 0)
2639                return -EINVAL;
2640
2641        while (tuple_size < block_size) {
2642                array = (struct snd_soc_tplg_vendor_array *)(pvt_data + off);
2643
2644                off += array->size;
2645
2646                switch (array->type) {
2647                case SND_SOC_TPLG_TUPLE_TYPE_STRING:
2648                        dev_warn(dev, "no string tokens expected for skl tplg\n");
2649                        continue;
2650
2651                case SND_SOC_TPLG_TUPLE_TYPE_UUID:
2652                        if (is_module_guid) {
2653                                ret = skl_tplg_get_uuid(dev, (guid_t *)mconfig->guid,
2654                                                        array->uuid);
2655                                is_module_guid = false;
2656                        } else {
2657                                ret = skl_tplg_get_token(dev, array->value, skl,
2658                                                         mconfig);
2659                        }
2660
2661                        if (ret < 0)
2662                                return ret;
2663
2664                        tuple_size += sizeof(*array->uuid);
2665
2666                        continue;
2667
2668                default:
2669                        tkn_elem = array->value;
2670                        tkn_count = 0;
2671                        break;
2672                }
2673
2674                while (tkn_count <= (array->num_elems - 1)) {
2675                        ret = skl_tplg_get_token(dev, tkn_elem,
2676                                        skl, mconfig);
2677
2678                        if (ret < 0)
2679                                return ret;
2680
2681                        tkn_count = tkn_count + ret;
2682                        tkn_elem++;
2683                }
2684
2685                tuple_size += tkn_count * sizeof(*tkn_elem);
2686        }
2687
2688        return off;
2689}
2690
2691/*
2692 * Every data block is preceded by a descriptor to read the number
2693 * of data blocks, they type of the block and it's size
2694 */
2695static int skl_tplg_get_desc_blocks(struct device *dev,
2696                struct snd_soc_tplg_vendor_array *array)
2697{
2698        struct snd_soc_tplg_vendor_value_elem *tkn_elem;
2699
2700        tkn_elem = array->value;
2701
2702        switch (tkn_elem->token) {
2703        case SKL_TKN_U8_NUM_BLOCKS:
2704        case SKL_TKN_U8_BLOCK_TYPE:
2705        case SKL_TKN_U16_BLOCK_SIZE:
2706                return tkn_elem->value;
2707
2708        default:
2709                dev_err(dev, "Invalid descriptor token %d\n", tkn_elem->token);
2710                break;
2711        }
2712
2713        return -EINVAL;
2714}
2715
2716/* Functions to parse private data from configuration file format v4 */
2717
2718/*
2719 * Add pipeline from topology binary into driver pipeline list
2720 *
2721 * If already added we return that instance
2722 * Otherwise we create a new instance and add into driver list
2723 */
2724static int skl_tplg_add_pipe_v4(struct device *dev,
2725                        struct skl_module_cfg *mconfig, struct skl_dev *skl,
2726                        struct skl_dfw_v4_pipe *dfw_pipe)
2727{
2728        struct skl_pipeline *ppl;
2729        struct skl_pipe *pipe;
2730        struct skl_pipe_params *params;
2731
2732        list_for_each_entry(ppl, &skl->ppl_list, node) {
2733                if (ppl->pipe->ppl_id == dfw_pipe->pipe_id) {
2734                        mconfig->pipe = ppl->pipe;
2735                        return 0;
2736                }
2737        }
2738
2739        ppl = devm_kzalloc(dev, sizeof(*ppl), GFP_KERNEL);
2740        if (!ppl)
2741                return -ENOMEM;
2742
2743        pipe = devm_kzalloc(dev, sizeof(*pipe), GFP_KERNEL);
2744        if (!pipe)
2745                return -ENOMEM;
2746
2747        params = devm_kzalloc(dev, sizeof(*params), GFP_KERNEL);
2748        if (!params)
2749                return -ENOMEM;
2750
2751        pipe->ppl_id = dfw_pipe->pipe_id;
2752        pipe->memory_pages = dfw_pipe->memory_pages;
2753        pipe->pipe_priority = dfw_pipe->pipe_priority;
2754        pipe->conn_type = dfw_pipe->conn_type;
2755        pipe->state = SKL_PIPE_INVALID;
2756        pipe->p_params = params;
2757        INIT_LIST_HEAD(&pipe->w_list);
2758
2759        ppl->pipe = pipe;
2760        list_add(&ppl->node, &skl->ppl_list);
2761
2762        mconfig->pipe = pipe;
2763
2764        return 0;
2765}
2766
2767static void skl_fill_module_pin_info_v4(struct skl_dfw_v4_module_pin *dfw_pin,
2768                                        struct skl_module_pin *m_pin,
2769                                        bool is_dynamic, int max_pin)
2770{
2771        int i;
2772
2773        for (i = 0; i < max_pin; i++) {
2774                m_pin[i].id.module_id = dfw_pin[i].module_id;
2775                m_pin[i].id.instance_id = dfw_pin[i].instance_id;
2776                m_pin[i].in_use = false;
2777                m_pin[i].is_dynamic = is_dynamic;
2778                m_pin[i].pin_state = SKL_PIN_UNBIND;
2779        }
2780}
2781
2782static void skl_tplg_fill_fmt_v4(struct skl_module_pin_fmt *dst_fmt,
2783                                 struct skl_dfw_v4_module_fmt *src_fmt,
2784                                 int pins)
2785{
2786        int i;
2787
2788        for (i = 0; i < pins; i++) {
2789                dst_fmt[i].fmt.channels  = src_fmt[i].channels;
2790                dst_fmt[i].fmt.s_freq = src_fmt[i].freq;
2791                dst_fmt[i].fmt.bit_depth = src_fmt[i].bit_depth;
2792                dst_fmt[i].fmt.valid_bit_depth = src_fmt[i].valid_bit_depth;
2793                dst_fmt[i].fmt.ch_cfg = src_fmt[i].ch_cfg;
2794                dst_fmt[i].fmt.ch_map = src_fmt[i].ch_map;
2795                dst_fmt[i].fmt.interleaving_style =
2796                                                src_fmt[i].interleaving_style;
2797                dst_fmt[i].fmt.sample_type = src_fmt[i].sample_type;
2798        }
2799}
2800
2801static int skl_tplg_get_pvt_data_v4(struct snd_soc_tplg_dapm_widget *tplg_w,
2802                                    struct skl_dev *skl, struct device *dev,
2803                                    struct skl_module_cfg *mconfig)
2804{
2805        struct skl_dfw_v4_module *dfw =
2806                                (struct skl_dfw_v4_module *)tplg_w->priv.data;
2807        int ret;
2808        int idx = mconfig->fmt_cfg_idx;
2809
2810        dev_dbg(dev, "Parsing Skylake v4 widget topology data\n");
2811
2812        ret = guid_parse(dfw->uuid, (guid_t *)mconfig->guid);
2813        if (ret)
2814                return ret;
2815        mconfig->id.module_id = -1;
2816        mconfig->id.instance_id = dfw->instance_id;
2817        mconfig->module->resources[0].cpc = dfw->max_mcps / 1000;
2818        mconfig->module->resources[0].ibs = dfw->ibs;
2819        mconfig->module->resources[0].obs = dfw->obs;
2820        mconfig->core_id = dfw->core_id;
2821        mconfig->module->max_input_pins = dfw->max_in_queue;
2822        mconfig->module->max_output_pins = dfw->max_out_queue;
2823        mconfig->module->loadable = dfw->is_loadable;
2824        skl_tplg_fill_fmt_v4(mconfig->module->formats[0].inputs, dfw->in_fmt,
2825                             MAX_IN_QUEUE);
2826        skl_tplg_fill_fmt_v4(mconfig->module->formats[0].outputs, dfw->out_fmt,
2827                             MAX_OUT_QUEUE);
2828
2829        mconfig->params_fixup = dfw->params_fixup;
2830        mconfig->converter = dfw->converter;
2831        mconfig->m_type = dfw->module_type;
2832        mconfig->vbus_id = dfw->vbus_id;
2833        mconfig->module->resources[0].is_pages = dfw->mem_pages;
2834
2835        ret = skl_tplg_add_pipe_v4(dev, mconfig, skl, &dfw->pipe);
2836        if (ret)
2837                return ret;
2838
2839        mconfig->dev_type = dfw->dev_type;
2840        mconfig->hw_conn_type = dfw->hw_conn_type;
2841        mconfig->time_slot = dfw->time_slot;
2842        mconfig->formats_config[idx].caps_size = dfw->caps.caps_size;
2843
2844        mconfig->m_in_pin = devm_kcalloc(dev,
2845                                MAX_IN_QUEUE, sizeof(*mconfig->m_in_pin),
2846                                GFP_KERNEL);
2847        if (!mconfig->m_in_pin)
2848                return -ENOMEM;
2849
2850        mconfig->m_out_pin = devm_kcalloc(dev,
2851                                MAX_OUT_QUEUE, sizeof(*mconfig->m_out_pin),
2852                                GFP_KERNEL);
2853        if (!mconfig->m_out_pin)
2854                return -ENOMEM;
2855
2856        skl_fill_module_pin_info_v4(dfw->in_pin, mconfig->m_in_pin,
2857                                    dfw->is_dynamic_in_pin,
2858                                    mconfig->module->max_input_pins);
2859        skl_fill_module_pin_info_v4(dfw->out_pin, mconfig->m_out_pin,
2860                                    dfw->is_dynamic_out_pin,
2861                                    mconfig->module->max_output_pins);
2862
2863        if (mconfig->formats_config[idx].caps_size) {
2864                mconfig->formats_config[idx].set_params = dfw->caps.set_params;
2865                mconfig->formats_config[idx].param_id = dfw->caps.param_id;
2866                mconfig->formats_config[idx].caps =
2867                devm_kzalloc(dev, mconfig->formats_config[idx].caps_size,
2868                             GFP_KERNEL);
2869                if (!mconfig->formats_config[idx].caps)
2870                        return -ENOMEM;
2871                memcpy(mconfig->formats_config[idx].caps, dfw->caps.caps,
2872                       dfw->caps.caps_size);
2873        }
2874
2875        return 0;
2876}
2877
2878static int skl_tplg_get_caps_data(struct device *dev, char *data,
2879                                  struct skl_module_cfg *mconfig)
2880{
2881        int idx = mconfig->fmt_cfg_idx;
2882
2883        if (mconfig->formats_config[idx].caps_size > 0) {
2884                mconfig->formats_config[idx].caps =
2885                        devm_kzalloc(dev, mconfig->formats_config[idx].caps_size,
2886                                     GFP_KERNEL);
2887                if (!mconfig->formats_config[idx].caps)
2888                        return -ENOMEM;
2889                memcpy(mconfig->formats_config[idx].caps, data,
2890                       mconfig->formats_config[idx].caps_size);
2891        }
2892
2893        return mconfig->formats_config[idx].caps_size;
2894}
2895
2896/*
2897 * Parse the private data for the token and corresponding value.
2898 * The private data can have multiple data blocks. So, a data block
2899 * is preceded by a descriptor for number of blocks and a descriptor
2900 * for the type and size of the suceeding data block.
2901 */
2902static int skl_tplg_get_pvt_data(struct snd_soc_tplg_dapm_widget *tplg_w,
2903                                struct skl_dev *skl, struct device *dev,
2904                                struct skl_module_cfg *mconfig)
2905{
2906        struct snd_soc_tplg_vendor_array *array;
2907        int num_blocks, block_size, block_type, off = 0;
2908        char *data;
2909        int ret;
2910
2911        /*
2912         * v4 configuration files have a valid UUID at the start of
2913         * the widget's private data.
2914         */
2915        if (uuid_is_valid((char *)tplg_w->priv.data))
2916                return skl_tplg_get_pvt_data_v4(tplg_w, skl, dev, mconfig);
2917
2918        /* Read the NUM_DATA_BLOCKS descriptor */
2919        array = (struct snd_soc_tplg_vendor_array *)tplg_w->priv.data;
2920        ret = skl_tplg_get_desc_blocks(dev, array);
2921        if (ret < 0)
2922                return ret;
2923        num_blocks = ret;
2924
2925        off += array->size;
2926        /* Read the BLOCK_TYPE and BLOCK_SIZE descriptor */
2927        while (num_blocks > 0) {
2928                array = (struct snd_soc_tplg_vendor_array *)
2929                                (tplg_w->priv.data + off);
2930
2931                ret = skl_tplg_get_desc_blocks(dev, array);
2932
2933                if (ret < 0)
2934                        return ret;
2935                block_type = ret;
2936                off += array->size;
2937
2938                array = (struct snd_soc_tplg_vendor_array *)
2939                        (tplg_w->priv.data + off);
2940
2941                ret = skl_tplg_get_desc_blocks(dev, array);
2942
2943                if (ret < 0)
2944                        return ret;
2945                block_size = ret;
2946                off += array->size;
2947
2948                array = (struct snd_soc_tplg_vendor_array *)
2949                        (tplg_w->priv.data + off);
2950
2951                data = (tplg_w->priv.data + off);
2952
2953                if (block_type == SKL_TYPE_TUPLE) {
2954                        ret = skl_tplg_get_tokens(dev, data,
2955                                        skl, mconfig, block_size);
2956                } else {
2957                        ret = skl_tplg_get_caps_data(dev, data, mconfig);
2958                }
2959
2960                if (ret < 0)
2961                        return ret;
2962
2963                --num_blocks;
2964                off += ret;
2965        }
2966
2967        return 0;
2968}
2969
2970static void skl_clear_pin_config(struct snd_soc_component *component,
2971                                struct snd_soc_dapm_widget *w)
2972{
2973        int i;
2974        struct skl_module_cfg *mconfig;
2975        struct skl_pipe *pipe;
2976
2977        if (!strncmp(w->dapm->component->name, component->name,
2978                                        strlen(component->name))) {
2979                mconfig = w->priv;
2980                pipe = mconfig->pipe;
2981                for (i = 0; i < mconfig->module->max_input_pins; i++) {
2982                        mconfig->m_in_pin[i].in_use = false;
2983                        mconfig->m_in_pin[i].pin_state = SKL_PIN_UNBIND;
2984                }
2985                for (i = 0; i < mconfig->module->max_output_pins; i++) {
2986                        mconfig->m_out_pin[i].in_use = false;
2987                        mconfig->m_out_pin[i].pin_state = SKL_PIN_UNBIND;
2988                }
2989                pipe->state = SKL_PIPE_INVALID;
2990                mconfig->m_state = SKL_MODULE_UNINIT;
2991        }
2992}
2993
2994void skl_cleanup_resources(struct skl_dev *skl)
2995{
2996        struct snd_soc_component *soc_component = skl->component;
2997        struct snd_soc_dapm_widget *w;
2998        struct snd_soc_card *card;
2999
3000        if (soc_component == NULL)
3001                return;
3002
3003        card = soc_component->card;
3004        if (!card || !card->instantiated)
3005                return;
3006
3007        list_for_each_entry(w, &card->widgets, list) {
3008                if (is_skl_dsp_widget_type(w, skl->dev) && w->priv != NULL)
3009                        skl_clear_pin_config(soc_component, w);
3010        }
3011
3012        skl_clear_module_cnt(skl->dsp);
3013}
3014
3015/*
3016 * Topology core widget load callback
3017 *
3018 * This is used to save the private data for each widget which gives
3019 * information to the driver about module and pipeline parameters which DSP
3020 * FW expects like ids, resource values, formats etc
3021 */
3022static int skl_tplg_widget_load(struct snd_soc_component *cmpnt, int index,
3023                                struct snd_soc_dapm_widget *w,
3024                                struct snd_soc_tplg_dapm_widget *tplg_w)
3025{
3026        int ret;
3027        struct hdac_bus *bus = snd_soc_component_get_drvdata(cmpnt);
3028        struct skl_dev *skl = bus_to_skl(bus);
3029        struct skl_module_cfg *mconfig;
3030
3031        if (!tplg_w->priv.size)
3032                goto bind_event;
3033
3034        mconfig = devm_kzalloc(bus->dev, sizeof(*mconfig), GFP_KERNEL);
3035
3036        if (!mconfig)
3037                return -ENOMEM;
3038
3039        if (skl->nr_modules == 0) {
3040                mconfig->module = devm_kzalloc(bus->dev,
3041                                sizeof(*mconfig->module), GFP_KERNEL);
3042                if (!mconfig->module)
3043                        return -ENOMEM;
3044        }
3045
3046        w->priv = mconfig;
3047
3048        /*
3049         * module binary can be loaded later, so set it to query when
3050         * module is load for a use case
3051         */
3052        mconfig->id.module_id = -1;
3053
3054        /* To provide backward compatibility, set default as SKL_PARAM_INIT */
3055        mconfig->fmt_cfg_idx = SKL_PARAM_INIT;
3056
3057        /* Parse private data for tuples */
3058        ret = skl_tplg_get_pvt_data(tplg_w, skl, bus->dev, mconfig);
3059        if (ret < 0)
3060                return ret;
3061
3062        skl_debug_init_module(skl->debugfs, w, mconfig);
3063
3064bind_event:
3065        if (tplg_w->event_type == 0) {
3066                dev_dbg(bus->dev, "ASoC: No event handler required\n");
3067                return 0;
3068        }
3069
3070        ret = snd_soc_tplg_widget_bind_event(w, skl_tplg_widget_ops,
3071                                        ARRAY_SIZE(skl_tplg_widget_ops),
3072                                        tplg_w->event_type);
3073
3074        if (ret) {
3075                dev_err(bus->dev, "%s: No matching event handlers found for %d\n",
3076                                        __func__, tplg_w->event_type);
3077                return -EINVAL;
3078        }
3079
3080        return 0;
3081}
3082
3083static int skl_init_algo_data(struct device *dev, struct soc_bytes_ext *be,
3084                                        struct snd_soc_tplg_bytes_control *bc)
3085{
3086        struct skl_algo_data *ac;
3087        struct skl_dfw_algo_data *dfw_ac =
3088                                (struct skl_dfw_algo_data *)bc->priv.data;
3089
3090        ac = devm_kzalloc(dev, sizeof(*ac), GFP_KERNEL);
3091        if (!ac)
3092                return -ENOMEM;
3093
3094        /* Fill private data */
3095        ac->max = dfw_ac->max;
3096        ac->param_id = dfw_ac->param_id;
3097        ac->set_params = dfw_ac->set_params;
3098        ac->size = dfw_ac->max;
3099
3100        if (ac->max) {
3101                ac->params = devm_kzalloc(dev, ac->max, GFP_KERNEL);
3102                if (!ac->params)
3103                        return -ENOMEM;
3104
3105                memcpy(ac->params, dfw_ac->params, ac->max);
3106        }
3107
3108        be->dobj.private  = ac;
3109        return 0;
3110}
3111
3112static int skl_init_enum_data(struct device *dev, struct soc_enum *se,
3113                                struct snd_soc_tplg_enum_control *ec)
3114{
3115
3116        void *data;
3117
3118        if (ec->priv.size) {
3119                data = devm_kzalloc(dev, sizeof(ec->priv.size), GFP_KERNEL);
3120                if (!data)
3121                        return -ENOMEM;
3122                memcpy(data, ec->priv.data, ec->priv.size);
3123                se->dobj.private = data;
3124        }
3125
3126        return 0;
3127
3128}
3129
3130static int skl_tplg_control_load(struct snd_soc_component *cmpnt,
3131                                int index,
3132                                struct snd_kcontrol_new *kctl,
3133                                struct snd_soc_tplg_ctl_hdr *hdr)
3134{
3135        struct soc_bytes_ext *sb;
3136        struct snd_soc_tplg_bytes_control *tplg_bc;
3137        struct snd_soc_tplg_enum_control *tplg_ec;
3138        struct hdac_bus *bus  = snd_soc_component_get_drvdata(cmpnt);
3139        struct soc_enum *se;
3140
3141        switch (hdr->ops.info) {
3142        case SND_SOC_TPLG_CTL_BYTES:
3143                tplg_bc = container_of(hdr,
3144                                struct snd_soc_tplg_bytes_control, hdr);
3145                if (kctl->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
3146                        sb = (struct soc_bytes_ext *)kctl->private_value;
3147                        if (tplg_bc->priv.size)
3148                                return skl_init_algo_data(
3149                                                bus->dev, sb, tplg_bc);
3150                }
3151                break;
3152
3153        case SND_SOC_TPLG_CTL_ENUM:
3154                tplg_ec = container_of(hdr,
3155                                struct snd_soc_tplg_enum_control, hdr);
3156                if (kctl->access & SNDRV_CTL_ELEM_ACCESS_READ) {
3157                        se = (struct soc_enum *)kctl->private_value;
3158                        if (tplg_ec->priv.size)
3159                                skl_init_enum_data(bus->dev, se, tplg_ec);
3160                }
3161
3162                /*
3163                 * now that the control initializations are done, remove
3164                 * write permission for the DMIC configuration enums to
3165                 * avoid conflicts between NHLT settings and user interaction
3166                 */
3167
3168                if (hdr->ops.get == SKL_CONTROL_TYPE_MULTI_IO_SELECT_DMIC)
3169                        kctl->access = SNDRV_CTL_ELEM_ACCESS_READ;
3170
3171                break;
3172
3173        default:
3174                dev_dbg(bus->dev, "Control load not supported %d:%d:%d\n",
3175                        hdr->ops.get, hdr->ops.put, hdr->ops.info);
3176                break;
3177        }
3178
3179        return 0;
3180}
3181
3182static int skl_tplg_fill_str_mfest_tkn(struct device *dev,
3183                struct snd_soc_tplg_vendor_string_elem *str_elem,
3184                struct skl_dev *skl)
3185{
3186        int tkn_count = 0;
3187        static int ref_count;
3188
3189        switch (str_elem->token) {
3190        case SKL_TKN_STR_LIB_NAME:
3191                if (ref_count > skl->lib_count - 1) {
3192                        ref_count = 0;
3193                        return -EINVAL;
3194                }
3195
3196                strncpy(skl->lib_info[ref_count].name,
3197                        str_elem->string,
3198                        ARRAY_SIZE(skl->lib_info[ref_count].name));
3199                ref_count++;
3200                break;
3201
3202        default:
3203                dev_err(dev, "Not a string token %d\n", str_elem->token);
3204                break;
3205        }
3206        tkn_count++;
3207
3208        return tkn_count;
3209}
3210
3211static int skl_tplg_get_str_tkn(struct device *dev,
3212                struct snd_soc_tplg_vendor_array *array,
3213                struct skl_dev *skl)
3214{
3215        int tkn_count = 0, ret;
3216        struct snd_soc_tplg_vendor_string_elem *str_elem;
3217
3218        str_elem = (struct snd_soc_tplg_vendor_string_elem *)array->value;
3219        while (tkn_count < array->num_elems) {
3220                ret = skl_tplg_fill_str_mfest_tkn(dev, str_elem, skl);
3221                str_elem++;
3222
3223                if (ret < 0)
3224                        return ret;
3225
3226                tkn_count = tkn_count + ret;
3227        }
3228
3229        return tkn_count;
3230}
3231
3232static int skl_tplg_manifest_fill_fmt(struct device *dev,
3233                struct skl_module_iface *fmt,
3234                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3235                u32 dir, int fmt_idx)
3236{
3237        struct skl_module_pin_fmt *dst_fmt;
3238        struct skl_module_fmt *mod_fmt;
3239        int ret;
3240
3241        if (!fmt)
3242                return -EINVAL;
3243
3244        switch (dir) {
3245        case SKL_DIR_IN:
3246                dst_fmt = &fmt->inputs[fmt_idx];
3247                break;
3248
3249        case SKL_DIR_OUT:
3250                dst_fmt = &fmt->outputs[fmt_idx];
3251                break;
3252
3253        default:
3254                dev_err(dev, "Invalid direction: %d\n", dir);
3255                return -EINVAL;
3256        }
3257
3258        mod_fmt = &dst_fmt->fmt;
3259
3260        switch (tkn_elem->token) {
3261        case SKL_TKN_MM_U32_INTF_PIN_ID:
3262                dst_fmt->id = tkn_elem->value;
3263                break;
3264
3265        default:
3266                ret = skl_tplg_fill_fmt(dev, mod_fmt, tkn_elem->token,
3267                                        tkn_elem->value);
3268                if (ret < 0)
3269                        return ret;
3270                break;
3271        }
3272
3273        return 0;
3274}
3275
3276static int skl_tplg_fill_mod_info(struct device *dev,
3277                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3278                struct skl_module *mod)
3279{
3280
3281        if (!mod)
3282                return -EINVAL;
3283
3284        switch (tkn_elem->token) {
3285        case SKL_TKN_U8_IN_PIN_TYPE:
3286                mod->input_pin_type = tkn_elem->value;
3287                break;
3288
3289        case SKL_TKN_U8_OUT_PIN_TYPE:
3290                mod->output_pin_type = tkn_elem->value;
3291                break;
3292
3293        case SKL_TKN_U8_IN_QUEUE_COUNT:
3294                mod->max_input_pins = tkn_elem->value;
3295                break;
3296
3297        case SKL_TKN_U8_OUT_QUEUE_COUNT:
3298                mod->max_output_pins = tkn_elem->value;
3299                break;
3300
3301        case SKL_TKN_MM_U8_NUM_RES:
3302                mod->nr_resources = tkn_elem->value;
3303                break;
3304
3305        case SKL_TKN_MM_U8_NUM_INTF:
3306                mod->nr_interfaces = tkn_elem->value;
3307                break;
3308
3309        default:
3310                dev_err(dev, "Invalid mod info token %d", tkn_elem->token);
3311                return -EINVAL;
3312        }
3313
3314        return 0;
3315}
3316
3317
3318static int skl_tplg_get_int_tkn(struct device *dev,
3319                struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3320                struct skl_dev *skl)
3321{
3322        int tkn_count = 0, ret;
3323        static int mod_idx, res_val_idx, intf_val_idx, dir, pin_idx;
3324        struct skl_module_res *res = NULL;
3325        struct skl_module_iface *fmt = NULL;
3326        struct skl_module *mod = NULL;
3327        static struct skl_astate_param *astate_table;
3328        static int astate_cfg_idx, count;
3329        int i;
3330        size_t size;
3331
3332        if (skl->modules) {
3333                mod = skl->modules[mod_idx];
3334                res = &mod->resources[res_val_idx];
3335                fmt = &mod->formats[intf_val_idx];
3336        }
3337
3338        switch (tkn_elem->token) {
3339        case SKL_TKN_U32_LIB_COUNT:
3340                skl->lib_count = tkn_elem->value;
3341                break;
3342
3343        case SKL_TKN_U8_NUM_MOD:
3344                skl->nr_modules = tkn_elem->value;
3345                skl->modules = devm_kcalloc(dev, skl->nr_modules,
3346                                sizeof(*skl->modules), GFP_KERNEL);
3347                if (!skl->modules)
3348                        return -ENOMEM;
3349
3350                for (i = 0; i < skl->nr_modules; i++) {
3351                        skl->modules[i] = devm_kzalloc(dev,
3352                                        sizeof(struct skl_module), GFP_KERNEL);
3353                        if (!skl->modules[i])
3354                                return -ENOMEM;
3355                }
3356                break;
3357
3358        case SKL_TKN_MM_U8_MOD_IDX:
3359                mod_idx = tkn_elem->value;
3360                break;
3361
3362        case SKL_TKN_U32_ASTATE_COUNT:
3363                if (astate_table != NULL) {
3364                        dev_err(dev, "More than one entry for A-State count");
3365                        return -EINVAL;
3366                }
3367
3368                if (tkn_elem->value > SKL_MAX_ASTATE_CFG) {
3369                        dev_err(dev, "Invalid A-State count %d\n",
3370                                tkn_elem->value);
3371                        return -EINVAL;
3372                }
3373
3374                size = struct_size(skl->cfg.astate_cfg, astate_table,
3375                                   tkn_elem->value);
3376                skl->cfg.astate_cfg = devm_kzalloc(dev, size, GFP_KERNEL);
3377                if (!skl->cfg.astate_cfg)
3378                        return -ENOMEM;
3379
3380                astate_table = skl->cfg.astate_cfg->astate_table;
3381                count = skl->cfg.astate_cfg->count = tkn_elem->value;
3382                break;
3383
3384        case SKL_TKN_U32_ASTATE_IDX:
3385                if (tkn_elem->value >= count) {
3386                        dev_err(dev, "Invalid A-State index %d\n",
3387                                tkn_elem->value);
3388                        return -EINVAL;
3389                }
3390
3391                astate_cfg_idx = tkn_elem->value;
3392                break;
3393
3394        case SKL_TKN_U32_ASTATE_KCPS:
3395                astate_table[astate_cfg_idx].kcps = tkn_elem->value;
3396                break;
3397
3398        case SKL_TKN_U32_ASTATE_CLK_SRC:
3399                astate_table[astate_cfg_idx].clk_src = tkn_elem->value;
3400                break;
3401
3402        case SKL_TKN_U8_IN_PIN_TYPE:
3403        case SKL_TKN_U8_OUT_PIN_TYPE:
3404        case SKL_TKN_U8_IN_QUEUE_COUNT:
3405        case SKL_TKN_U8_OUT_QUEUE_COUNT:
3406        case SKL_TKN_MM_U8_NUM_RES:
3407        case SKL_TKN_MM_U8_NUM_INTF:
3408                ret = skl_tplg_fill_mod_info(dev, tkn_elem, mod);
3409                if (ret < 0)
3410                        return ret;
3411                break;
3412
3413        case SKL_TKN_U32_DIR_PIN_COUNT:
3414                dir = tkn_elem->value & SKL_IN_DIR_BIT_MASK;
3415                pin_idx = (tkn_elem->value & SKL_PIN_COUNT_MASK) >> 4;
3416                break;
3417
3418        case SKL_TKN_MM_U32_RES_ID:
3419                if (!res)
3420                        return -EINVAL;
3421
3422                res->id = tkn_elem->value;
3423                res_val_idx = tkn_elem->value;
3424                break;
3425
3426        case SKL_TKN_MM_U32_FMT_ID:
3427                if (!fmt)
3428                        return -EINVAL;
3429
3430                fmt->fmt_idx = tkn_elem->value;
3431                intf_val_idx = tkn_elem->value;
3432                break;
3433
3434        case SKL_TKN_MM_U32_CPS:
3435        case SKL_TKN_MM_U32_DMA_SIZE:
3436        case SKL_TKN_MM_U32_CPC:
3437        case SKL_TKN_U32_MEM_PAGES:
3438        case SKL_TKN_U32_OBS:
3439        case SKL_TKN_U32_IBS:
3440        case SKL_TKN_MM_U32_RES_PIN_ID:
3441        case SKL_TKN_MM_U32_PIN_BUF:
3442                ret = skl_tplg_fill_res_tkn(dev, tkn_elem, res, pin_idx, dir);
3443                if (ret < 0)
3444                        return ret;
3445
3446                break;
3447
3448        case SKL_TKN_MM_U32_NUM_IN_FMT:
3449                if (!fmt)
3450                        return -EINVAL;
3451
3452                res->nr_input_pins = tkn_elem->value;
3453                break;
3454
3455        case SKL_TKN_MM_U32_NUM_OUT_FMT:
3456                if (!fmt)
3457                        return -EINVAL;
3458
3459                res->nr_output_pins = tkn_elem->value;
3460                break;
3461
3462        case SKL_TKN_U32_FMT_CH:
3463        case SKL_TKN_U32_FMT_FREQ:
3464        case SKL_TKN_U32_FMT_BIT_DEPTH:
3465        case SKL_TKN_U32_FMT_SAMPLE_SIZE:
3466        case SKL_TKN_U32_FMT_CH_CONFIG:
3467        case SKL_TKN_U32_FMT_INTERLEAVE:
3468        case SKL_TKN_U32_FMT_SAMPLE_TYPE:
3469        case SKL_TKN_U32_FMT_CH_MAP:
3470        case SKL_TKN_MM_U32_INTF_PIN_ID:
3471                ret = skl_tplg_manifest_fill_fmt(dev, fmt, tkn_elem,
3472                                                 dir, pin_idx);
3473                if (ret < 0)
3474                        return ret;
3475                break;
3476
3477        default:
3478                dev_err(dev, "Not a manifest token %d\n", tkn_elem->token);
3479                return -EINVAL;
3480        }
3481        tkn_count++;
3482
3483        return tkn_count;
3484}
3485
3486/*
3487 * Fill the manifest structure by parsing the tokens based on the
3488 * type.
3489 */
3490static int skl_tplg_get_manifest_tkn(struct device *dev,
3491                char *pvt_data, struct skl_dev *skl,
3492                int block_size)
3493{
3494        int tkn_count = 0, ret;
3495        int off = 0, tuple_size = 0;
3496        u8 uuid_index = 0;
3497        struct snd_soc_tplg_vendor_array *array;
3498        struct snd_soc_tplg_vendor_value_elem *tkn_elem;
3499
3500        if (block_size <= 0)
3501                return -EINVAL;
3502
3503        while (tuple_size < block_size) {
3504                array = (struct snd_soc_tplg_vendor_array *)(pvt_data + off);
3505                off += array->size;
3506                switch (array->type) {
3507                case SND_SOC_TPLG_TUPLE_TYPE_STRING:
3508                        ret = skl_tplg_get_str_tkn(dev, array, skl);
3509
3510                        if (ret < 0)
3511                                return ret;
3512                        tkn_count = ret;
3513
3514                        tuple_size += tkn_count *
3515                                sizeof(struct snd_soc_tplg_vendor_string_elem);
3516                        continue;
3517
3518                case SND_SOC_TPLG_TUPLE_TYPE_UUID:
3519                        if (array->uuid->token != SKL_TKN_UUID) {
3520                                dev_err(dev, "Not an UUID token: %d\n",
3521                                        array->uuid->token);
3522                                return -EINVAL;
3523                        }
3524                        if (uuid_index >= skl->nr_modules) {
3525                                dev_err(dev, "Too many UUID tokens\n");
3526                                return -EINVAL;
3527                        }
3528                        import_guid(&skl->modules[uuid_index++]->uuid,
3529                                    array->uuid->uuid);
3530
3531                        tuple_size += sizeof(*array->uuid);
3532                        continue;
3533
3534                default:
3535                        tkn_elem = array->value;
3536                        tkn_count = 0;
3537                        break;
3538                }
3539
3540                while (tkn_count <= array->num_elems - 1) {
3541                        ret = skl_tplg_get_int_tkn(dev,
3542                                        tkn_elem, skl);
3543                        if (ret < 0)
3544                                return ret;
3545
3546                        tkn_count = tkn_count + ret;
3547                        tkn_elem++;
3548                }
3549                tuple_size += (tkn_count * sizeof(*tkn_elem));
3550                tkn_count = 0;
3551        }
3552
3553        return off;
3554}
3555
3556/*
3557 * Parse manifest private data for tokens. The private data block is
3558 * preceded by descriptors for type and size of data block.
3559 */
3560static int skl_tplg_get_manifest_data(struct snd_soc_tplg_manifest *manifest,
3561                        struct device *dev, struct skl_dev *skl)
3562{
3563        struct snd_soc_tplg_vendor_array *array;
3564        int num_blocks, block_size = 0, block_type, off = 0;
3565        char *data;
3566        int ret;
3567
3568        /* Read the NUM_DATA_BLOCKS descriptor */
3569        array = (struct snd_soc_tplg_vendor_array *)manifest->priv.data;
3570        ret = skl_tplg_get_desc_blocks(dev, array);
3571        if (ret < 0)
3572                return ret;
3573        num_blocks = ret;
3574
3575        off += array->size;
3576        /* Read the BLOCK_TYPE and BLOCK_SIZE descriptor */
3577        while (num_blocks > 0) {
3578                array = (struct snd_soc_tplg_vendor_array *)
3579                                (manifest->priv.data + off);
3580                ret = skl_tplg_get_desc_blocks(dev, array);
3581
3582                if (ret < 0)
3583                        return ret;
3584                block_type = ret;
3585                off += array->size;
3586
3587                array = (struct snd_soc_tplg_vendor_array *)
3588                        (manifest->priv.data + off);
3589
3590                ret = skl_tplg_get_desc_blocks(dev, array);
3591
3592                if (ret < 0)
3593                        return ret;
3594                block_size = ret;
3595                off += array->size;
3596
3597                array = (struct snd_soc_tplg_vendor_array *)
3598                        (manifest->priv.data + off);
3599
3600                data = (manifest->priv.data + off);
3601
3602                if (block_type == SKL_TYPE_TUPLE) {
3603                        ret = skl_tplg_get_manifest_tkn(dev, data, skl,
3604                                        block_size);
3605
3606                        if (ret < 0)
3607                                return ret;
3608
3609                        --num_blocks;
3610                } else {
3611                        return -EINVAL;
3612                }
3613                off += ret;
3614        }
3615
3616        return 0;
3617}
3618
3619static int skl_manifest_load(struct snd_soc_component *cmpnt, int index,
3620                                struct snd_soc_tplg_manifest *manifest)
3621{
3622        struct hdac_bus *bus = snd_soc_component_get_drvdata(cmpnt);
3623        struct skl_dev *skl = bus_to_skl(bus);
3624
3625        /* proceed only if we have private data defined */
3626        if (manifest->priv.size == 0)
3627                return 0;
3628
3629        skl_tplg_get_manifest_data(manifest, bus->dev, skl);
3630
3631        if (skl->lib_count > SKL_MAX_LIB) {
3632                dev_err(bus->dev, "Exceeding max Library count. Got:%d\n",
3633                                        skl->lib_count);
3634                return  -EINVAL;
3635        }
3636
3637        return 0;
3638}
3639
3640static void skl_tplg_complete(struct snd_soc_component *component)
3641{
3642        struct snd_soc_dobj *dobj;
3643        struct snd_soc_acpi_mach *mach;
3644        struct snd_ctl_elem_value *val;
3645        int i;
3646
3647        val = kmalloc(sizeof(*val), GFP_KERNEL);
3648        if (!val)
3649                return;
3650
3651        mach = dev_get_platdata(component->card->dev);
3652        list_for_each_entry(dobj, &component->dobj_list, list) {
3653                struct snd_kcontrol *kcontrol = dobj->control.kcontrol;
3654                struct soc_enum *se;
3655                char **texts;
3656                char chan_text[4];
3657
3658                if (dobj->type != SND_SOC_DOBJ_ENUM || !kcontrol ||
3659                    kcontrol->put != skl_tplg_multi_config_set_dmic)
3660                        continue;
3661
3662                se = (struct soc_enum *)kcontrol->private_value;
3663                texts = dobj->control.dtexts;
3664                sprintf(chan_text, "c%d", mach->mach_params.dmic_num);
3665
3666                for (i = 0; i < se->items; i++) {
3667                        if (strstr(texts[i], chan_text)) {
3668                                memset(val, 0, sizeof(*val));
3669                                val->value.enumerated.item[0] = i;
3670                                kcontrol->put(kcontrol, val);
3671                        }
3672                }
3673        }
3674        kfree(val);
3675}
3676
3677static struct snd_soc_tplg_ops skl_tplg_ops  = {
3678        .widget_load = skl_tplg_widget_load,
3679        .control_load = skl_tplg_control_load,
3680        .bytes_ext_ops = skl_tlv_ops,
3681        .bytes_ext_ops_count = ARRAY_SIZE(skl_tlv_ops),
3682        .io_ops = skl_tplg_kcontrol_ops,
3683        .io_ops_count = ARRAY_SIZE(skl_tplg_kcontrol_ops),
3684        .manifest = skl_manifest_load,
3685        .dai_load = skl_dai_load,
3686        .complete = skl_tplg_complete,
3687};
3688
3689/*
3690 * A pipe can have multiple modules, each of them will be a DAPM widget as
3691 * well. While managing a pipeline we need to get the list of all the
3692 * widgets in a pipelines, so this helper - skl_tplg_create_pipe_widget_list()
3693 * helps to get the SKL type widgets in that pipeline
3694 */
3695static int skl_tplg_create_pipe_widget_list(struct snd_soc_component *component)
3696{
3697        struct snd_soc_dapm_widget *w;
3698        struct skl_module_cfg *mcfg = NULL;
3699        struct skl_pipe_module *p_module = NULL;
3700        struct skl_pipe *pipe;
3701
3702        list_for_each_entry(w, &component->card->widgets, list) {
3703                if (is_skl_dsp_widget_type(w, component->dev) && w->priv) {
3704                        mcfg = w->priv;
3705                        pipe = mcfg->pipe;
3706
3707                        p_module = devm_kzalloc(component->dev,
3708                                                sizeof(*p_module), GFP_KERNEL);
3709                        if (!p_module)
3710                                return -ENOMEM;
3711
3712                        p_module->w = w;
3713                        list_add_tail(&p_module->node, &pipe->w_list);
3714                }
3715        }
3716
3717        return 0;
3718}
3719
3720static void skl_tplg_set_pipe_type(struct skl_dev *skl, struct skl_pipe *pipe)
3721{
3722        struct skl_pipe_module *w_module;
3723        struct snd_soc_dapm_widget *w;
3724        struct skl_module_cfg *mconfig;
3725        bool host_found = false, link_found = false;
3726
3727        list_for_each_entry(w_module, &pipe->w_list, node) {
3728                w = w_module->w;
3729                mconfig = w->priv;
3730
3731                if (mconfig->dev_type == SKL_DEVICE_HDAHOST)
3732                        host_found = true;
3733                else if (mconfig->dev_type != SKL_DEVICE_NONE)
3734                        link_found = true;
3735        }
3736
3737        if (host_found && link_found)
3738                pipe->passthru = true;
3739        else
3740                pipe->passthru = false;
3741}
3742
3743/*
3744 * SKL topology init routine
3745 */
3746int skl_tplg_init(struct snd_soc_component *component, struct hdac_bus *bus)
3747{
3748        int ret;
3749        const struct firmware *fw;
3750        struct skl_dev *skl = bus_to_skl(bus);
3751        struct skl_pipeline *ppl;
3752
3753        ret = request_firmware(&fw, skl->tplg_name, bus->dev);
3754        if (ret < 0) {
3755                char alt_tplg_name[64];
3756
3757                snprintf(alt_tplg_name, sizeof(alt_tplg_name), "%s-tplg.bin",
3758                         skl->mach->drv_name);
3759                dev_info(bus->dev, "tplg fw %s load failed with %d, trying alternative tplg name %s",
3760                         skl->tplg_name, ret, alt_tplg_name);
3761
3762                ret = request_firmware(&fw, alt_tplg_name, bus->dev);
3763                if (!ret)
3764                        goto component_load;
3765
3766                dev_info(bus->dev, "tplg %s failed with %d, falling back to dfw_sst.bin",
3767                         alt_tplg_name, ret);
3768
3769                ret = request_firmware(&fw, "dfw_sst.bin", bus->dev);
3770                if (ret < 0) {
3771                        dev_err(bus->dev, "Fallback tplg fw %s load failed with %d\n",
3772                                        "dfw_sst.bin", ret);
3773                        return ret;
3774                }
3775        }
3776
3777component_load:
3778        ret = snd_soc_tplg_component_load(component, &skl_tplg_ops, fw);
3779        if (ret < 0) {
3780                dev_err(bus->dev, "tplg component load failed%d\n", ret);
3781                goto err;
3782        }
3783
3784        ret = skl_tplg_create_pipe_widget_list(component);
3785        if (ret < 0) {
3786                dev_err(bus->dev, "tplg create pipe widget list failed%d\n",
3787                                ret);
3788                goto err;
3789        }
3790
3791        list_for_each_entry(ppl, &skl->ppl_list, node)
3792                skl_tplg_set_pipe_type(skl, ppl->pipe);
3793
3794err:
3795        release_firmware(fw);
3796        return ret;
3797}
3798
3799void skl_tplg_exit(struct snd_soc_component *component, struct hdac_bus *bus)
3800{
3801        struct skl_dev *skl = bus_to_skl(bus);
3802        struct skl_pipeline *ppl, *tmp;
3803
3804        list_for_each_entry_safe(ppl, tmp, &skl->ppl_list, node)
3805                list_del(&ppl->node);
3806
3807        /* clean up topology */
3808        snd_soc_tplg_component_remove(component);
3809}
3810