Lines Matching +full:3 +full:- +full:tuples
1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
18 #include "sof-priv.h"
19 #include "sof-audio.h"
25 * from dB gain 20th root of 10 in Q1.16 fixed-point notation
28 /* 40th root of 10 in Q1.16 fixed-point notation*/
40 * sof_update_ipc_object - Parse multiple sets of tokens within the token array associated with the
45 * @tuples: pointer to the tuples array
46 * @num_tuples: number of tuples in the tuples array
53 struct snd_sof_tuple *tuples, int num_tuples, in sof_update_ipc_object() argument
62 token_list = tplg_ops ? tplg_ops->token_list : NULL; in sof_update_ipc_object()
68 dev_err(scomp->dev, "Invalid token count for token ID: %d\n", token_id); in sof_update_ipc_object()
69 return -EINVAL; in sof_update_ipc_object()
78 dev_err(scomp->dev, "Invalid tokens for token id: %d\n", token_id); in sof_update_ipc_object()
79 return -EINVAL; in sof_update_ipc_object()
87 if (tokens[i].token == tuples[j].token) { in sof_update_ipc_object()
94 *val = tuples[j].value.v; in sof_update_ipc_object()
103 *val = (u16)tuples[j].value.v; in sof_update_ipc_object()
109 dev_err(scomp->dev, in sof_update_ipc_object()
112 return -EINVAL; in sof_update_ipc_object()
115 tokens[i].get_token((void *)tuples[j].value.s, object, in sof_update_ipc_object()
142 return -EINVAL; in get_tlv_data()
162 * Function to truncate an unsigned 64-bit number
163 * by x bits and return 32-bit unsigned number. This
175 return (u32)(((i >> (x - 1)) + 1) >> 1); in vol_shift_64()
180 * a is a fractional number represented by a fixed-point
185 * fixed-point integer with a fractional word length of "fwl"
199 iter = exp * -1; in vol_pow32()
206 * Product of 2 Qx.fwl fixed-point numbers yields a Q2*x.2*fwl in vol_pow32()
245 * compute linear gain represented by fixed-point in vol_compute_gain()
251 f_step = tlv[TLV_STEP] - (tlv[TLV_STEP] / 100); in vol_compute_gain()
269 struct snd_soc_component *scomp = scontrol->scomp; in set_up_volume_table()
273 if (tplg_ops && tplg_ops->control && tplg_ops->control->set_up_volume_table) in set_up_volume_table()
274 return tplg_ops->control->set_up_volume_table(scontrol, tlv, size); in set_up_volume_table()
276 dev_err(scomp->dev, "Mandatory op %s not set\n", __func__); in set_up_volume_table()
277 return -EINVAL; in set_up_volume_table()
350 *val = le32_to_cpu(velem->value); in get_token_u32()
359 *val = (u16)le32_to_cpu(velem->value); in get_token_u16()
368 memcpy(dst, velem->uuid, UUID_SIZE); in get_token_uuid()
384 return -ENOMEM; in get_token_string()
442 * sof_parse_uuid_tokens - Parse multiple sets of UUID tokens
462 for (i = 0; i < le32_to_cpu(array->num_elems); i++) { in sof_parse_uuid_tokens()
463 elem = &array->uuid[i]; in sof_parse_uuid_tokens()
472 if (tokens[j].token != le32_to_cpu(elem->token)) in sof_parse_uuid_tokens()
475 /* matched - now load token */ in sof_parse_uuid_tokens()
487 * sof_copy_tuples - Parse tokens and copy them to the @tuples array
495 * @tuples: tuples array to copy the matched tuples to
496 * @tuples_size: size of @tuples
497 * @num_copied_tuples: pointer to the number of copied tuples in the tuples array
502 struct snd_sof_tuple *tuples, int tuples_size, int *num_copied_tuples) in sof_copy_tuples() argument
511 token_list = tplg_ops ? tplg_ops->token_list : NULL; in sof_copy_tuples()
516 if (!tuples || !num_copied_tuples) { in sof_copy_tuples()
517 dev_err(sdev->dev, "Invalid tuples array\n"); in sof_copy_tuples()
518 return -EINVAL; in sof_copy_tuples()
525 dev_err(sdev->dev, "No token array defined for token ID: %d\n", token_id); in sof_copy_tuples()
526 return -EINVAL; in sof_copy_tuples()
529 /* check if there's space in the tuples array for new tokens */ in sof_copy_tuples()
531 dev_err(sdev->dev, "No space in tuples array for new tokens from %s", in sof_copy_tuples()
533 return -EINVAL; in sof_copy_tuples()
537 asize = le32_to_cpu(array->size); in sof_copy_tuples()
541 dev_err(sdev->dev, "Invalid array size 0x%x\n", asize); in sof_copy_tuples()
542 return -EINVAL; in sof_copy_tuples()
546 array_size -= asize; in sof_copy_tuples()
548 dev_err(sdev->dev, "Invalid array size 0x%x\n", asize); in sof_copy_tuples()
549 return -EINVAL; in sof_copy_tuples()
553 for (i = 0; i < le32_to_cpu(array->num_elems); i++) { in sof_copy_tuples()
567 elem = &array->string[i]; in sof_copy_tuples()
570 if (tokens[j].token != le32_to_cpu(elem->token)) in sof_copy_tuples()
573 tuples[*num_copied_tuples].token = tokens[j].token; in sof_copy_tuples()
574 tuples[*num_copied_tuples].value.s = elem->string; in sof_copy_tuples()
578 elem = &array->value[i]; in sof_copy_tuples()
581 if (tokens[j].token != le32_to_cpu(elem->token)) in sof_copy_tuples()
584 tuples[*num_copied_tuples].token = tokens[j].token; in sof_copy_tuples()
585 tuples[*num_copied_tuples].value.v = in sof_copy_tuples()
586 le32_to_cpu(elem->value); in sof_copy_tuples()
591 /* stop if there's no space for any more new tuples */ in sof_copy_tuples()
609 * sof_parse_string_tokens - Parse multiple sets of tokens
629 for (i = 0; i < le32_to_cpu(array->num_elems); i++) { in sof_parse_string_tokens()
630 elem = &array->string[i]; in sof_parse_string_tokens()
639 if (tokens[j].token != le32_to_cpu(elem->token)) in sof_parse_string_tokens()
642 /* matched - now load token */ in sof_parse_string_tokens()
643 ret = tokens[j].get_token(elem->string, object, offset + tokens[j].offset); in sof_parse_string_tokens()
655 * sof_parse_word_tokens - Parse multiple sets of tokens
675 for (i = 0; i < le32_to_cpu(array->num_elems); i++) { in sof_parse_word_tokens()
676 elem = &array->value[i]; in sof_parse_word_tokens()
688 if (tokens[j].token != le32_to_cpu(elem->token)) in sof_parse_word_tokens()
702 * sof_parse_token_sets - Parse multiple sets of tokens
728 asize = le32_to_cpu(array->size); in sof_parse_token_sets()
731 if (asize < 0) { /* FIXME: A zero-size array makes no sense */ in sof_parse_token_sets()
732 dev_err(scomp->dev, "error: invalid array size 0x%x\n", in sof_parse_token_sets()
734 return -EINVAL; in sof_parse_token_sets()
738 array_size -= asize; in sof_parse_token_sets()
740 dev_err(scomp->dev, "error: invalid array size 0x%x\n", in sof_parse_token_sets()
742 return -EINVAL; in sof_parse_token_sets()
746 switch (le32_to_cpu(array->type)) { in sof_parse_token_sets()
756 dev_err(scomp->dev, "error: no memory to copy string token\n"); in sof_parse_token_sets()
770 dev_err(scomp->dev, "error: unknown token type %d\n", in sof_parse_token_sets()
771 array->type); in sof_parse_token_sets()
772 return -EINVAL; in sof_parse_token_sets()
791 * sof_parse_tokens - Parse one set of tokens
810 * identical tuples arrays. So additional parameters to in sof_parse_tokens()
835 if (le32_to_cpu(mc->num_channels) > SND_SOC_TPLG_MAX_CHAN) in sof_control_load_volume()
836 return -EINVAL; in sof_control_load_volume()
841 * pre-defined dapm control types (and related functions) creating the actual control in sof_control_load_volume()
844 if (le32_to_cpu(mc->num_channels) > 2) in sof_control_load_volume()
845 kc->info = snd_sof_volume_info; in sof_control_load_volume()
847 scontrol->comp_id = sdev->next_comp_id; in sof_control_load_volume()
848 scontrol->min_volume_step = le32_to_cpu(mc->min); in sof_control_load_volume()
849 scontrol->max_volume_step = le32_to_cpu(mc->max); in sof_control_load_volume()
850 scontrol->num_channels = le32_to_cpu(mc->num_channels); in sof_control_load_volume()
852 scontrol->max = le32_to_cpu(mc->max); in sof_control_load_volume()
853 if (le32_to_cpu(mc->max) == 1) in sof_control_load_volume()
857 if (!kc->tlv.p || get_tlv_data(kc->tlv.p, tlv) < 0) { in sof_control_load_volume()
858 dev_err(scomp->dev, "error: invalid TLV data\n"); in sof_control_load_volume()
859 return -EINVAL; in sof_control_load_volume()
863 ret = set_up_volume_table(scontrol, tlv, le32_to_cpu(mc->max) + 1); in sof_control_load_volume()
865 dev_err(scomp->dev, "error: setting up volume table\n"); in sof_control_load_volume()
871 ret = sof_parse_tokens(scomp, &scontrol->led_ctl, led_tokens, in sof_control_load_volume()
872 ARRAY_SIZE(led_tokens), mc->priv.array, in sof_control_load_volume()
873 le32_to_cpu(mc->priv.size)); in sof_control_load_volume()
875 dev_err(scomp->dev, "error: parse led tokens failed %d\n", in sof_control_load_volume()
876 le32_to_cpu(mc->priv.size)); in sof_control_load_volume()
880 if (scontrol->led_ctl.use_led) { in sof_control_load_volume()
881 mask = scontrol->led_ctl.direction ? SNDRV_CTL_ELEM_ACCESS_MIC_LED : in sof_control_load_volume()
883 scontrol->access &= ~SNDRV_CTL_ELEM_ACCESS_LED_MASK; in sof_control_load_volume()
884 scontrol->access |= mask; in sof_control_load_volume()
885 kc->access &= ~SNDRV_CTL_ELEM_ACCESS_LED_MASK; in sof_control_load_volume()
886 kc->access |= mask; in sof_control_load_volume()
887 sdev->led_present = true; in sof_control_load_volume()
890 dev_dbg(scomp->dev, "tplg: load kcontrol index %d chans %d\n", in sof_control_load_volume()
891 scontrol->comp_id, scontrol->num_channels); in sof_control_load_volume()
896 if (le32_to_cpu(mc->max) > 1) in sof_control_load_volume()
897 kfree(scontrol->volume_table); in sof_control_load_volume()
912 if (le32_to_cpu(ec->num_channels) > SND_SOC_TPLG_MAX_CHAN) in sof_control_load_enum()
913 return -EINVAL; in sof_control_load_enum()
915 scontrol->comp_id = sdev->next_comp_id; in sof_control_load_enum()
916 scontrol->num_channels = le32_to_cpu(ec->num_channels); in sof_control_load_enum()
918 dev_dbg(scomp->dev, "tplg: load kcontrol index %d chans %d comp_id %d\n", in sof_control_load_enum()
919 scontrol->comp_id, scontrol->num_channels, scontrol->comp_id); in sof_control_load_enum()
932 struct soc_bytes_ext *sbe = (struct soc_bytes_ext *)kc->private_value; in sof_control_load_bytes()
933 size_t priv_size = le32_to_cpu(control->priv.size); in sof_control_load_bytes()
935 scontrol->max_size = sbe->max; in sof_control_load_bytes()
936 scontrol->comp_id = sdev->next_comp_id; in sof_control_load_bytes()
938 dev_dbg(scomp->dev, "tplg: load kcontrol index %d\n", scontrol->comp_id); in sof_control_load_bytes()
942 scontrol->priv = kmemdup(control->priv.data, priv_size, GFP_KERNEL); in sof_control_load_bytes()
943 if (!scontrol->priv) in sof_control_load_bytes()
944 return -ENOMEM; in sof_control_load_bytes()
946 scontrol->priv_size = priv_size; in sof_control_load_bytes()
952 /* external kcontrol init - used for any driver specific init */
965 dev_dbg(scomp->dev, "tplg: load control type %d name : %s\n", in sof_control_load()
966 hdr->type, hdr->name); in sof_control_load()
970 return -ENOMEM; in sof_control_load()
972 scontrol->name = kstrdup(hdr->name, GFP_KERNEL); in sof_control_load()
973 if (!scontrol->name) { in sof_control_load()
975 return -ENOMEM; in sof_control_load()
978 scontrol->scomp = scomp; in sof_control_load()
979 scontrol->access = kc->access; in sof_control_load()
980 scontrol->info_type = le32_to_cpu(hdr->ops.info); in sof_control_load()
981 scontrol->index = kc->index; in sof_control_load()
983 switch (le32_to_cpu(hdr->ops.info)) { in sof_control_load()
987 sm = (struct soc_mixer_control *)kc->private_value; in sof_control_load()
988 dobj = &sm->dobj; in sof_control_load()
992 sbe = (struct soc_bytes_ext *)kc->private_value; in sof_control_load()
993 dobj = &sbe->dobj; in sof_control_load()
998 se = (struct soc_enum *)kc->private_value; in sof_control_load()
999 dobj = &se->dobj; in sof_control_load()
1010 dev_warn(scomp->dev, "control type not supported %d:%d:%d\n", in sof_control_load()
1011 hdr->ops.get, hdr->ops.put, hdr->ops.info); in sof_control_load()
1012 kfree(scontrol->name); in sof_control_load()
1018 kfree(scontrol->name); in sof_control_load()
1023 scontrol->led_ctl.led_value = -1; in sof_control_load()
1025 dobj->private = scontrol; in sof_control_load()
1026 list_add(&scontrol->list, &sdev->kcontrol_list); in sof_control_load()
1035 struct snd_sof_control *scontrol = dobj->private; in sof_control_unload()
1038 dev_dbg(scomp->dev, "tplg: unload control name : %s\n", scontrol->name); in sof_control_unload()
1040 if (tplg_ops && tplg_ops->control_free) { in sof_control_unload()
1041 ret = tplg_ops->control_free(sdev, scontrol); in sof_control_unload()
1043 dev_err(scomp->dev, "failed to free control: %s\n", scontrol->name); in sof_control_unload()
1047 kfree(scontrol->ipc_control_data); in sof_control_unload()
1048 kfree(scontrol->priv); in sof_control_unload()
1049 kfree(scontrol->name); in sof_control_unload()
1050 list_del(&scontrol->list); in sof_control_unload()
1065 struct snd_soc_card *card = scomp->card; in sof_connect_dai_widget()
1071 if (!w->sname) { in sof_connect_dai_widget()
1072 dev_err(scomp->dev, "Widget %s does not have stream\n", w->name); in sof_connect_dai_widget()
1073 return -EINVAL; in sof_connect_dai_widget()
1076 if (w->id == snd_soc_dapm_dai_out) in sof_connect_dai_widget()
1078 else if (w->id == snd_soc_dapm_dai_in) in sof_connect_dai_widget()
1085 list_for_each_entry(rtd, &card->rtd_list, list) { in sof_connect_dai_widget()
1087 if (rtd->dai_link->stream_name) { in sof_connect_dai_widget()
1088 if (!strcmp(rtd->dai_link->stream_name, w->sname)) { in sof_connect_dai_widget()
1091 } else if (strstr(rtd->dai_link->stream_name, w->sname)) { in sof_connect_dai_widget()
1110 if (i == rtd->dai_link->num_cpus) { in sof_connect_dai_widget()
1111 dev_err(scomp->dev, "error: can't find BE for DAI %s\n", w->name); in sof_connect_dai_widget()
1113 return -EINVAL; in sof_connect_dai_widget()
1116 dai->name = rtd->dai_link->name; in sof_connect_dai_widget()
1117 dev_dbg(scomp->dev, "tplg: connected widget %s -> DAI link %s\n", in sof_connect_dai_widget()
1118 w->name, rtd->dai_link->name); in sof_connect_dai_widget()
1122 if (!dai->name) { in sof_connect_dai_widget()
1123 dev_err(scomp->dev, "error: can't connect DAI %s stream %s\n", in sof_connect_dai_widget()
1124 w->name, w->sname); in sof_connect_dai_widget()
1125 return -EINVAL; in sof_connect_dai_widget()
1134 struct snd_soc_card *card = scomp->card; in sof_disconnect_dai_widget()
1136 const char *sname = w->sname; in sof_disconnect_dai_widget()
1143 if (w->id == snd_soc_dapm_dai_out) in sof_disconnect_dai_widget()
1145 else if (w->id == snd_soc_dapm_dai_in) in sof_disconnect_dai_widget()
1150 list_for_each_entry(rtd, &card->rtd_list, list) { in sof_disconnect_dai_widget()
1152 if (!rtd->dai_link->stream_name || in sof_disconnect_dai_widget()
1153 !strstr(rtd->dai_link->stream_name, sname)) in sof_disconnect_dai_widget()
1171 if (sdev->dspless_mode_selected) in spcm_bind()
1175 spcm->pcm.caps[dir].name, in spcm_bind()
1178 dev_err(scomp->dev, "can't find host comp to bind pcm\n"); in spcm_bind()
1179 return -EINVAL; in spcm_bind()
1182 spcm->stream[dir].comp_id = host_widget->comp_id; in spcm_bind()
1187 static int sof_get_token_value(u32 token_id, struct snd_sof_tuple *tuples, int num_tuples) in sof_get_token_value() argument
1191 if (!tuples) in sof_get_token_value()
1192 return -EINVAL; in sof_get_token_value()
1195 if (tuples[i].token == token_id) in sof_get_token_value()
1196 return tuples[i].value.v; in sof_get_token_value()
1199 return -EINVAL; in sof_get_token_value()
1208 struct snd_soc_tplg_private *private = &tw->priv; in sof_widget_parse_tokens()
1213 token_list = tplg_ops ? tplg_ops->token_list : NULL; in sof_widget_parse_tokens()
1219 dev_err(scomp->dev, "No token list for widget %s\n", swidget->widget->name); in sof_widget_parse_tokens()
1220 return -EINVAL; in sof_widget_parse_tokens()
1223 /* calculate max size of tuples array */ in sof_widget_parse_tokens()
1227 /* allocate memory for tuples array */ in sof_widget_parse_tokens()
1228 swidget->tuples = kcalloc(num_tuples, sizeof(*swidget->tuples), GFP_KERNEL); in sof_widget_parse_tokens()
1229 if (!swidget->tuples) in sof_widget_parse_tokens()
1230 return -ENOMEM; in sof_widget_parse_tokens()
1237 dev_err(scomp->dev, "Invalid token id %d for widget %s\n", in sof_widget_parse_tokens()
1238 object_token_list[i], swidget->widget->name); in sof_widget_parse_tokens()
1239 ret = -EINVAL; in sof_widget_parse_tokens()
1249 private->array, le32_to_cpu(private->size)); in sof_widget_parse_tokens()
1251 dev_err(scomp->dev, "Failed parsing %s for widget %s\n", in sof_widget_parse_tokens()
1253 swidget->widget->name); in sof_widget_parse_tokens()
1260 swidget->tuples, swidget->num_tuples); in sof_widget_parse_tokens()
1262 dev_err(sdev->dev, "Invalid input audio format count for %s\n", in sof_widget_parse_tokens()
1263 swidget->widget->name); in sof_widget_parse_tokens()
1270 swidget->tuples, swidget->num_tuples); in sof_widget_parse_tokens()
1272 dev_err(sdev->dev, "Invalid output audio format count for %s\n", in sof_widget_parse_tokens()
1273 swidget->widget->name); in sof_widget_parse_tokens()
1285 num_tuples += token_list[object_token_list[i]].count * (num_sets - 1); in sof_widget_parse_tokens()
1286 new_tuples = krealloc_array(swidget->tuples, in sof_widget_parse_tokens()
1289 ret = -ENOMEM; in sof_widget_parse_tokens()
1293 swidget->tuples = new_tuples; in sof_widget_parse_tokens()
1296 /* copy one set of tuples per token ID into swidget->tuples */ in sof_widget_parse_tokens()
1297 ret = sof_copy_tuples(sdev, private->array, le32_to_cpu(private->size), in sof_widget_parse_tokens()
1298 object_token_list[i], num_sets, swidget->tuples, in sof_widget_parse_tokens()
1299 num_tuples, &swidget->num_tuples); in sof_widget_parse_tokens()
1301 dev_err(scomp->dev, "Failed parsing %s for widget %s err: %d\n", in sof_widget_parse_tokens()
1302 token_list[object_token_list[i]].name, swidget->widget->name, ret); in sof_widget_parse_tokens()
1309 kfree(swidget->tuples); in sof_widget_parse_tokens()
1321 pin_binding = swidget->input_pin_binding; in sof_free_pin_binding()
1322 num_pins = swidget->num_input_pins; in sof_free_pin_binding()
1324 pin_binding = swidget->output_pin_binding; in sof_free_pin_binding()
1325 num_pins = swidget->num_output_pins; in sof_free_pin_binding()
1348 num_pins = swidget->num_input_pins; in sof_parse_pin_binding()
1352 num_pins = swidget->num_output_pins; in sof_parse_pin_binding()
1358 ret = sof_parse_token_sets(swidget->scomp, pin_binding, pin_binding_token, in sof_parse_pin_binding()
1359 token_count, priv->array, le32_to_cpu(priv->size), in sof_parse_pin_binding()
1368 ret = -ENOMEM; in sof_parse_pin_binding()
1372 swidget->input_pin_binding = pb; in sof_parse_pin_binding()
1374 swidget->output_pin_binding = pb; in sof_parse_pin_binding()
1391 w->no_wname_in_kcontrol_name = !!le32_to_cpu(velem->value); in get_w_no_wname_in_long_name()
1400 /* external widget init - used for any driver specific init */
1408 struct snd_soc_tplg_private *priv = &tw->priv; in sof_widget_ready()
1417 return -ENOMEM; in sof_widget_ready()
1419 swidget->scomp = scomp; in sof_widget_ready()
1420 swidget->widget = w; in sof_widget_ready()
1421 swidget->comp_id = sdev->next_comp_id++; in sof_widget_ready()
1422 swidget->id = w->id; in sof_widget_ready()
1423 swidget->pipeline_id = index; in sof_widget_ready()
1424 swidget->private = NULL; in sof_widget_ready()
1425 mutex_init(&swidget->setup_mutex); in sof_widget_ready()
1427 ida_init(&swidget->output_queue_ida); in sof_widget_ready()
1428 ida_init(&swidget->input_queue_ida); in sof_widget_ready()
1431 priv->array, le32_to_cpu(priv->size)); in sof_widget_ready()
1433 dev_err(scomp->dev, "failed to parse dapm widget tokens for %s\n", in sof_widget_ready()
1434 w->name); in sof_widget_ready()
1439 ARRAY_SIZE(comp_pin_tokens), priv->array, in sof_widget_ready()
1440 le32_to_cpu(priv->size)); in sof_widget_ready()
1442 dev_err(scomp->dev, "failed to parse component pin tokens for %s\n", in sof_widget_ready()
1443 w->name); in sof_widget_ready()
1447 if (swidget->num_input_pins > SOF_WIDGET_MAX_NUM_PINS || in sof_widget_ready()
1448 swidget->num_output_pins > SOF_WIDGET_MAX_NUM_PINS) { in sof_widget_ready()
1449 dev_err(scomp->dev, "invalid pins for %s: [input: %d, output: %d]\n", in sof_widget_ready()
1450 swidget->widget->name, swidget->num_input_pins, swidget->num_output_pins); in sof_widget_ready()
1451 ret = -EINVAL; in sof_widget_ready()
1455 if (swidget->num_input_pins > 1) { in sof_widget_ready()
1459 dev_err(scomp->dev, "failed to parse input pin binding for %s\n", in sof_widget_ready()
1460 w->name); in sof_widget_ready()
1465 if (swidget->num_output_pins > 1) { in sof_widget_ready()
1469 dev_err(scomp->dev, "failed to parse output pin binding for %s\n", in sof_widget_ready()
1470 w->name); in sof_widget_ready()
1475 dev_dbg(scomp->dev, in sof_widget_ready()
1477 swidget->comp_id, w->name, swidget->id, index, in sof_widget_ready()
1478 swidget->num_input_pins, swidget->num_output_pins, in sof_widget_ready()
1479 strnlen(w->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) > 0 ? w->sname : "none"); in sof_widget_ready()
1481 widget_ops = tplg_ops ? tplg_ops->widget : NULL; in sof_widget_ready()
1483 token_list = widget_ops[w->id].token_list; in sof_widget_ready()
1484 token_list_size = widget_ops[w->id].token_list_size; in sof_widget_ready()
1488 switch (w->id) { in sof_widget_ready()
1493 ret = -ENOMEM; in sof_widget_ready()
1504 list_add(&dai->list, &sdev->dai_list); in sof_widget_ready()
1505 swidget->private = dai; in sof_widget_ready()
1508 /* check we have some tokens - we need at least process type */ in sof_widget_ready()
1509 if (le32_to_cpu(tw->priv.size) == 0) { in sof_widget_ready()
1510 dev_err(scomp->dev, "error: process tokens not found\n"); in sof_widget_ready()
1511 ret = -EINVAL; in sof_widget_ready()
1517 if (!le32_to_cpu(tw->num_kcontrols)) { in sof_widget_ready()
1518 dev_err(scomp->dev, "invalid kcontrol count %d for volume\n", in sof_widget_ready()
1519 tw->num_kcontrols); in sof_widget_ready()
1520 ret = -EINVAL; in sof_widget_ready()
1541 dev_dbg(scomp->dev, "widget type %d name %s not handled\n", swidget->id, tw->name); in sof_widget_ready()
1547 dev_err(scomp->dev, in sof_widget_ready()
1549 swidget->id, tw->name, strnlen(tw->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) > 0 in sof_widget_ready()
1550 ? tw->sname : "none"); in sof_widget_ready()
1555 swidget->core = SOF_DSP_PRIMARY_CORE; in sof_widget_ready()
1557 int core = sof_get_token_value(SOF_TKN_COMP_CORE_ID, swidget->tuples, in sof_widget_ready()
1558 swidget->num_tuples); in sof_widget_ready()
1561 swidget->core = core; in sof_widget_ready()
1565 if (tw->event_type) { in sof_widget_ready()
1566 if (widget_ops && widget_ops[w->id].bind_event) { in sof_widget_ready()
1567 ret = widget_ops[w->id].bind_event(scomp, swidget, in sof_widget_ready()
1568 le16_to_cpu(tw->event_type)); in sof_widget_ready()
1570 dev_err(scomp->dev, "widget event binding failed for %s\n", in sof_widget_ready()
1571 swidget->widget->name); in sof_widget_ready()
1578 if (w->id == snd_soc_dapm_scheduler) { in sof_widget_ready()
1583 ret = -ENOMEM; in sof_widget_ready()
1587 spipe->pipe_widget = swidget; in sof_widget_ready()
1588 swidget->spipe = spipe; in sof_widget_ready()
1589 list_add(&spipe->list, &sdev->pipeline_list); in sof_widget_ready()
1592 w->dobj.private = swidget; in sof_widget_ready()
1593 list_add(&swidget->list, &sdev->widget_list); in sof_widget_ready()
1596 kfree(swidget->private); in sof_widget_ready()
1597 kfree(swidget->tuples); in sof_widget_ready()
1608 sroute = dobj->private; in sof_route_unload()
1613 kfree(sroute->private); in sof_route_unload()
1614 list_del(&sroute->list); in sof_route_unload()
1636 swidget = dobj->private; in sof_widget_unload()
1640 widget = swidget->widget; in sof_widget_unload()
1642 switch (swidget->id) { in sof_widget_unload()
1645 dai = swidget->private; in sof_widget_unload()
1648 list_del(&dai->list); in sof_widget_unload()
1655 struct snd_sof_pipeline *spipe = swidget->spipe; in sof_widget_unload()
1657 list_del(&spipe->list); in sof_widget_unload()
1659 swidget->spipe = NULL; in sof_widget_unload()
1665 for (i = 0; i < widget->num_kcontrols; i++) { in sof_widget_unload()
1666 kc = &widget->kcontrol_news[i]; in sof_widget_unload()
1667 switch (widget->dobj.widget.kcontrol_type[i]) { in sof_widget_unload()
1669 sm = (struct soc_mixer_control *)kc->private_value; in sof_widget_unload()
1670 scontrol = sm->dobj.private; in sof_widget_unload()
1671 if (sm->max > 1) in sof_widget_unload()
1672 kfree(scontrol->volume_table); in sof_widget_unload()
1675 se = (struct soc_enum *)kc->private_value; in sof_widget_unload()
1676 scontrol = se->dobj.private; in sof_widget_unload()
1679 sbe = (struct soc_bytes_ext *)kc->private_value; in sof_widget_unload()
1680 scontrol = sbe->dobj.private; in sof_widget_unload()
1683 dev_warn(scomp->dev, "unsupported kcontrol_type\n"); in sof_widget_unload()
1686 kfree(scontrol->ipc_control_data); in sof_widget_unload()
1687 list_del(&scontrol->list); in sof_widget_unload()
1688 kfree(scontrol->name); in sof_widget_unload()
1694 widget_ops = tplg_ops ? tplg_ops->widget : NULL; in sof_widget_unload()
1695 if (widget_ops && widget_ops[swidget->id].ipc_free) in sof_widget_unload()
1696 widget_ops[swidget->id].ipc_free(swidget); in sof_widget_unload()
1698 ida_destroy(&swidget->output_queue_ida); in sof_widget_unload()
1699 ida_destroy(&swidget->input_queue_ida); in sof_widget_unload()
1704 kfree(swidget->tuples); in sof_widget_unload()
1707 list_del(&swidget->list); in sof_widget_unload()
1717 /* FE DAI - used for any driver specific init */
1725 struct snd_soc_tplg_private *private = &pcm->priv; in sof_dai_load()
1736 return -ENOMEM; in sof_dai_load()
1738 spcm->scomp = scomp; in sof_dai_load()
1741 spcm->stream[stream].comp_id = COMP_ID_UNASSIGNED; in sof_dai_load()
1742 if (pcm->compress) in sof_dai_load()
1743 snd_sof_compr_init_elapsed_work(&spcm->stream[stream].period_elapsed_work); in sof_dai_load()
1745 snd_sof_pcm_init_elapsed_work(&spcm->stream[stream].period_elapsed_work); in sof_dai_load()
1748 spcm->pcm = *pcm; in sof_dai_load()
1749 dev_dbg(scomp->dev, "tplg: load pcm %s\n", pcm->dai_name); in sof_dai_load()
1752 if (ipc_pcm_ops && ipc_pcm_ops->pcm_setup) { in sof_dai_load()
1753 ret = ipc_pcm_ops->pcm_setup(sdev, spcm); in sof_dai_load()
1760 dai_drv->dobj.private = spcm; in sof_dai_load()
1761 list_add(&spcm->list, &sdev->pcm_list); in sof_dai_load()
1764 ARRAY_SIZE(stream_tokens), private->array, in sof_dai_load()
1765 le32_to_cpu(private->size)); in sof_dai_load()
1767 dev_err(scomp->dev, "error: parse stream tokens failed %d\n", in sof_dai_load()
1768 le32_to_cpu(private->size)); in sof_dai_load()
1773 if (!spcm->pcm.playback) in sof_dai_load()
1778 caps = &spcm->pcm.caps[stream]; in sof_dai_load()
1781 ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, sdev->dev, in sof_dai_load()
1782 PAGE_SIZE, &spcm->stream[stream].page_table); in sof_dai_load()
1784 dev_err(scomp->dev, "error: can't alloc page table for %s %d\n", in sof_dai_load()
1785 caps->name, ret); in sof_dai_load()
1793 dev_err(scomp->dev, in sof_dai_load()
1802 if (!spcm->pcm.capture) in sof_dai_load()
1805 caps = &spcm->pcm.caps[stream]; in sof_dai_load()
1808 ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, sdev->dev, in sof_dai_load()
1809 PAGE_SIZE, &spcm->stream[stream].page_table); in sof_dai_load()
1811 dev_err(scomp->dev, "error: can't alloc page table for %s %d\n", in sof_dai_load()
1812 caps->name, ret); in sof_dai_load()
1819 dev_err(scomp->dev, in sof_dai_load()
1821 snd_dma_free_pages(&spcm->stream[stream].page_table); in sof_dai_load()
1828 if (spcm->pcm.playback) in sof_dai_load()
1829 snd_dma_free_pages(&spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].page_table); in sof_dai_load()
1839 struct snd_sof_pcm *spcm = dobj->private; in sof_dai_unload()
1842 if (spcm->pcm.playback) in sof_dai_unload()
1843 snd_dma_free_pages(&spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].page_table); in sof_dai_unload()
1845 if (spcm->pcm.capture) in sof_dai_unload()
1846 snd_dma_free_pages(&spcm->stream[SNDRV_PCM_STREAM_CAPTURE].page_table); in sof_dai_unload()
1849 if (ipc_pcm_ops && ipc_pcm_ops->pcm_free) in sof_dai_unload()
1850 ipc_pcm_ops->pcm_free(sdev, spcm); in sof_dai_unload()
1853 list_del(&spcm->list); in sof_dai_unload()
1864 /* DAI link - used for any driver specific init */
1870 struct snd_soc_tplg_private *private = &cfg->priv; in sof_link_load()
1877 if (!link->platforms) { in sof_link_load()
1878 dev_err(scomp->dev, "error: no platforms\n"); in sof_link_load()
1879 return -EINVAL; in sof_link_load()
1881 link->platforms->name = dev_name(scomp->dev); in sof_link_load()
1883 if (tplg_ops && tplg_ops->link_setup) { in sof_link_load()
1884 ret = tplg_ops->link_setup(sdev, link); in sof_link_load()
1890 if (!link->no_pcm) { in sof_link_load()
1891 link->nonatomic = true; in sof_link_load()
1895 /* check we have some tokens - we need at least DAI type */ in sof_link_load()
1896 if (le32_to_cpu(private->size) == 0) { in sof_link_load()
1897 dev_err(scomp->dev, "error: expected tokens for DAI, none found\n"); in sof_link_load()
1898 return -EINVAL; in sof_link_load()
1903 return -ENOMEM; in sof_link_load()
1905 slink->num_hw_configs = le32_to_cpu(cfg->num_hw_configs); in sof_link_load()
1906 slink->hw_configs = kmemdup_array(cfg->hw_config, in sof_link_load()
1907 slink->num_hw_configs, sizeof(*slink->hw_configs), in sof_link_load()
1909 if (!slink->hw_configs) { in sof_link_load()
1911 return -ENOMEM; in sof_link_load()
1914 slink->default_hw_cfg_id = le32_to_cpu(cfg->default_hw_config_id); in sof_link_load()
1915 slink->link = link; in sof_link_load()
1917 dev_dbg(scomp->dev, "tplg: %d hw_configs found, default id: %d for dai link %s!\n", in sof_link_load()
1918 slink->num_hw_configs, slink->default_hw_cfg_id, link->name); in sof_link_load()
1922 private->array, le32_to_cpu(private->size)); in sof_link_load()
1924 dev_err(scomp->dev, "Failed tp parse common DAI link tokens\n"); in sof_link_load()
1925 kfree(slink->hw_configs); in sof_link_load()
1930 token_list = tplg_ops ? tplg_ops->token_list : NULL; in sof_link_load()
1934 /* calculate size of tuples array */ in sof_link_load()
1936 num_sets = slink->num_hw_configs; in sof_link_load()
1937 switch (slink->type) { in sof_link_load()
1940 num_tuples += token_list[SOF_SSP_TOKENS].count * slink->num_hw_configs; in sof_link_load()
1993 /* allocate memory for tuples array */ in sof_link_load()
1994 slink->tuples = kcalloc(num_tuples, sizeof(*slink->tuples), GFP_KERNEL); in sof_link_load()
1995 if (!slink->tuples) { in sof_link_load()
1996 kfree(slink->hw_configs); in sof_link_load()
1998 return -ENOMEM; in sof_link_load()
2003 ret = sof_copy_tuples(sdev, private->array, le32_to_cpu(private->size), in sof_link_load()
2004 SOF_DAI_LINK_TOKENS, 1, slink->tuples, in sof_link_load()
2005 num_tuples, &slink->num_tuples); in sof_link_load()
2007 dev_err(scomp->dev, "failed to parse %s for dai link %s\n", in sof_link_load()
2008 token_list[SOF_DAI_LINK_TOKENS].name, link->name); in sof_link_load()
2013 /* nothing more to do if there are no DAI type-specific tokens defined */ in sof_link_load()
2017 /* parse "num_sets" sets of DAI-specific tokens */ in sof_link_load()
2018 ret = sof_copy_tuples(sdev, private->array, le32_to_cpu(private->size), in sof_link_load()
2019 token_id, num_sets, slink->tuples, num_tuples, &slink->num_tuples); in sof_link_load()
2021 dev_err(scomp->dev, "failed to parse %s for dai link %s\n", in sof_link_load()
2022 token_list[token_id].name, link->name); in sof_link_load()
2029 slink->tuples, slink->num_tuples); in sof_link_load()
2032 dev_err(sdev->dev, "Invalid active PDM count for %s\n", link->name); in sof_link_load()
2037 ret = sof_copy_tuples(sdev, private->array, le32_to_cpu(private->size), in sof_link_load()
2038 SOF_DMIC_PDM_TOKENS, num_sets, slink->tuples, in sof_link_load()
2039 num_tuples, &slink->num_tuples); in sof_link_load()
2041 dev_err(scomp->dev, "failed to parse %s for dai link %s\n", in sof_link_load()
2042 token_list[SOF_DMIC_PDM_TOKENS].name, link->name); in sof_link_load()
2047 link->dobj.private = slink; in sof_link_load()
2048 list_add(&slink->list, &sdev->dai_link_list); in sof_link_load()
2053 kfree(slink->tuples); in sof_link_load()
2054 kfree(slink->hw_configs); in sof_link_load()
2062 struct snd_sof_dai_link *slink = dobj->private; in sof_link_unload()
2067 slink->link->platforms->name = NULL; in sof_link_unload()
2069 kfree(slink->tuples); in sof_link_unload()
2070 list_del(&slink->list); in sof_link_unload()
2071 kfree(slink->hw_configs); in sof_link_unload()
2073 dobj->private = NULL; in sof_link_unload()
2078 /* DAI link - used for any driver specific init */
2084 struct snd_soc_dobj *dobj = &route->dobj; in sof_route_load()
2091 return -ENOMEM; in sof_route_load()
2093 sroute->scomp = scomp; in sof_route_load()
2094 dev_dbg(scomp->dev, "sink %s control %s source %s\n", in sof_route_load()
2095 route->sink, route->control ? route->control : "none", in sof_route_load()
2096 route->source); in sof_route_load()
2099 source_swidget = snd_sof_find_swidget(scomp, (char *)route->source); in sof_route_load()
2101 dev_err(scomp->dev, "error: source %s not found\n", in sof_route_load()
2102 route->source); in sof_route_load()
2103 ret = -EINVAL; in sof_route_load()
2113 if (source_swidget->id == snd_soc_dapm_out_drv || in sof_route_load()
2114 source_swidget->id == snd_soc_dapm_output) in sof_route_load()
2118 sink_swidget = snd_sof_find_swidget(scomp, (char *)route->sink); in sof_route_load()
2120 dev_err(scomp->dev, "error: sink %s not found\n", in sof_route_load()
2121 route->sink); in sof_route_load()
2122 ret = -EINVAL; in sof_route_load()
2130 if (sink_swidget->id == snd_soc_dapm_out_drv || in sof_route_load()
2131 sink_swidget->id == snd_soc_dapm_output) in sof_route_load()
2134 sroute->route = route; in sof_route_load()
2135 dobj->private = sroute; in sof_route_load()
2136 sroute->src_widget = source_swidget; in sof_route_load()
2137 sroute->sink_widget = sink_swidget; in sof_route_load()
2140 list_add(&sroute->list, &sdev->route_list); in sof_route_load()
2149 * sof_set_widget_pipeline - Set pipeline for a component
2154 * Return: 0 if successful, -EINVAL on error.
2161 struct snd_sof_widget *pipe_widget = spipe->pipe_widget; in sof_set_widget_pipeline()
2164 if (pipe_widget->dynamic_pipeline_widget) { in sof_set_widget_pipeline()
2166 list_for_each_entry(scontrol, &sdev->kcontrol_list, list) in sof_set_widget_pipeline()
2167 if (scontrol->comp_id == swidget->comp_id && in sof_set_widget_pipeline()
2168 (scontrol->access & SNDRV_CTL_ELEM_ACCESS_VOLATILE)) { in sof_set_widget_pipeline()
2169 dev_err(sdev->dev, in sof_set_widget_pipeline()
2171 swidget->widget->name); in sof_set_widget_pipeline()
2172 return -EINVAL; in sof_set_widget_pipeline()
2177 swidget->spipe = spipe; in sof_set_widget_pipeline()
2178 swidget->dynamic_pipeline_widget = pipe_widget->dynamic_pipeline_widget; in sof_set_widget_pipeline()
2183 /* completion - called at completion of firmware loading */
2193 widget_ops = tplg_ops ? tplg_ops->widget : NULL; in sof_complete()
2196 if (tplg_ops && tplg_ops->control_setup) in sof_complete()
2197 list_for_each_entry(scontrol, &sdev->kcontrol_list, list) { in sof_complete()
2198 ret = tplg_ops->control_setup(sdev, scontrol); in sof_complete()
2200 dev_err(sdev->dev, "failed updating IPC struct for control %s\n", in sof_complete()
2201 scontrol->name); in sof_complete()
2207 list_for_each_entry(spipe, &sdev->pipeline_list, list) { in sof_complete()
2208 struct snd_sof_widget *pipe_widget = spipe->pipe_widget; in sof_complete()
2211 pipe_widget->instance_id = -EINVAL; in sof_complete()
2214 if (widget_ops && widget_ops[pipe_widget->id].ipc_setup) { in sof_complete()
2215 ret = widget_ops[pipe_widget->id].ipc_setup(pipe_widget); in sof_complete()
2217 dev_err(sdev->dev, "failed updating IPC struct for %s\n", in sof_complete()
2218 pipe_widget->widget->name); in sof_complete()
2224 list_for_each_entry(swidget, &sdev->widget_list, list) in sof_complete()
2225 if (swidget->widget->id != snd_soc_dapm_scheduler && in sof_complete()
2226 swidget->pipeline_id == pipe_widget->pipeline_id) { in sof_complete()
2231 if (widget_ops && widget_ops[swidget->id].ipc_setup) { in sof_complete()
2232 ret = widget_ops[swidget->id].ipc_setup(swidget); in sof_complete()
2234 dev_err(sdev->dev, in sof_complete()
2236 swidget->widget->name); in sof_complete()
2245 if (tplg_ops && tplg_ops->set_up_all_pipelines && in sof_complete()
2246 tplg_ops->tear_down_all_pipelines) { in sof_complete()
2247 ret = tplg_ops->set_up_all_pipelines(sdev, true); in sof_complete()
2249 dev_err(sdev->dev, "Failed to set up all topology pipelines: %d\n", in sof_complete()
2254 ret = tplg_ops->tear_down_all_pipelines(sdev, true); in sof_complete()
2256 dev_err(sdev->dev, "Failed to tear down topology pipelines: %d\n", in sof_complete()
2264 if (tplg_ops && tplg_ops->set_up_all_pipelines) in sof_complete()
2265 return tplg_ops->set_up_all_pipelines(sdev, false); in sof_complete()
2270 /* manifest - optional to inform component of manifest */
2277 if (tplg_ops && tplg_ops->parse_manifest) in sof_manifest()
2278 return tplg_ops->parse_manifest(scomp, index, man); in sof_manifest()
2298 /* external kcontrol init - used for any driver specific init */
2302 /* external kcontrol init - used for any driver specific init */
2306 /* external widget init - used for any driver specific init */
2311 /* FE DAI - used for any driver specific init */
2315 /* DAI link - used for any driver specific init */
2319 /* completion - called at completion of firmware loading */
2322 /* manifest - optional to inform component of manifest */
2366 /* external widget init - used for any driver specific init */
2371 if (WIDGET_IS_DAI(w->id)) { in sof_dspless_widget_ready()
2375 struct snd_soc_tplg_private *priv = &tw->priv; in sof_dspless_widget_ready()
2382 return -ENOMEM; in sof_dspless_widget_ready()
2387 return -ENOMEM; in sof_dspless_widget_ready()
2390 ret = sof_parse_tokens(scomp, &sdai->type, dai_tokens, ARRAY_SIZE(dai_tokens), in sof_dspless_widget_ready()
2391 priv->array, le32_to_cpu(priv->size)); in sof_dspless_widget_ready()
2393 dev_err(scomp->dev, "Failed to parse DAI tokens for %s\n", tw->name); in sof_dspless_widget_ready()
2406 swidget->scomp = scomp; in sof_dspless_widget_ready()
2407 swidget->widget = w; in sof_dspless_widget_ready()
2408 swidget->private = sdai; in sof_dspless_widget_ready()
2409 mutex_init(&swidget->setup_mutex); in sof_dspless_widget_ready()
2410 w->dobj.private = swidget; in sof_dspless_widget_ready()
2411 list_add(&swidget->list, &sdev->widget_list); in sof_dspless_widget_ready()
2422 if (WIDGET_IS_DAI(w->id)) { in sof_dspless_widget_unload()
2423 struct snd_sof_widget *swidget = dobj->private; in sof_dspless_widget_unload()
2431 list_del(&swidget->list); in sof_dspless_widget_unload()
2432 kfree(swidget->private); in sof_dspless_widget_unload()
2443 link->platforms->name = dev_name(scomp->dev); in sof_dspless_link_load()
2445 /* Set nonatomic property for FE dai links for FE-BE compatibility */ in sof_dspless_link_load()
2446 if (!link->no_pcm) in sof_dspless_link_load()
2447 link->nonatomic = true; in sof_dspless_link_load()
2453 /* external widget init - used for any driver specific init */
2457 /* FE DAI - used for any driver specific init */
2461 /* DAI link - used for any driver specific init */
2479 dev_dbg(scomp->dev, "loading topology:%s\n", file); in snd_sof_load_topology()
2481 ret = request_firmware(&fw, file, scomp->dev); in snd_sof_load_topology()
2483 dev_err(scomp->dev, "error: tplg request firmware %s failed err: %d\n", in snd_sof_load_topology()
2485 dev_err(scomp->dev, in snd_sof_load_topology()
2486 "you may need to download the firmware from https://github.com/thesofproject/sof-bin/\n"); in snd_sof_load_topology()
2490 if (sdev->dspless_mode_selected) in snd_sof_load_topology()
2496 dev_err(scomp->dev, "error: tplg component load failed %d\n", in snd_sof_load_topology()
2498 ret = -EINVAL; in snd_sof_load_topology()
2503 if (ret >= 0 && sdev->led_present) in snd_sof_load_topology()