| // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause) |
| // |
| // This file is provided under a dual BSD/GPLv2 license. When using or |
| // redistributing this file, you may do so under either license. |
| // |
| // Copyright(c) 2018 Intel Corporation. All rights reserved. |
| // |
| // Author: Liam Girdwood <liam.r.girdwood@linux.intel.com> |
| // |
| |
| /* Mixer Controls */ |
| |
| #include <linux/pm_runtime.h> |
| #include <linux/leds.h> |
| #include "sof-priv.h" |
| #include "sof-audio.h" |
| |
| static void update_mute_led(struct snd_sof_control *scontrol, |
| struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| int temp = 0; |
| int mask; |
| int i; |
| |
| mask = 1U << snd_ctl_get_ioffidx(kcontrol, &ucontrol->id); |
| |
| for (i = 0; i < scontrol->num_channels; i++) { |
| if (ucontrol->value.integer.value[i]) { |
| temp |= mask; |
| break; |
| } |
| } |
| |
| if (temp == scontrol->led_ctl.led_value) |
| return; |
| |
| scontrol->led_ctl.led_value = temp; |
| |
| #if IS_REACHABLE(CONFIG_LEDS_TRIGGER_AUDIO) |
| if (!scontrol->led_ctl.direction) |
| ledtrig_audio_set(LED_AUDIO_MUTE, temp ? LED_OFF : LED_ON); |
| else |
| ledtrig_audio_set(LED_AUDIO_MICMUTE, temp ? LED_OFF : LED_ON); |
| #endif |
| } |
| |
| static inline u32 mixer_to_ipc(unsigned int value, u32 *volume_map, int size) |
| { |
| if (value >= size) |
| return volume_map[size - 1]; |
| |
| return volume_map[value]; |
| } |
| |
| static inline u32 ipc_to_mixer(u32 value, u32 *volume_map, int size) |
| { |
| int i; |
| |
| for (i = 0; i < size; i++) { |
| if (volume_map[i] >= value) |
| return i; |
| } |
| |
| return i - 1; |
| } |
| |
| int snd_sof_volume_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *sm = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = sm->dobj.private; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| |
| /* read back each channel */ |
| for (i = 0; i < channels; i++) |
| ucontrol->value.integer.value[i] = |
| ipc_to_mixer(cdata->chanv[i].value, |
| scontrol->volume_table, sm->max + 1); |
| |
| return 0; |
| } |
| |
| int snd_sof_volume_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *sm = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = sm->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| bool change = false; |
| u32 value; |
| |
| /* update each channel */ |
| for (i = 0; i < channels; i++) { |
| value = mixer_to_ipc(ucontrol->value.integer.value[i], |
| scontrol->volume_table, sm->max + 1); |
| change = change || (value != cdata->chanv[i].value); |
| cdata->chanv[i].channel = i; |
| cdata->chanv[i].value = value; |
| } |
| |
| /* notify DSP of mixer updates */ |
| if (pm_runtime_active(scomp->dev)) |
| snd_sof_ipc_set_get_comp_data(scontrol, |
| SOF_IPC_COMP_SET_VALUE, |
| SOF_CTRL_TYPE_VALUE_CHAN_GET, |
| SOF_CTRL_CMD_VOLUME, |
| true); |
| return change; |
| } |
| |
| int snd_sof_switch_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *sm = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = sm->dobj.private; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| |
| /* read back each channel */ |
| for (i = 0; i < channels; i++) |
| ucontrol->value.integer.value[i] = cdata->chanv[i].value; |
| |
| return 0; |
| } |
| |
| int snd_sof_switch_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *sm = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = sm->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| bool change = false; |
| u32 value; |
| |
| /* update each channel */ |
| for (i = 0; i < channels; i++) { |
| value = ucontrol->value.integer.value[i]; |
| change = change || (value != cdata->chanv[i].value); |
| cdata->chanv[i].channel = i; |
| cdata->chanv[i].value = value; |
| } |
| |
| if (scontrol->led_ctl.use_led) |
| update_mute_led(scontrol, kcontrol, ucontrol); |
| |
| /* notify DSP of mixer updates */ |
| if (pm_runtime_active(scomp->dev)) |
| snd_sof_ipc_set_get_comp_data(scontrol, |
| SOF_IPC_COMP_SET_VALUE, |
| SOF_CTRL_TYPE_VALUE_CHAN_GET, |
| SOF_CTRL_CMD_SWITCH, |
| true); |
| |
| return change; |
| } |
| |
| int snd_sof_enum_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_enum *se = |
| (struct soc_enum *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = se->dobj.private; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| |
| /* read back each channel */ |
| for (i = 0; i < channels; i++) |
| ucontrol->value.enumerated.item[i] = cdata->chanv[i].value; |
| |
| return 0; |
| } |
| |
| int snd_sof_enum_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_enum *se = |
| (struct soc_enum *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = se->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| unsigned int i, channels = scontrol->num_channels; |
| bool change = false; |
| u32 value; |
| |
| /* update each channel */ |
| for (i = 0; i < channels; i++) { |
| value = ucontrol->value.enumerated.item[i]; |
| change = change || (value != cdata->chanv[i].value); |
| cdata->chanv[i].channel = i; |
| cdata->chanv[i].value = value; |
| } |
| |
| /* notify DSP of enum updates */ |
| if (pm_runtime_active(scomp->dev)) |
| snd_sof_ipc_set_get_comp_data(scontrol, |
| SOF_IPC_COMP_SET_VALUE, |
| SOF_CTRL_TYPE_VALUE_CHAN_GET, |
| SOF_CTRL_CMD_ENUM, |
| true); |
| |
| return change; |
| } |
| |
| int snd_sof_bytes_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_bytes_ext *be = |
| (struct soc_bytes_ext *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = be->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| struct sof_abi_hdr *data = cdata->data; |
| size_t size; |
| int ret = 0; |
| |
| if (be->max > sizeof(ucontrol->value.bytes.data)) { |
| dev_err_ratelimited(scomp->dev, |
| "error: data max %d exceeds ucontrol data array size\n", |
| be->max); |
| return -EINVAL; |
| } |
| |
| size = data->size + sizeof(*data); |
| if (size > be->max) { |
| dev_err_ratelimited(scomp->dev, |
| "error: DSP sent %zu bytes max is %d\n", |
| size, be->max); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| /* copy back to kcontrol */ |
| memcpy(ucontrol->value.bytes.data, data, size); |
| |
| out: |
| return ret; |
| } |
| |
| int snd_sof_bytes_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_bytes_ext *be = |
| (struct soc_bytes_ext *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = be->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| struct sof_abi_hdr *data = cdata->data; |
| size_t size = data->size + sizeof(*data); |
| |
| if (be->max > sizeof(ucontrol->value.bytes.data)) { |
| dev_err_ratelimited(scomp->dev, |
| "error: data max %d exceeds ucontrol data array size\n", |
| be->max); |
| return -EINVAL; |
| } |
| |
| if (size > be->max) { |
| dev_err_ratelimited(scomp->dev, |
| "error: size too big %zu bytes max is %d\n", |
| size, be->max); |
| return -EINVAL; |
| } |
| |
| /* copy from kcontrol */ |
| memcpy(data, ucontrol->value.bytes.data, size); |
| |
| /* notify DSP of byte control updates */ |
| if (pm_runtime_active(scomp->dev)) |
| snd_sof_ipc_set_get_comp_data(scontrol, |
| SOF_IPC_COMP_SET_DATA, |
| SOF_CTRL_TYPE_DATA_SET, |
| scontrol->cmd, |
| true); |
| |
| return 0; |
| } |
| |
| int snd_sof_bytes_ext_put(struct snd_kcontrol *kcontrol, |
| const unsigned int __user *binary_data, |
| unsigned int size) |
| { |
| struct soc_bytes_ext *be = |
| (struct soc_bytes_ext *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = be->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| struct snd_ctl_tlv header; |
| const struct snd_ctl_tlv __user *tlvd = |
| (const struct snd_ctl_tlv __user *)binary_data; |
| |
| /* |
| * The beginning of bytes data contains a header from where |
| * the length (as bytes) is needed to know the correct copy |
| * length of data from tlvd->tlv. |
| */ |
| if (copy_from_user(&header, tlvd, sizeof(const struct snd_ctl_tlv))) |
| return -EFAULT; |
| |
| /* be->max is coming from topology */ |
| if (header.length > be->max) { |
| dev_err_ratelimited(scomp->dev, "error: Bytes data size %d exceeds max %d.\n", |
| header.length, be->max); |
| return -EINVAL; |
| } |
| |
| /* Check that header id matches the command */ |
| if (header.numid != scontrol->cmd) { |
| dev_err_ratelimited(scomp->dev, |
| "error: incorrect numid %d\n", |
| header.numid); |
| return -EINVAL; |
| } |
| |
| if (copy_from_user(cdata->data, tlvd->tlv, header.length)) |
| return -EFAULT; |
| |
| if (cdata->data->magic != SOF_ABI_MAGIC) { |
| dev_err_ratelimited(scomp->dev, |
| "error: Wrong ABI magic 0x%08x.\n", |
| cdata->data->magic); |
| return -EINVAL; |
| } |
| |
| if (SOF_ABI_VERSION_INCOMPATIBLE(SOF_ABI_VERSION, cdata->data->abi)) { |
| dev_err_ratelimited(scomp->dev, "error: Incompatible ABI version 0x%08x.\n", |
| cdata->data->abi); |
| return -EINVAL; |
| } |
| |
| if (cdata->data->size + sizeof(const struct sof_abi_hdr) > be->max) { |
| dev_err_ratelimited(scomp->dev, "error: Mismatch in ABI data size (truncated?).\n"); |
| return -EINVAL; |
| } |
| |
| /* notify DSP of byte control updates */ |
| if (pm_runtime_active(scomp->dev)) |
| snd_sof_ipc_set_get_comp_data(scontrol, |
| SOF_IPC_COMP_SET_DATA, |
| SOF_CTRL_TYPE_DATA_SET, |
| scontrol->cmd, |
| true); |
| |
| return 0; |
| } |
| |
| int snd_sof_bytes_ext_get(struct snd_kcontrol *kcontrol, |
| unsigned int __user *binary_data, |
| unsigned int size) |
| { |
| struct soc_bytes_ext *be = |
| (struct soc_bytes_ext *)kcontrol->private_value; |
| struct snd_sof_control *scontrol = be->dobj.private; |
| struct snd_soc_component *scomp = scontrol->scomp; |
| struct sof_ipc_ctrl_data *cdata = scontrol->control_data; |
| struct snd_ctl_tlv header; |
| struct snd_ctl_tlv __user *tlvd = |
| (struct snd_ctl_tlv __user *)binary_data; |
| int data_size; |
| int ret = 0; |
| |
| /* |
| * Decrement the limit by ext bytes header size to |
| * ensure the user space buffer is not exceeded. |
| */ |
| size -= sizeof(const struct snd_ctl_tlv); |
| |
| /* set the ABI header values */ |
| cdata->data->magic = SOF_ABI_MAGIC; |
| cdata->data->abi = SOF_ABI_VERSION; |
| |
| /* Prevent read of other kernel data or possibly corrupt response */ |
| data_size = cdata->data->size + sizeof(const struct sof_abi_hdr); |
| |
| /* check data size doesn't exceed max coming from topology */ |
| if (data_size > be->max) { |
| dev_err_ratelimited(scomp->dev, "error: user data size %d exceeds max size %d.\n", |
| data_size, be->max); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| header.numid = scontrol->cmd; |
| header.length = data_size; |
| if (copy_to_user(tlvd, &header, sizeof(const struct snd_ctl_tlv))) { |
| ret = -EFAULT; |
| goto out; |
| } |
| |
| if (copy_to_user(tlvd->tlv, cdata->data, data_size)) |
| ret = -EFAULT; |
| |
| out: |
| return ret; |
| } |