1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause) 2 // 3 // This file is provided under a dual BSD/GPLv2 license. When using or 4 // redistributing this file, you may do so under either license. 5 // 6 // Copyright(c) 2021 Intel Corporation. All rights reserved. 7 // 8 // 9 10 #include "sof-priv.h" 11 #include "sof-audio.h" 12 #include "ipc3-priv.h" 13 14 /* IPC set()/get() for kcontrols. */ 15 static int sof_ipc3_set_get_kcontrol_data(struct snd_sof_control *scontrol, 16 bool set, bool lock) 17 { 18 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scontrol->scomp); 19 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 20 const struct sof_ipc_ops *iops = sdev->ipc->ops; 21 enum sof_ipc_ctrl_type ctrl_type; 22 struct snd_sof_widget *swidget; 23 bool widget_found = false; 24 u32 ipc_cmd, msg_bytes; 25 int ret = 0; 26 27 list_for_each_entry(swidget, &sdev->widget_list, list) { 28 if (swidget->comp_id == scontrol->comp_id) { 29 widget_found = true; 30 break; 31 } 32 } 33 34 if (!widget_found) { 35 dev_err(sdev->dev, "%s: can't find widget with id %d\n", __func__, 36 scontrol->comp_id); 37 return -EINVAL; 38 } 39 40 if (lock) 41 mutex_lock(&swidget->setup_mutex); 42 else 43 lockdep_assert_held(&swidget->setup_mutex); 44 45 /* 46 * Volatile controls should always be part of static pipelines and the 47 * widget use_count would always be > 0 in this case. For the others, 48 * just return the cached value if the widget is not set up. 49 */ 50 if (!swidget->use_count) 51 goto unlock; 52 53 /* 54 * Select the IPC cmd and the ctrl_type based on the ctrl_cmd and the 55 * direction 56 * Note: SOF_CTRL_TYPE_VALUE_COMP_* is not used and supported currently 57 * for ctrl_type 58 */ 59 if (cdata->cmd == SOF_CTRL_CMD_BINARY) { 60 ipc_cmd = set ? SOF_IPC_COMP_SET_DATA : SOF_IPC_COMP_GET_DATA; 61 ctrl_type = set ? SOF_CTRL_TYPE_DATA_SET : SOF_CTRL_TYPE_DATA_GET; 62 } else { 63 ipc_cmd = set ? SOF_IPC_COMP_SET_VALUE : SOF_IPC_COMP_GET_VALUE; 64 ctrl_type = set ? SOF_CTRL_TYPE_VALUE_CHAN_SET : SOF_CTRL_TYPE_VALUE_CHAN_GET; 65 } 66 67 cdata->rhdr.hdr.cmd = SOF_IPC_GLB_COMP_MSG | ipc_cmd; 68 cdata->type = ctrl_type; 69 cdata->comp_id = scontrol->comp_id; 70 cdata->msg_index = 0; 71 72 /* calculate header and data size */ 73 switch (cdata->type) { 74 case SOF_CTRL_TYPE_VALUE_CHAN_GET: 75 case SOF_CTRL_TYPE_VALUE_CHAN_SET: 76 cdata->num_elems = scontrol->num_channels; 77 78 msg_bytes = scontrol->num_channels * 79 sizeof(struct sof_ipc_ctrl_value_chan); 80 msg_bytes += sizeof(struct sof_ipc_ctrl_data); 81 break; 82 case SOF_CTRL_TYPE_DATA_GET: 83 case SOF_CTRL_TYPE_DATA_SET: 84 cdata->num_elems = cdata->data->size; 85 86 msg_bytes = cdata->data->size; 87 msg_bytes += sizeof(struct sof_ipc_ctrl_data) + 88 sizeof(struct sof_abi_hdr); 89 break; 90 default: 91 ret = -EINVAL; 92 goto unlock; 93 } 94 95 cdata->rhdr.hdr.size = msg_bytes; 96 cdata->elems_remaining = 0; 97 98 ret = iops->set_get_data(sdev, cdata, cdata->rhdr.hdr.size, set); 99 if (!set) 100 goto unlock; 101 102 /* It is a set-data operation, and we have a backup that we can restore */ 103 if (ret < 0) { 104 if (!scontrol->old_ipc_control_data) 105 goto unlock; 106 /* 107 * Current ipc_control_data is not valid, we use the last known good 108 * configuration 109 */ 110 memcpy(scontrol->ipc_control_data, scontrol->old_ipc_control_data, 111 scontrol->max_size); 112 kfree(scontrol->old_ipc_control_data); 113 scontrol->old_ipc_control_data = NULL; 114 /* Send the last known good configuration to firmware */ 115 ret = iops->set_get_data(sdev, cdata, cdata->rhdr.hdr.size, set); 116 if (ret < 0) 117 goto unlock; 118 } 119 120 unlock: 121 if (lock) 122 mutex_unlock(&swidget->setup_mutex); 123 124 return ret; 125 } 126 127 static void sof_ipc3_refresh_control(struct snd_sof_control *scontrol) 128 { 129 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 130 struct snd_soc_component *scomp = scontrol->scomp; 131 int ret; 132 133 if (!scontrol->comp_data_dirty) 134 return; 135 136 if (!pm_runtime_active(scomp->dev)) 137 return; 138 139 /* set the ABI header values */ 140 cdata->data->magic = SOF_ABI_MAGIC; 141 cdata->data->abi = SOF_ABI_VERSION; 142 143 /* refresh the component data from DSP */ 144 scontrol->comp_data_dirty = false; 145 ret = sof_ipc3_set_get_kcontrol_data(scontrol, false, true); 146 if (ret < 0) { 147 dev_err(scomp->dev, "Failed to get control data: %d\n", ret); 148 149 /* Set the flag to re-try next time to get the data */ 150 scontrol->comp_data_dirty = true; 151 } 152 } 153 154 static int sof_ipc3_volume_get(struct snd_sof_control *scontrol, 155 struct snd_ctl_elem_value *ucontrol) 156 { 157 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 158 unsigned int channels = scontrol->num_channels; 159 unsigned int i; 160 161 sof_ipc3_refresh_control(scontrol); 162 163 /* read back each channel */ 164 for (i = 0; i < channels; i++) 165 ucontrol->value.integer.value[i] = ipc_to_mixer(cdata->chanv[i].value, 166 scontrol->volume_table, 167 scontrol->max + 1); 168 169 return 0; 170 } 171 172 static bool sof_ipc3_volume_put(struct snd_sof_control *scontrol, 173 struct snd_ctl_elem_value *ucontrol) 174 { 175 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 176 struct snd_soc_component *scomp = scontrol->scomp; 177 unsigned int channels = scontrol->num_channels; 178 unsigned int i; 179 bool change = false; 180 181 /* update each channel */ 182 for (i = 0; i < channels; i++) { 183 u32 value = mixer_to_ipc(ucontrol->value.integer.value[i], 184 scontrol->volume_table, scontrol->max + 1); 185 186 change = change || (value != cdata->chanv[i].value); 187 cdata->chanv[i].channel = i; 188 cdata->chanv[i].value = value; 189 } 190 191 /* notify DSP of mixer updates */ 192 if (pm_runtime_active(scomp->dev)) { 193 int ret = sof_ipc3_set_get_kcontrol_data(scontrol, true, true); 194 195 if (ret < 0) { 196 dev_err(scomp->dev, "Failed to set mixer updates for %s\n", 197 scontrol->name); 198 return false; 199 } 200 } 201 202 return change; 203 } 204 205 static int sof_ipc3_switch_get(struct snd_sof_control *scontrol, 206 struct snd_ctl_elem_value *ucontrol) 207 { 208 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 209 unsigned int channels = scontrol->num_channels; 210 unsigned int i; 211 212 sof_ipc3_refresh_control(scontrol); 213 214 /* read back each channel */ 215 for (i = 0; i < channels; i++) 216 ucontrol->value.integer.value[i] = cdata->chanv[i].value; 217 218 return 0; 219 } 220 221 static bool sof_ipc3_switch_put(struct snd_sof_control *scontrol, 222 struct snd_ctl_elem_value *ucontrol) 223 { 224 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 225 struct snd_soc_component *scomp = scontrol->scomp; 226 unsigned int channels = scontrol->num_channels; 227 unsigned int i; 228 bool change = false; 229 u32 value; 230 231 /* update each channel */ 232 for (i = 0; i < channels; i++) { 233 value = ucontrol->value.integer.value[i]; 234 change = change || (value != cdata->chanv[i].value); 235 cdata->chanv[i].channel = i; 236 cdata->chanv[i].value = value; 237 } 238 239 /* notify DSP of mixer updates */ 240 if (pm_runtime_active(scomp->dev)) { 241 int ret = sof_ipc3_set_get_kcontrol_data(scontrol, true, true); 242 243 if (ret < 0) { 244 dev_err(scomp->dev, "Failed to set mixer updates for %s\n", 245 scontrol->name); 246 return false; 247 } 248 } 249 250 return change; 251 } 252 253 static int sof_ipc3_enum_get(struct snd_sof_control *scontrol, 254 struct snd_ctl_elem_value *ucontrol) 255 { 256 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 257 unsigned int channels = scontrol->num_channels; 258 unsigned int i; 259 260 sof_ipc3_refresh_control(scontrol); 261 262 /* read back each channel */ 263 for (i = 0; i < channels; i++) 264 ucontrol->value.enumerated.item[i] = cdata->chanv[i].value; 265 266 return 0; 267 } 268 269 static bool sof_ipc3_enum_put(struct snd_sof_control *scontrol, 270 struct snd_ctl_elem_value *ucontrol) 271 { 272 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 273 struct snd_soc_component *scomp = scontrol->scomp; 274 unsigned int channels = scontrol->num_channels; 275 unsigned int i; 276 bool change = false; 277 u32 value; 278 279 /* update each channel */ 280 for (i = 0; i < channels; i++) { 281 value = ucontrol->value.enumerated.item[i]; 282 change = change || (value != cdata->chanv[i].value); 283 cdata->chanv[i].channel = i; 284 cdata->chanv[i].value = value; 285 } 286 287 /* notify DSP of enum updates */ 288 if (pm_runtime_active(scomp->dev)) { 289 int ret = sof_ipc3_set_get_kcontrol_data(scontrol, true, true); 290 291 if (ret < 0) { 292 dev_err(scomp->dev, "Failed to set enum updates for %s\n", 293 scontrol->name); 294 return false; 295 } 296 } 297 298 return change; 299 } 300 301 static int sof_ipc3_bytes_get(struct snd_sof_control *scontrol, 302 struct snd_ctl_elem_value *ucontrol) 303 { 304 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 305 struct snd_soc_component *scomp = scontrol->scomp; 306 struct sof_abi_hdr *data = cdata->data; 307 size_t size; 308 309 sof_ipc3_refresh_control(scontrol); 310 311 if (scontrol->max_size > sizeof(ucontrol->value.bytes.data)) { 312 dev_err_ratelimited(scomp->dev, "data max %zu exceeds ucontrol data array size\n", 313 scontrol->max_size); 314 return -EINVAL; 315 } 316 317 /* be->max has been verified to be >= sizeof(struct sof_abi_hdr) */ 318 if (data->size > scontrol->max_size - sizeof(*data)) { 319 dev_err_ratelimited(scomp->dev, 320 "%u bytes of control data is invalid, max is %zu\n", 321 data->size, scontrol->max_size - sizeof(*data)); 322 return -EINVAL; 323 } 324 325 size = data->size + sizeof(*data); 326 327 /* copy back to kcontrol */ 328 memcpy(ucontrol->value.bytes.data, data, size); 329 330 return 0; 331 } 332 333 static int sof_ipc3_bytes_put(struct snd_sof_control *scontrol, 334 struct snd_ctl_elem_value *ucontrol) 335 { 336 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 337 struct snd_soc_component *scomp = scontrol->scomp; 338 struct sof_abi_hdr *data = cdata->data; 339 size_t size; 340 341 if (scontrol->max_size > sizeof(ucontrol->value.bytes.data)) { 342 dev_err_ratelimited(scomp->dev, "data max %zu exceeds ucontrol data array size\n", 343 scontrol->max_size); 344 return -EINVAL; 345 } 346 347 /* scontrol->max_size has been verified to be >= sizeof(struct sof_abi_hdr) */ 348 if (data->size > scontrol->max_size - sizeof(*data)) { 349 dev_err_ratelimited(scomp->dev, "data size too big %u bytes max is %zu\n", 350 data->size, scontrol->max_size - sizeof(*data)); 351 return -EINVAL; 352 } 353 354 size = data->size + sizeof(*data); 355 356 /* copy from kcontrol */ 357 memcpy(data, ucontrol->value.bytes.data, size); 358 359 /* notify DSP of byte control updates */ 360 if (pm_runtime_active(scomp->dev)) 361 return sof_ipc3_set_get_kcontrol_data(scontrol, true, true); 362 363 return 0; 364 } 365 366 static int sof_ipc3_bytes_ext_put(struct snd_sof_control *scontrol, 367 const unsigned int __user *binary_data, 368 unsigned int size) 369 { 370 const struct snd_ctl_tlv __user *tlvd = (const struct snd_ctl_tlv __user *)binary_data; 371 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 372 struct snd_soc_component *scomp = scontrol->scomp; 373 struct snd_ctl_tlv header; 374 int ret = -EINVAL; 375 376 /* 377 * The beginning of bytes data contains a header from where 378 * the length (as bytes) is needed to know the correct copy 379 * length of data from tlvd->tlv. 380 */ 381 if (copy_from_user(&header, tlvd, sizeof(struct snd_ctl_tlv))) 382 return -EFAULT; 383 384 /* make sure TLV info is consistent */ 385 if (header.length + sizeof(struct snd_ctl_tlv) > size) { 386 dev_err_ratelimited(scomp->dev, "Inconsistent TLV, data %d + header %zu > %d\n", 387 header.length, sizeof(struct snd_ctl_tlv), size); 388 return -EINVAL; 389 } 390 391 /* be->max is coming from topology */ 392 if (header.length > scontrol->max_size) { 393 dev_err_ratelimited(scomp->dev, "Bytes data size %d exceeds max %zu\n", 394 header.length, scontrol->max_size); 395 return -EINVAL; 396 } 397 398 /* Check that header id matches the command */ 399 if (header.numid != cdata->cmd) { 400 dev_err_ratelimited(scomp->dev, "Incorrect command for bytes put %d\n", 401 header.numid); 402 return -EINVAL; 403 } 404 405 if (!scontrol->old_ipc_control_data) { 406 /* Create a backup of the current, valid bytes control */ 407 scontrol->old_ipc_control_data = kmemdup(scontrol->ipc_control_data, 408 scontrol->max_size, GFP_KERNEL); 409 if (!scontrol->old_ipc_control_data) 410 return -ENOMEM; 411 } 412 413 if (copy_from_user(cdata->data, tlvd->tlv, header.length)) { 414 ret = -EFAULT; 415 goto err_restore; 416 } 417 418 if (cdata->data->magic != SOF_ABI_MAGIC) { 419 dev_err_ratelimited(scomp->dev, "Wrong ABI magic 0x%08x\n", cdata->data->magic); 420 goto err_restore; 421 } 422 423 if (SOF_ABI_VERSION_INCOMPATIBLE(SOF_ABI_VERSION, cdata->data->abi)) { 424 dev_err_ratelimited(scomp->dev, "Incompatible ABI version 0x%08x\n", 425 cdata->data->abi); 426 goto err_restore; 427 } 428 429 /* be->max has been verified to be >= sizeof(struct sof_abi_hdr) */ 430 if (cdata->data->size > scontrol->max_size - sizeof(struct sof_abi_hdr)) { 431 dev_err_ratelimited(scomp->dev, "Mismatch in ABI data size (truncated?)\n"); 432 goto err_restore; 433 } 434 435 /* notify DSP of byte control updates */ 436 if (pm_runtime_active(scomp->dev)) { 437 /* Actually send the data to the DSP; this is an opportunity to validate the data */ 438 return sof_ipc3_set_get_kcontrol_data(scontrol, true, true); 439 } 440 441 return 0; 442 443 err_restore: 444 /* If we have an issue, we restore the old, valid bytes control data */ 445 if (scontrol->old_ipc_control_data) { 446 memcpy(cdata->data, scontrol->old_ipc_control_data, scontrol->max_size); 447 kfree(scontrol->old_ipc_control_data); 448 scontrol->old_ipc_control_data = NULL; 449 } 450 return ret; 451 } 452 453 static int _sof_ipc3_bytes_ext_get(struct snd_sof_control *scontrol, 454 const unsigned int __user *binary_data, 455 unsigned int size, bool from_dsp) 456 { 457 struct snd_ctl_tlv __user *tlvd = (struct snd_ctl_tlv __user *)binary_data; 458 struct sof_ipc_ctrl_data *cdata = scontrol->ipc_control_data; 459 struct snd_soc_component *scomp = scontrol->scomp; 460 struct snd_ctl_tlv header; 461 size_t data_size; 462 463 /* 464 * Decrement the limit by ext bytes header size to 465 * ensure the user space buffer is not exceeded. 466 */ 467 if (size < sizeof(struct snd_ctl_tlv)) 468 return -ENOSPC; 469 470 size -= sizeof(struct snd_ctl_tlv); 471 472 /* set the ABI header values */ 473 cdata->data->magic = SOF_ABI_MAGIC; 474 cdata->data->abi = SOF_ABI_VERSION; 475 476 /* get all the component data from DSP */ 477 if (from_dsp) { 478 int ret = sof_ipc3_set_get_kcontrol_data(scontrol, false, true); 479 480 if (ret < 0) 481 return ret; 482 } 483 484 /* check data size doesn't exceed max coming from topology */ 485 if (cdata->data->size > scontrol->max_size - sizeof(struct sof_abi_hdr)) { 486 dev_err_ratelimited(scomp->dev, "User data size %d exceeds max size %zu\n", 487 cdata->data->size, 488 scontrol->max_size - sizeof(struct sof_abi_hdr)); 489 return -EINVAL; 490 } 491 492 data_size = cdata->data->size + sizeof(struct sof_abi_hdr); 493 494 /* make sure we don't exceed size provided by user space for data */ 495 if (data_size > size) 496 return -ENOSPC; 497 498 header.numid = cdata->cmd; 499 header.length = data_size; 500 if (copy_to_user(tlvd, &header, sizeof(struct snd_ctl_tlv))) 501 return -EFAULT; 502 503 if (copy_to_user(tlvd->tlv, cdata->data, data_size)) 504 return -EFAULT; 505 506 return 0; 507 } 508 509 static int sof_ipc3_bytes_ext_get(struct snd_sof_control *scontrol, 510 const unsigned int __user *binary_data, unsigned int size) 511 { 512 return _sof_ipc3_bytes_ext_get(scontrol, binary_data, size, false); 513 } 514 515 static int sof_ipc3_bytes_ext_volatile_get(struct snd_sof_control *scontrol, 516 const unsigned int __user *binary_data, 517 unsigned int size) 518 { 519 return _sof_ipc3_bytes_ext_get(scontrol, binary_data, size, true); 520 } 521 522 static void snd_sof_update_control(struct snd_sof_control *scontrol, 523 struct sof_ipc_ctrl_data *cdata) 524 { 525 struct snd_soc_component *scomp = scontrol->scomp; 526 struct sof_ipc_ctrl_data *local_cdata; 527 int i; 528 529 local_cdata = scontrol->ipc_control_data; 530 531 if (cdata->cmd == SOF_CTRL_CMD_BINARY) { 532 if (cdata->num_elems != local_cdata->data->size) { 533 dev_err(scomp->dev, "cdata binary size mismatch %u - %u\n", 534 cdata->num_elems, local_cdata->data->size); 535 return; 536 } 537 538 /* copy the new binary data */ 539 memcpy(local_cdata->data, cdata->data, cdata->num_elems); 540 } else if (cdata->num_elems != scontrol->num_channels) { 541 dev_err(scomp->dev, "cdata channel count mismatch %u - %d\n", 542 cdata->num_elems, scontrol->num_channels); 543 } else { 544 /* copy the new values */ 545 for (i = 0; i < cdata->num_elems; i++) 546 local_cdata->chanv[i].value = cdata->chanv[i].value; 547 } 548 } 549 550 static void sof_ipc3_control_update(struct snd_sof_dev *sdev, void *ipc_control_message) 551 { 552 struct sof_ipc_ctrl_data *cdata = ipc_control_message; 553 struct snd_soc_dapm_widget *widget; 554 struct snd_sof_control *scontrol; 555 struct snd_sof_widget *swidget; 556 struct snd_kcontrol *kc = NULL; 557 struct soc_mixer_control *sm; 558 struct soc_bytes_ext *be; 559 size_t expected_size; 560 struct soc_enum *se; 561 bool found = false; 562 int i, type; 563 564 if (cdata->type == SOF_CTRL_TYPE_VALUE_COMP_GET || 565 cdata->type == SOF_CTRL_TYPE_VALUE_COMP_SET) { 566 dev_err(sdev->dev, "Component data is not supported in control notification\n"); 567 return; 568 } 569 570 /* Find the swidget first */ 571 list_for_each_entry(swidget, &sdev->widget_list, list) { 572 if (swidget->comp_id == cdata->comp_id) { 573 found = true; 574 break; 575 } 576 } 577 578 if (!found) 579 return; 580 581 /* Translate SOF cmd to TPLG type */ 582 switch (cdata->cmd) { 583 case SOF_CTRL_CMD_VOLUME: 584 case SOF_CTRL_CMD_SWITCH: 585 type = SND_SOC_TPLG_TYPE_MIXER; 586 break; 587 case SOF_CTRL_CMD_BINARY: 588 type = SND_SOC_TPLG_TYPE_BYTES; 589 break; 590 case SOF_CTRL_CMD_ENUM: 591 type = SND_SOC_TPLG_TYPE_ENUM; 592 break; 593 default: 594 dev_err(sdev->dev, "Unknown cmd %u in %s\n", cdata->cmd, __func__); 595 return; 596 } 597 598 widget = swidget->widget; 599 for (i = 0; i < widget->num_kcontrols; i++) { 600 /* skip non matching types or non matching indexes within type */ 601 if (widget->dobj.widget.kcontrol_type[i] == type && 602 widget->kcontrol_news[i].index == cdata->index) { 603 kc = widget->kcontrols[i]; 604 break; 605 } 606 } 607 608 if (!kc) 609 return; 610 611 switch (cdata->cmd) { 612 case SOF_CTRL_CMD_VOLUME: 613 case SOF_CTRL_CMD_SWITCH: 614 sm = (struct soc_mixer_control *)kc->private_value; 615 scontrol = sm->dobj.private; 616 break; 617 case SOF_CTRL_CMD_BINARY: 618 be = (struct soc_bytes_ext *)kc->private_value; 619 scontrol = be->dobj.private; 620 break; 621 case SOF_CTRL_CMD_ENUM: 622 se = (struct soc_enum *)kc->private_value; 623 scontrol = se->dobj.private; 624 break; 625 default: 626 return; 627 } 628 629 expected_size = sizeof(struct sof_ipc_ctrl_data); 630 switch (cdata->type) { 631 case SOF_CTRL_TYPE_VALUE_CHAN_GET: 632 case SOF_CTRL_TYPE_VALUE_CHAN_SET: 633 expected_size += cdata->num_elems * 634 sizeof(struct sof_ipc_ctrl_value_chan); 635 break; 636 case SOF_CTRL_TYPE_DATA_GET: 637 case SOF_CTRL_TYPE_DATA_SET: 638 expected_size += cdata->num_elems + sizeof(struct sof_abi_hdr); 639 break; 640 default: 641 return; 642 } 643 644 if (cdata->rhdr.hdr.size != expected_size) { 645 dev_err(sdev->dev, "Component notification size mismatch\n"); 646 return; 647 } 648 649 if (cdata->num_elems) 650 /* 651 * The message includes the updated value/data, update the 652 * control's local cache using the received notification 653 */ 654 snd_sof_update_control(scontrol, cdata); 655 else 656 /* Mark the scontrol that the value/data is changed in SOF */ 657 scontrol->comp_data_dirty = true; 658 659 snd_ctl_notify_one(swidget->scomp->card->snd_card, SNDRV_CTL_EVENT_MASK_VALUE, kc, 0); 660 } 661 662 static int sof_ipc3_widget_kcontrol_setup(struct snd_sof_dev *sdev, 663 struct snd_sof_widget *swidget) 664 { 665 struct snd_sof_control *scontrol; 666 int ret; 667 668 /* set up all controls for the widget */ 669 list_for_each_entry(scontrol, &sdev->kcontrol_list, list) 670 if (scontrol->comp_id == swidget->comp_id) { 671 /* set kcontrol data in DSP */ 672 ret = sof_ipc3_set_get_kcontrol_data(scontrol, true, false); 673 if (ret < 0) { 674 dev_err(sdev->dev, 675 "kcontrol %d set up failed for widget %s\n", 676 scontrol->comp_id, swidget->widget->name); 677 return ret; 678 } 679 680 /* 681 * Read back the data from the DSP for static widgets. 682 * This is particularly useful for binary kcontrols 683 * associated with static pipeline widgets to initialize 684 * the data size to match that in the DSP. 685 */ 686 if (swidget->dynamic_pipeline_widget) 687 continue; 688 689 ret = sof_ipc3_set_get_kcontrol_data(scontrol, false, false); 690 if (ret < 0) 691 dev_warn(sdev->dev, 692 "kcontrol %d read failed for widget %s\n", 693 scontrol->comp_id, swidget->widget->name); 694 } 695 696 return 0; 697 } 698 699 static int 700 sof_ipc3_set_up_volume_table(struct snd_sof_control *scontrol, int tlv[SOF_TLV_ITEMS], int size) 701 { 702 int i; 703 704 /* init the volume table */ 705 scontrol->volume_table = kcalloc(size, sizeof(u32), GFP_KERNEL); 706 if (!scontrol->volume_table) 707 return -ENOMEM; 708 709 /* populate the volume table */ 710 for (i = 0; i < size ; i++) 711 scontrol->volume_table[i] = vol_compute_gain(i, tlv); 712 713 return 0; 714 } 715 716 const struct sof_ipc_tplg_control_ops tplg_ipc3_control_ops = { 717 .volume_put = sof_ipc3_volume_put, 718 .volume_get = sof_ipc3_volume_get, 719 .switch_put = sof_ipc3_switch_put, 720 .switch_get = sof_ipc3_switch_get, 721 .enum_put = sof_ipc3_enum_put, 722 .enum_get = sof_ipc3_enum_get, 723 .bytes_put = sof_ipc3_bytes_put, 724 .bytes_get = sof_ipc3_bytes_get, 725 .bytes_ext_put = sof_ipc3_bytes_ext_put, 726 .bytes_ext_get = sof_ipc3_bytes_ext_get, 727 .bytes_ext_volatile_get = sof_ipc3_bytes_ext_volatile_get, 728 .update = sof_ipc3_control_update, 729 .widget_kcontrol_setup = sof_ipc3_widget_kcontrol_setup, 730 .set_up_volume_table = sof_ipc3_set_up_volume_table, 731 }; 732