greybus-dev May 2020

greybus-dev@lists.linaro.org

15 participants
9 discussions

[PATCH v2] greybus: fix typos in GREYBUS/GREYBUS_ES2 help text

by Zenyu Sy

From: Zenyu Sy <zenyu(a)tuta.io> Fix typos ("an" -> "a", "chose" -> "choose") in Kconfig Signed-off-by: Zenyu Sy <zenyu(a)tuta.io> --- base-commit: f5e94d10e4c468357019e5c28d48499f677b284f Fixed the white-space formatting problem. drivers/greybus/Kconfig | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/drivers/greybus/Kconfig b/drivers/greybus/Kconfig index b84fcaf8b..aeea082f1 100644 --- a/drivers/greybus/Kconfig +++ b/drivers/greybus/Kconfig @@ -3,7 +3,7 @@ menuconfig GREYBUS tristate "Greybus support" depends on SYSFS ---help--- - This option enables the Greybus driver core. Greybus is an + This option enables the Greybus driver core. Greybus is a hardware protocol that was designed to provide Unipro with a sane application layer. It was originally designed for the ARA project, a module phone system, but has shown up in other @@ -12,7 +12,7 @@ menuconfig GREYBUS Say Y here to enable support for these types of drivers. - To compile this code as a module, chose M here: the module + To compile this code as a module, choose M here: the module will be called greybus.ko if GREYBUS @@ -25,7 +25,7 @@ config GREYBUS_ES2 acts as a Greybus "host controller". This device is a bridge from a USB device to a Unipro network. - To compile this code as a module, chose M here: the module + To compile this code as a module, choose M here: the module will be called gb-es2.ko endif # GREYBUS -- 2.26.1

4 years, 6 months

[PATCH 0/8] Add helper for accessing Power Management callbacs

by Krzysztof Wilczyński

This series aims to add a new driver_to_pm() helper allowing for accessing the Power Management callbacs for a particular device. Access to the callbacs (struct dev_pm_ops) is normally done through using the pm pointer that is embedded within the device_driver struct. This new helper allows for the code required to reference the pm pointer and access Power Management callbas to be simplified. Changing the following: struct device_driver *drv = dev->driver; if (dev->driver && dev->driver->pm && dev->driver->pm->prepare) { int ret = dev->driver->pm->prepare(dev); To: const struct dev_pm_ops *pm = driver_to_pm(dev->driver); if (pm && pm->prepare) { int ret = pm->prepare(dev); Or, changing the following: const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL; To: const struct dev_pm_ops *pm = driver_to_pm(dev->driver); This series builds on top of the previous commit 6da2f2ccfd2d ("PCI/PM: Make power management op coding style consistent") that had an aim to make accessing the Power Managemnet callbacs more consistent. No functional change intended. Links: https://lore.kernel.org/driverdev-devel/20191014230016.240912-6-helgaas@ker… https://lore.kernel.org/driverdev-devel/8592302.r4xC6RIy69@kreacher/ https://lore.kernel.org/driverdev-devel/20191016135002.GA24678@kadam/ Krzysztof Wilczyński (8): driver core: Add helper for accessing Power Management callbacs ACPI: PM: Use the new device_to_pm() helper to access struct dev_pm_ops greybus: Use the new device_to_pm() helper to access struct dev_pm_ops scsi: pm: Use the new device_to_pm() helper to access struct dev_pm_ops usb: phy: fsl: Use the new device_to_pm() helper to access struct dev_pm_ops PCI/PM: Use the new device_to_pm() helper to access struct dev_pm_ops PM: Use the new device_to_pm() helper to access struct dev_pm_ops net/iucv: Use the new device_to_pm() helper to access struct dev_pm_ops drivers/acpi/device_pm.c | 5 ++- drivers/base/power/domain.c | 12 ++++-- drivers/base/power/generic_ops.c | 65 ++++++++++++++------------------ drivers/base/power/main.c | 48 +++++++++++++++-------- drivers/base/power/runtime.c | 7 ++-- drivers/greybus/bundle.c | 4 +- drivers/pci/pci-driver.c | 32 ++++++++-------- drivers/scsi/scsi_pm.c | 8 ++-- drivers/usb/phy/phy-fsl-usb.c | 11 ++++-- include/linux/device/driver.h | 15 ++++++++ net/iucv/iucv.c | 30 +++++++++------ 11 files changed, 138 insertions(+), 99 deletions(-) -- 2.26.2

4 years, 7 months

[PATCH] staging: greybus: loopback: fix a spelling error.

by Till Varoquaux

Successed -> succeeded. Signed-off-by: Till Varoquaux <till.varoquaux(a)gmail.com> --- drivers/staging/greybus/loopback.c | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/drivers/staging/greybus/loopback.c b/drivers/staging/greybus/loopback.c index 583d9708a191..2471448ba42a 100644 --- a/drivers/staging/greybus/loopback.c +++ b/drivers/staging/greybus/loopback.c @@ -135,7 +135,7 @@ static ssize_t name##_##field##_show(struct device *dev, \ char *buf) \ { \ struct gb_loopback *gb = dev_get_drvdata(dev); \ - /* Report 0 for min and max if no transfer successed */ \ + /* Report 0 for min and max if no transfer succeeded */ \ if (!gb->requests_completed) \ return sprintf(buf, "0\n"); \ return sprintf(buf, "%" #type "\n", gb->name.field); \ -- 2.25.4

4 years, 7 months

[PATCH V1 0/6] Enable Greybus Audio codec driver

by Vaibhav Agarwal

The existing GB Audio codec driver is dependent on MSM8994 Audio driver. During the development stage, this depdency was configured due to various changes involved in MSM Audio driver to enable addtional codec card and some of the changes proposed in mainline ASoC framework. However, these are not the real dependencies and some of them can be easily removed. The folowing patch series includes the changes to resolve unnecessary depedencies and make the codec driver functional with the latest kernel. Patch 1,2: Incudes jack framework related changes. Patch 3,4,5: Resolves compilation error observed with the latest kernel and also provides helper APIs required to allow dynamic addition/removal of modules. Patch 6: Finally provides config options and related Makefile changes to enable GB Codec driver. Thanks to Alexandre for raising the headsup [1] and motivating me to provide the necessary changes. [1] https://lore.kernel.org/lkml/20200507212912.599433-1-alexandre.belloni@boot… Vaibhav Agarwal (6): staging: greybus: audio: Update snd_jack FW usage as per new APIs staging: greybus: audio: Maintain jack list within GB Audio module staging: greybus: audio: Resolve compilation errors for GB codec module staging: greybus: audio: Resolve compilation error in topology parser staging: greybus: audio: Add helper APIs for dynamic audio modules staging: greybus: audio: Enable GB codec, audio module compilation. drivers/staging/greybus/Kconfig | 14 ++- drivers/staging/greybus/Makefile | 6 +- drivers/staging/greybus/audio_codec.c | 187 ++++++++++++++++++----------- drivers/staging/greybus/audio_codec.h | 12 +- drivers/staging/greybus/audio_helper.c | 197 +++++++++++++++++++++++++++++++ drivers/staging/greybus/audio_helper.h | 17 +++ drivers/staging/greybus/audio_module.c | 20 ++-- drivers/staging/greybus/audio_topology.c | 130 ++++++++++---------- 8 files changed, 427 insertions(+), 156 deletions(-) create mode 100644 drivers/staging/greybus/audio_helper.c create mode 100644 drivers/staging/greybus/audio_helper.h -- 2.7.4

4 years, 7 months

[PATCH] greybus: audio: remove unused code

by Alexandre Belloni

GREYBUS_AUDIO_MSM8994 is not an existing configuration option and as reported in September 2016, it depends on an "out-of-tree qualcomm audio driver". This driver never made it upstream. https://lore.kernel.org/lkml/20160921073905.GA31263@kroah.com/ Moreover, there doesn't seem to be any interest in actually fixing the driver as it uses ASoC APIs that have been removed from the kernel in 2018 as shown by its use of snd_soc_register_codec and snd_soc_codec_get_drvdata, removed in commit 999f7f5af8eb ("ASoC: remove Codec related code"). Signed-off-by: Alexandre Belloni <alexandre.belloni(a)bootlin.com> --- drivers/staging/greybus/Makefile | 4 - drivers/staging/greybus/audio_codec.c | 1103 ---------------- drivers/staging/greybus/audio_module.c | 478 ------- drivers/staging/greybus/audio_topology.c | 1448 ---------------------- 4 files changed, 3033 deletions(-) delete mode 100644 drivers/staging/greybus/audio_codec.c delete mode 100644 drivers/staging/greybus/audio_module.c delete mode 100644 drivers/staging/greybus/audio_topology.c diff --git a/drivers/staging/greybus/Makefile b/drivers/staging/greybus/Makefile index 627e44f2a983..af88583cdc20 100644 --- a/drivers/staging/greybus/Makefile +++ b/drivers/staging/greybus/Makefile @@ -27,8 +27,6 @@ obj-$(CONFIG_GREYBUS_RAW) += gb-raw.o obj-$(CONFIG_GREYBUS_VIBRATOR) += gb-vibrator.o # Greybus Audio is a bunch of modules -gb-audio-module-y := audio_module.o audio_topology.o -gb-audio-codec-y := audio_codec.o gb-audio-gb-y := audio_gb.o gb-audio-apbridgea-y := audio_apbridgea.o gb-audio-manager-y := audio_manager.o audio_manager_module.o @@ -40,8 +38,6 @@ gb-audio-manager-y := audio_manager.o audio_manager_module.o #ccflags-y += -DGB_AUDIO_MANAGER_SYSFS #endif -obj-$(CONFIG_GREYBUS_AUDIO_MSM8994) += gb-audio-codec.o -obj-$(CONFIG_GREYBUS_AUDIO_MSM8994) += gb-audio-module.o obj-$(CONFIG_GREYBUS_AUDIO) += gb-audio-gb.o obj-$(CONFIG_GREYBUS_AUDIO) += gb-audio-apbridgea.o obj-$(CONFIG_GREYBUS_AUDIO) += gb-audio-manager.o diff --git a/drivers/staging/greybus/audio_codec.c b/drivers/staging/greybus/audio_codec.c deleted file mode 100644 index 08746c85dea6..000000000000 --- a/drivers/staging/greybus/audio_codec.c +++ /dev/null @@ -1,1103 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0 -/* - * APBridge ALSA SoC dummy codec driver - * Copyright 2016 Google Inc. - * Copyright 2016 Linaro Ltd. - */ -#include <linux/kernel.h> -#include <linux/module.h> -#include <linux/pm_runtime.h> -#include <sound/soc.h> -#include <sound/pcm_params.h> -#include <uapi/linux/input.h> - -#include "audio_codec.h" -#include "audio_apbridgea.h" -#include "audio_manager.h" - -static struct gbaudio_codec_info *gbcodec; - -static struct gbaudio_data_connection * -find_data(struct gbaudio_module_info *module, int id) -{ - struct gbaudio_data_connection *data; - - list_for_each_entry(data, &module->data_list, list) { - if (id == data->id) - return data; - } - return NULL; -} - -static struct gbaudio_stream_params * -find_dai_stream_params(struct gbaudio_codec_info *codec, int id, int stream) -{ - struct gbaudio_codec_dai *dai; - - list_for_each_entry(dai, &codec->dai_list, list) { - if (dai->id == id) - return &dai->params[stream]; - } - return NULL; -} - -static int gbaudio_module_enable_tx(struct gbaudio_codec_info *codec, - struct gbaudio_module_info *module, int id) -{ - int module_state, ret = 0; - u16 data_cport, i2s_port, cportid; - u8 sig_bits, channels; - u32 format, rate; - struct gbaudio_data_connection *data; - struct gbaudio_stream_params *params; - - /* find the dai */ - data = find_data(module, id); - if (!data) { - dev_err(module->dev, "%d:DATA connection missing\n", id); - return -ENODEV; - } - module_state = data->state[SNDRV_PCM_STREAM_PLAYBACK]; - - params = find_dai_stream_params(codec, id, SNDRV_PCM_STREAM_PLAYBACK); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - return -EINVAL; - } - - /* register cport */ - if (module_state < GBAUDIO_CODEC_STARTUP) { - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_register_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_TX); - if (ret) { - dev_err_ratelimited(module->dev, - "reg_cport failed:%d\n", ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_PLAYBACK] = - GBAUDIO_CODEC_STARTUP; - dev_dbg(module->dev, "Dynamic Register %d DAI\n", cportid); - } - - /* hw_params */ - if (module_state < GBAUDIO_CODEC_HWPARAMS) { - format = params->format; - channels = params->channels; - rate = params->rate; - sig_bits = params->sig_bits; - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_set_pcm(module->mgmt_connection, data_cport, - format, rate, channels, sig_bits); - if (ret) { - dev_err_ratelimited(module->dev, "set_pcm failed:%d\n", - ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_PLAYBACK] = - GBAUDIO_CODEC_HWPARAMS; - dev_dbg(module->dev, "Dynamic hw_params %d DAI\n", data_cport); - } - - /* prepare */ - if (module_state < GBAUDIO_CODEC_PREPARE) { - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_set_tx_data_size(module->mgmt_connection, - data_cport, 192); - if (ret) { - dev_err_ratelimited(module->dev, - "set_tx_data_size failed:%d\n", - ret); - return ret; - } - ret = gb_audio_gb_activate_tx(module->mgmt_connection, - data_cport); - if (ret) { - dev_err_ratelimited(module->dev, - "activate_tx failed:%d\n", ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_PLAYBACK] = - GBAUDIO_CODEC_PREPARE; - dev_dbg(module->dev, "Dynamic prepare %d DAI\n", data_cport); - } - - return 0; -} - -static int gbaudio_module_disable_tx(struct gbaudio_module_info *module, int id) -{ - int ret; - u16 data_cport, cportid, i2s_port; - int module_state; - struct gbaudio_data_connection *data; - - /* find the dai */ - data = find_data(module, id); - if (!data) { - dev_err(module->dev, "%d:DATA connection missing\n", id); - return -ENODEV; - } - module_state = data->state[SNDRV_PCM_STREAM_PLAYBACK]; - - if (module_state > GBAUDIO_CODEC_HWPARAMS) { - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_deactivate_tx(module->mgmt_connection, - data_cport); - if (ret) { - dev_err_ratelimited(module->dev, - "deactivate_tx failed:%d\n", ret); - return ret; - } - dev_dbg(module->dev, "Dynamic deactivate %d DAI\n", data_cport); - data->state[SNDRV_PCM_STREAM_PLAYBACK] = - GBAUDIO_CODEC_HWPARAMS; - } - - if (module_state > GBAUDIO_CODEC_SHUTDOWN) { - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_unregister_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_TX); - if (ret) { - dev_err_ratelimited(module->dev, - "unregister_cport failed:%d\n", - ret); - return ret; - } - dev_dbg(module->dev, "Dynamic Unregister %d DAI\n", cportid); - data->state[SNDRV_PCM_STREAM_PLAYBACK] = - GBAUDIO_CODEC_SHUTDOWN; - } - - return 0; -} - -static int gbaudio_module_enable_rx(struct gbaudio_codec_info *codec, - struct gbaudio_module_info *module, int id) -{ - int module_state, ret = 0; - u16 data_cport, i2s_port, cportid; - u8 sig_bits, channels; - u32 format, rate; - struct gbaudio_data_connection *data; - struct gbaudio_stream_params *params; - - /* find the dai */ - data = find_data(module, id); - if (!data) { - dev_err(module->dev, "%d:DATA connection missing\n", id); - return -ENODEV; - } - module_state = data->state[SNDRV_PCM_STREAM_CAPTURE]; - - params = find_dai_stream_params(codec, id, SNDRV_PCM_STREAM_CAPTURE); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - return -EINVAL; - } - - /* register cport */ - if (module_state < GBAUDIO_CODEC_STARTUP) { - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_register_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_RX); - if (ret) { - dev_err_ratelimited(module->dev, - "reg_cport failed:%d\n", ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_CAPTURE] = - GBAUDIO_CODEC_STARTUP; - dev_dbg(module->dev, "Dynamic Register %d DAI\n", cportid); - } - - /* hw_params */ - if (module_state < GBAUDIO_CODEC_HWPARAMS) { - format = params->format; - channels = params->channels; - rate = params->rate; - sig_bits = params->sig_bits; - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_set_pcm(module->mgmt_connection, data_cport, - format, rate, channels, sig_bits); - if (ret) { - dev_err_ratelimited(module->dev, "set_pcm failed:%d\n", - ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_CAPTURE] = - GBAUDIO_CODEC_HWPARAMS; - dev_dbg(module->dev, "Dynamic hw_params %d DAI\n", data_cport); - } - - /* prepare */ - if (module_state < GBAUDIO_CODEC_PREPARE) { - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_set_rx_data_size(module->mgmt_connection, - data_cport, 192); - if (ret) { - dev_err_ratelimited(module->dev, - "set_rx_data_size failed:%d\n", - ret); - return ret; - } - ret = gb_audio_gb_activate_rx(module->mgmt_connection, - data_cport); - if (ret) { - dev_err_ratelimited(module->dev, - "activate_rx failed:%d\n", ret); - return ret; - } - data->state[SNDRV_PCM_STREAM_CAPTURE] = - GBAUDIO_CODEC_PREPARE; - dev_dbg(module->dev, "Dynamic prepare %d DAI\n", data_cport); - } - - return 0; -} - -static int gbaudio_module_disable_rx(struct gbaudio_module_info *module, int id) -{ - int ret; - u16 data_cport, cportid, i2s_port; - int module_state; - struct gbaudio_data_connection *data; - - /* find the dai */ - data = find_data(module, id); - if (!data) { - dev_err(module->dev, "%d:DATA connection missing\n", id); - return -ENODEV; - } - module_state = data->state[SNDRV_PCM_STREAM_CAPTURE]; - - if (module_state > GBAUDIO_CODEC_HWPARAMS) { - data_cport = data->connection->intf_cport_id; - ret = gb_audio_gb_deactivate_rx(module->mgmt_connection, - data_cport); - if (ret) { - dev_err_ratelimited(module->dev, - "deactivate_rx failed:%d\n", ret); - return ret; - } - dev_dbg(module->dev, "Dynamic deactivate %d DAI\n", data_cport); - data->state[SNDRV_PCM_STREAM_CAPTURE] = - GBAUDIO_CODEC_HWPARAMS; - } - - if (module_state > GBAUDIO_CODEC_SHUTDOWN) { - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_unregister_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_RX); - if (ret) { - dev_err_ratelimited(module->dev, - "unregister_cport failed:%d\n", - ret); - return ret; - } - dev_dbg(module->dev, "Dynamic Unregister %d DAI\n", cportid); - data->state[SNDRV_PCM_STREAM_CAPTURE] = - GBAUDIO_CODEC_SHUTDOWN; - } - - return 0; -} - -int gbaudio_module_update(struct gbaudio_codec_info *codec, - struct snd_soc_dapm_widget *w, - struct gbaudio_module_info *module, int enable) -{ - int dai_id, ret; - char intf_name[NAME_SIZE], dir[NAME_SIZE]; - - dev_dbg(module->dev, "%s:Module update %s sequence\n", w->name, - enable ? "Enable" : "Disable"); - - if ((w->id != snd_soc_dapm_aif_in) && (w->id != snd_soc_dapm_aif_out)) { - dev_dbg(codec->dev, "No action required for %s\n", w->name); - return 0; - } - - /* parse dai_id from AIF widget's stream_name */ - ret = sscanf(w->sname, "%s %d %s", intf_name, &dai_id, dir); - if (ret < 3) { - dev_err(codec->dev, "Error while parsing dai_id for %s\n", - w->name); - return -EINVAL; - } - - mutex_lock(&codec->lock); - if (w->id == snd_soc_dapm_aif_in) { - if (enable) - ret = gbaudio_module_enable_tx(codec, module, dai_id); - else - ret = gbaudio_module_disable_tx(module, dai_id); - } else if (w->id == snd_soc_dapm_aif_out) { - if (enable) - ret = gbaudio_module_enable_rx(codec, module, dai_id); - else - ret = gbaudio_module_disable_rx(module, dai_id); - } - - mutex_unlock(&codec->lock); - - return ret; -} -EXPORT_SYMBOL(gbaudio_module_update); - -/* - * codec DAI ops - */ -static int gbcodec_startup(struct snd_pcm_substream *substream, - struct snd_soc_dai *dai) -{ - struct gbaudio_codec_info *codec = dev_get_drvdata(dai->dev); - struct gbaudio_stream_params *params; - - mutex_lock(&codec->lock); - - if (list_empty(&codec->module_list)) { - dev_err(codec->dev, "No codec module available\n"); - mutex_unlock(&codec->lock); - return -ENODEV; - } - - params = find_dai_stream_params(codec, dai->id, substream->stream); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - mutex_unlock(&codec->lock); - return -EINVAL; - } - params->state = GBAUDIO_CODEC_STARTUP; - mutex_unlock(&codec->lock); - /* to prevent suspend in case of active audio */ - pm_stay_awake(dai->dev); - - return 0; -} - -static void gbcodec_shutdown(struct snd_pcm_substream *substream, - struct snd_soc_dai *dai) -{ - struct gbaudio_codec_info *codec = dev_get_drvdata(dai->dev); - struct gbaudio_stream_params *params; - - mutex_lock(&codec->lock); - - if (list_empty(&codec->module_list)) - dev_info(codec->dev, "No codec module available during shutdown\n"); - - params = find_dai_stream_params(codec, dai->id, substream->stream); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - mutex_unlock(&codec->lock); - return; - } - params->state = GBAUDIO_CODEC_SHUTDOWN; - mutex_unlock(&codec->lock); - pm_relax(dai->dev); -} - -static int gbcodec_hw_params(struct snd_pcm_substream *substream, - struct snd_pcm_hw_params *hwparams, - struct snd_soc_dai *dai) -{ - int ret; - u8 sig_bits, channels; - u32 format, rate; - struct gbaudio_module_info *module; - struct gbaudio_data_connection *data; - struct gb_bundle *bundle; - struct gbaudio_codec_info *codec = dev_get_drvdata(dai->dev); - struct gbaudio_stream_params *params; - - mutex_lock(&codec->lock); - - if (list_empty(&codec->module_list)) { - dev_err(codec->dev, "No codec module available\n"); - mutex_unlock(&codec->lock); - return -ENODEV; - } - - /* - * assuming, currently only 48000 Hz, 16BIT_LE, stereo - * is supported, validate params before configuring codec - */ - if (params_channels(hwparams) != 2) { - dev_err(dai->dev, "Invalid channel count:%d\n", - params_channels(hwparams)); - mutex_unlock(&codec->lock); - return -EINVAL; - } - channels = params_channels(hwparams); - - if (params_rate(hwparams) != 48000) { - dev_err(dai->dev, "Invalid sampling rate:%d\n", - params_rate(hwparams)); - mutex_unlock(&codec->lock); - return -EINVAL; - } - rate = GB_AUDIO_PCM_RATE_48000; - - if (params_format(hwparams) != SNDRV_PCM_FORMAT_S16_LE) { - dev_err(dai->dev, "Invalid format:%d\n", - params_format(hwparams)); - mutex_unlock(&codec->lock); - return -EINVAL; - } - format = GB_AUDIO_PCM_FMT_S16_LE; - - /* find the data connection */ - list_for_each_entry(module, &codec->module_list, list) { - data = find_data(module, dai->id); - if (data) - break; - } - - if (!data) { - dev_err(dai->dev, "DATA connection missing\n"); - mutex_unlock(&codec->lock); - return -EINVAL; - } - - params = find_dai_stream_params(codec, dai->id, substream->stream); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - mutex_unlock(&codec->lock); - return -EINVAL; - } - - bundle = to_gb_bundle(module->dev); - ret = gb_pm_runtime_get_sync(bundle); - if (ret) { - mutex_unlock(&codec->lock); - return ret; - } - - ret = gb_audio_apbridgea_set_config(data->connection, 0, - AUDIO_APBRIDGEA_PCM_FMT_16, - AUDIO_APBRIDGEA_PCM_RATE_48000, - 6144000); - if (ret) { - dev_err_ratelimited(dai->dev, "%d: Error during set_config\n", - ret); - mutex_unlock(&codec->lock); - return ret; - } - - gb_pm_runtime_put_noidle(bundle); - - if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) - sig_bits = dai->driver->playback.sig_bits; - else - sig_bits = dai->driver->capture.sig_bits; - - params->state = GBAUDIO_CODEC_HWPARAMS; - params->format = format; - params->rate = rate; - params->channels = channels; - params->sig_bits = sig_bits; - - mutex_unlock(&codec->lock); - return 0; -} - -static int gbcodec_prepare(struct snd_pcm_substream *substream, - struct snd_soc_dai *dai) -{ - int ret; - struct gbaudio_module_info *module; - struct gbaudio_data_connection *data; - struct gb_bundle *bundle; - struct gbaudio_codec_info *codec = dev_get_drvdata(dai->dev); - struct gbaudio_stream_params *params; - - mutex_lock(&codec->lock); - - if (list_empty(&codec->module_list)) { - dev_err(codec->dev, "No codec module available\n"); - mutex_unlock(&codec->lock); - return -ENODEV; - } - - list_for_each_entry(module, &codec->module_list, list) { - /* find the dai */ - data = find_data(module, dai->id); - if (data) - break; - } - if (!data) { - dev_err(dai->dev, "DATA connection missing\n"); - mutex_unlock(&codec->lock); - return -ENODEV; - } - - params = find_dai_stream_params(codec, dai->id, substream->stream); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - mutex_unlock(&codec->lock); - return -EINVAL; - } - - bundle = to_gb_bundle(module->dev); - ret = gb_pm_runtime_get_sync(bundle); - if (ret) { - mutex_unlock(&codec->lock); - return ret; - } - - switch (substream->stream) { - case SNDRV_PCM_STREAM_PLAYBACK: - ret = gb_audio_apbridgea_set_tx_data_size(data->connection, 0, - 192); - break; - case SNDRV_PCM_STREAM_CAPTURE: - ret = gb_audio_apbridgea_set_rx_data_size(data->connection, 0, - 192); - break; - } - if (ret) { - mutex_unlock(&codec->lock); - dev_err_ratelimited(dai->dev, "set_data_size failed:%d\n", - ret); - return ret; - } - - gb_pm_runtime_put_noidle(bundle); - - params->state = GBAUDIO_CODEC_PREPARE; - mutex_unlock(&codec->lock); - return 0; -} - -static int gbcodec_mute_stream(struct snd_soc_dai *dai, int mute, int stream) -{ - int ret; - struct gbaudio_data_connection *data; - struct gbaudio_module_info *module; - struct gb_bundle *bundle; - struct gbaudio_codec_info *codec = dev_get_drvdata(dai->dev); - struct gbaudio_stream_params *params; - - dev_dbg(dai->dev, "Mute:%d, Direction:%s\n", mute, - stream ? "CAPTURE" : "PLAYBACK"); - - mutex_lock(&codec->lock); - - params = find_dai_stream_params(codec, dai->id, stream); - if (!params) { - dev_err(codec->dev, "Failed to fetch dai_stream pointer\n"); - mutex_unlock(&codec->lock); - return -EINVAL; - } - - if (list_empty(&codec->module_list)) { - dev_err(codec->dev, "No codec module available\n"); - if (mute) { - params->state = GBAUDIO_CODEC_STOP; - ret = 0; - } else { - ret = -ENODEV; - } - mutex_unlock(&codec->lock); - return ret; - } - - list_for_each_entry(module, &codec->module_list, list) { - /* find the dai */ - data = find_data(module, dai->id); - if (data) - break; - } - if (!data) { - dev_err(dai->dev, "%s:%s DATA connection missing\n", - dai->name, module->name); - mutex_unlock(&codec->lock); - return -ENODEV; - } - - bundle = to_gb_bundle(module->dev); - ret = gb_pm_runtime_get_sync(bundle); - if (ret) { - mutex_unlock(&codec->lock); - return ret; - } - - if (!mute && !stream) {/* start playback */ - ret = gb_audio_apbridgea_prepare_tx(data->connection, - 0); - if (!ret) - ret = gb_audio_apbridgea_start_tx(data->connection, - 0, 0); - params->state = GBAUDIO_CODEC_START; - } else if (!mute && stream) {/* start capture */ - ret = gb_audio_apbridgea_prepare_rx(data->connection, - 0); - if (!ret) - ret = gb_audio_apbridgea_start_rx(data->connection, - 0); - params->state = GBAUDIO_CODEC_START; - } else if (mute && !stream) {/* stop playback */ - ret = gb_audio_apbridgea_stop_tx(data->connection, 0); - if (!ret) - ret = gb_audio_apbridgea_shutdown_tx(data->connection, - 0); - params->state = GBAUDIO_CODEC_STOP; - } else if (mute && stream) {/* stop capture */ - ret = gb_audio_apbridgea_stop_rx(data->connection, 0); - if (!ret) - ret = gb_audio_apbridgea_shutdown_rx(data->connection, - 0); - params->state = GBAUDIO_CODEC_STOP; - } else { - ret = -EINVAL; - } - - if (ret) - dev_err_ratelimited(dai->dev, - "%s:Error during %s %s stream:%d\n", - module->name, mute ? "Mute" : "Unmute", - stream ? "Capture" : "Playback", ret); - - gb_pm_runtime_put_noidle(bundle); - mutex_unlock(&codec->lock); - return ret; -} - -static const struct snd_soc_dai_ops gbcodec_dai_ops = { - .startup = gbcodec_startup, - .shutdown = gbcodec_shutdown, - .hw_params = gbcodec_hw_params, - .prepare = gbcodec_prepare, - .mute_stream = gbcodec_mute_stream, -}; - -static struct snd_soc_dai_driver gbaudio_dai[] = { - { - .name = "apb-i2s0", - .id = 0, - .playback = { - .stream_name = "I2S 0 Playback", - .rates = SNDRV_PCM_RATE_48000, - .formats = SNDRV_PCM_FORMAT_S16_LE, - .rate_max = 48000, - .rate_min = 48000, - .channels_min = 1, - .channels_max = 2, - .sig_bits = 16, - }, - .capture = { - .stream_name = "I2S 0 Capture", - .rates = SNDRV_PCM_RATE_48000, - .formats = SNDRV_PCM_FORMAT_S16_LE, - .rate_max = 48000, - .rate_min = 48000, - .channels_min = 1, - .channels_max = 2, - .sig_bits = 16, - }, - .ops = &gbcodec_dai_ops, - }, -}; - -static int gbaudio_init_jack(struct gbaudio_module_info *module, - struct snd_soc_codec *codec) -{ - int ret; - - if (!module->jack_mask) - return 0; - - snprintf(module->jack_name, NAME_SIZE, "GB %d Headset Jack", - module->dev_id); - ret = snd_soc_jack_new(codec, module->jack_name, module->jack_mask, - &module->headset_jack); - if (ret) { - dev_err(module->dev, "Failed to create new jack\n"); - return ret; - } - - if (!module->button_mask) - return 0; - - snprintf(module->button_name, NAME_SIZE, "GB %d Button Jack", - module->dev_id); - ret = snd_soc_jack_new(codec, module->button_name, module->button_mask, - &module->button_jack); - if (ret) { - dev_err(module->dev, "Failed to create button jack\n"); - return ret; - } - - /* - * Currently, max 4 buttons are supported with following key mapping - * BTN_0 = KEY_MEDIA - * BTN_1 = KEY_VOICECOMMAND - * BTN_2 = KEY_VOLUMEUP - * BTN_3 = KEY_VOLUMEDOWN - */ - - if (module->button_mask & SND_JACK_BTN_0) { - ret = snd_jack_set_key(module->button_jack.jack, SND_JACK_BTN_0, - KEY_MEDIA); - if (ret) { - dev_err(module->dev, "Failed to set BTN_0\n"); - return ret; - } - } - - if (module->button_mask & SND_JACK_BTN_1) { - ret = snd_jack_set_key(module->button_jack.jack, SND_JACK_BTN_1, - KEY_VOICECOMMAND); - if (ret) { - dev_err(module->dev, "Failed to set BTN_1\n"); - return ret; - } - } - - if (module->button_mask & SND_JACK_BTN_2) { - ret = snd_jack_set_key(module->button_jack.jack, SND_JACK_BTN_2, - KEY_VOLUMEUP); - if (ret) { - dev_err(module->dev, "Failed to set BTN_2\n"); - return ret; - } - } - - if (module->button_mask & SND_JACK_BTN_3) { - ret = snd_jack_set_key(module->button_jack.jack, SND_JACK_BTN_3, - KEY_VOLUMEDOWN); - if (ret) { - dev_err(module->dev, "Failed to set BTN_0\n"); - return ret; - } - } - - /* FIXME - * verify if this is really required - set_bit(INPUT_PROP_NO_DUMMY_RELEASE, - module->button_jack.jack->input_dev->propbit); - */ - - return 0; -} - -int gbaudio_register_module(struct gbaudio_module_info *module) -{ - int ret; - struct snd_soc_codec *codec; - struct snd_card *card; - struct snd_soc_jack *jack = NULL; - - if (!gbcodec) { - dev_err(module->dev, "GB Codec not yet probed\n"); - return -EAGAIN; - } - - codec = gbcodec->codec; - card = codec->card->snd_card; - - down_write(&card->controls_rwsem); - - if (module->num_dais) { - dev_err(gbcodec->dev, - "%d:DAIs not supported via gbcodec driver\n", - module->num_dais); - up_write(&card->controls_rwsem); - return -EINVAL; - } - - ret = gbaudio_init_jack(module, codec); - if (ret) { - up_write(&card->controls_rwsem); - return ret; - } - - if (module->dapm_widgets) - snd_soc_dapm_new_controls(&codec->dapm, module->dapm_widgets, - module->num_dapm_widgets); - if (module->controls) - snd_soc_add_codec_controls(codec, module->controls, - module->num_controls); - if (module->dapm_routes) - snd_soc_dapm_add_routes(&codec->dapm, module->dapm_routes, - module->num_dapm_routes); - - /* card already instantiated, create widgets here only */ - if (codec->card->instantiated) { - snd_soc_dapm_link_component_dai_widgets(codec->card, - &codec->dapm); -#ifdef CONFIG_SND_JACK - /* - * register jack devices for this module - * from codec->jack_list - */ - list_for_each_entry(jack, &codec->jack_list, list) { - if ((jack == &module->headset_jack) || - (jack == &module->button_jack)) - snd_device_register(codec->card->snd_card, - jack->jack); - } -#endif - } - - mutex_lock(&gbcodec->lock); - list_add(&module->list, &gbcodec->module_list); - mutex_unlock(&gbcodec->lock); - - if (codec->card->instantiated) - ret = snd_soc_dapm_new_widgets(&codec->dapm); - dev_dbg(codec->dev, "Registered %s module\n", module->name); - - up_write(&card->controls_rwsem); - return ret; -} -EXPORT_SYMBOL(gbaudio_register_module); - -static void gbaudio_codec_clean_data_tx(struct gbaudio_data_connection *data) -{ - u16 i2s_port, cportid; - int ret; - - if (list_is_singular(&gbcodec->module_list)) { - ret = gb_audio_apbridgea_stop_tx(data->connection, 0); - if (ret) - return; - ret = gb_audio_apbridgea_shutdown_tx(data->connection, - 0); - if (ret) - return; - } - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_unregister_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_TX); - data->state[0] = GBAUDIO_CODEC_SHUTDOWN; -} - -static void gbaudio_codec_clean_data_rx(struct gbaudio_data_connection *data) -{ - u16 i2s_port, cportid; - int ret; - - if (list_is_singular(&gbcodec->module_list)) { - ret = gb_audio_apbridgea_stop_rx(data->connection, 0); - if (ret) - return; - ret = gb_audio_apbridgea_shutdown_rx(data->connection, - 0); - if (ret) - return; - } - i2s_port = 0; /* fixed for now */ - cportid = data->connection->hd_cport_id; - ret = gb_audio_apbridgea_unregister_cport(data->connection, - i2s_port, cportid, - AUDIO_APBRIDGEA_DIRECTION_RX); - data->state[1] = GBAUDIO_CODEC_SHUTDOWN; -} - -static void gbaudio_codec_cleanup(struct gbaudio_module_info *module) -{ - struct gbaudio_data_connection *data; - int pb_state, cap_state; - - dev_dbg(gbcodec->dev, "%s: removed, cleanup APBridge\n", module->name); - list_for_each_entry(data, &module->data_list, list) { - pb_state = data->state[0]; - cap_state = data->state[1]; - - if (pb_state > GBAUDIO_CODEC_SHUTDOWN) - gbaudio_codec_clean_data_tx(data); - - if (cap_state > GBAUDIO_CODEC_SHUTDOWN) - gbaudio_codec_clean_data_rx(data); - } -} - -void gbaudio_unregister_module(struct gbaudio_module_info *module) -{ - struct snd_soc_codec *codec = gbcodec->codec; - struct snd_card *card = codec->card->snd_card; - struct snd_soc_jack *jack, *next_j; - int mask; - - dev_dbg(codec->dev, "Unregister %s module\n", module->name); - - down_write(&card->controls_rwsem); - mutex_lock(&gbcodec->lock); - gbaudio_codec_cleanup(module); - list_del(&module->list); - dev_dbg(codec->dev, "Process Unregister %s module\n", module->name); - mutex_unlock(&gbcodec->lock); - -#ifdef CONFIG_SND_JACK - /* free jack devices for this module from codec->jack_list */ - list_for_each_entry_safe(jack, next_j, &codec->jack_list, list) { - if (jack == &module->headset_jack) - mask = GBCODEC_JACK_MASK; - else if (jack == &module->button_jack) - mask = GBCODEC_JACK_BUTTON_MASK; - else - mask = 0; - if (mask) { - dev_dbg(module->dev, "Report %s removal\n", - jack->jack->id); - snd_soc_jack_report(jack, 0, mask); - snd_device_free(codec->card->snd_card, jack->jack); - list_del(&jack->list); - } - } -#endif - - if (module->dapm_routes) { - dev_dbg(codec->dev, "Removing %d routes\n", - module->num_dapm_routes); - snd_soc_dapm_del_routes(&codec->dapm, module->dapm_routes, - module->num_dapm_routes); - } - if (module->controls) { - dev_dbg(codec->dev, "Removing %d controls\n", - module->num_controls); - snd_soc_remove_codec_controls(codec, module->controls, - module->num_controls); - } - if (module->dapm_widgets) { - dev_dbg(codec->dev, "Removing %d widgets\n", - module->num_dapm_widgets); - snd_soc_dapm_free_controls(&codec->dapm, module->dapm_widgets, - module->num_dapm_widgets); - } - - dev_dbg(codec->dev, "Unregistered %s module\n", module->name); - - up_write(&card->controls_rwsem); -} -EXPORT_SYMBOL(gbaudio_unregister_module); - -/* - * codec driver ops - */ -static int gbcodec_probe(struct snd_soc_codec *codec) -{ - int i; - struct gbaudio_codec_info *info; - struct gbaudio_codec_dai *dai; - - info = devm_kzalloc(codec->dev, sizeof(*info), GFP_KERNEL); - if (!info) - return -ENOMEM; - - info->dev = codec->dev; - INIT_LIST_HEAD(&info->module_list); - mutex_init(&info->lock); - INIT_LIST_HEAD(&info->dai_list); - - /* init dai_list used to maintain runtime stream info */ - for (i = 0; i < ARRAY_SIZE(gbaudio_dai); i++) { - dai = devm_kzalloc(codec->dev, sizeof(*dai), GFP_KERNEL); - if (!dai) - return -ENOMEM; - dai->id = gbaudio_dai[i].id; - list_add(&dai->list, &info->dai_list); - } - - info->codec = codec; - snd_soc_codec_set_drvdata(codec, info); - gbcodec = info; - - device_init_wakeup(codec->dev, 1); - return 0; -} - -static int gbcodec_remove(struct snd_soc_codec *codec) -{ - /* Empty function for now */ - return 0; -} - -static int gbcodec_write(struct snd_soc_codec *codec, unsigned int reg, - unsigned int value) -{ - return 0; -} - -static unsigned int gbcodec_read(struct snd_soc_codec *codec, - unsigned int reg) -{ - return 0; -} - -static struct snd_soc_codec_driver soc_codec_dev_gbaudio = { - .probe = gbcodec_probe, - .remove = gbcodec_remove, - - .read = gbcodec_read, - .write = gbcodec_write, - - .idle_bias_off = true, - .ignore_pmdown_time = 1, -}; - -#ifdef CONFIG_PM -static int gbaudio_codec_suspend(struct device *dev) -{ - dev_dbg(dev, "%s: suspend\n", __func__); - return 0; -} - -static int gbaudio_codec_resume(struct device *dev) -{ - dev_dbg(dev, "%s: resume\n", __func__); - return 0; -} - -static const struct dev_pm_ops gbaudio_codec_pm_ops = { - .suspend = gbaudio_codec_suspend, - .resume = gbaudio_codec_resume, -}; -#endif - -static int gbaudio_codec_probe(struct platform_device *pdev) -{ - return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_gbaudio, - gbaudio_dai, ARRAY_SIZE(gbaudio_dai)); -} - -static int gbaudio_codec_remove(struct platform_device *pdev) -{ - snd_soc_unregister_codec(&pdev->dev); - return 0; -} - -static const struct of_device_id greybus_asoc_machine_of_match[] = { - { .compatible = "toshiba,apb-dummy-codec", }, - {}, -}; - -static struct platform_driver gbaudio_codec_driver = { - .driver = { - .name = "apb-dummy-codec", -#ifdef CONFIG_PM - .pm = &gbaudio_codec_pm_ops, -#endif - .of_match_table = greybus_asoc_machine_of_match, - }, - .probe = gbaudio_codec_probe, - .remove = gbaudio_codec_remove, -}; -module_platform_driver(gbaudio_codec_driver); - -MODULE_DESCRIPTION("APBridge ALSA SoC dummy codec driver"); -MODULE_AUTHOR("Vaibhav Agarwal <vaibhav.agarwal(a)linaro.org>"); -MODULE_LICENSE("GPL v2"); -MODULE_ALIAS("platform:apb-dummy-codec"); diff --git a/drivers/staging/greybus/audio_module.c b/drivers/staging/greybus/audio_module.c deleted file mode 100644 index 300a2b4f3fc7..000000000000 --- a/drivers/staging/greybus/audio_module.c +++ /dev/null @@ -1,478 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0 -/* - * Greybus audio driver - * Copyright 2015 Google Inc. - * Copyright 2015 Linaro Ltd. - */ -#include <linux/kernel.h> -#include <linux/module.h> -#include <sound/soc.h> -#include <sound/pcm_params.h> - -#include "audio_codec.h" -#include "audio_apbridgea.h" -#include "audio_manager.h" - -/* - * gb_snd management functions - */ - -static int gbaudio_request_jack(struct gbaudio_module_info *module, - struct gb_audio_jack_event_request *req) -{ - int report; - struct snd_jack *jack = module->headset_jack.jack; - struct snd_jack *btn_jack = module->button_jack.jack; - - if (!jack) { - dev_err_ratelimited(module->dev, - "Invalid jack event received:type: %u, event: %u\n", - req->jack_attribute, req->event); - return -EINVAL; - } - - dev_warn_ratelimited(module->dev, - "Jack Event received: type: %u, event: %u\n", - req->jack_attribute, req->event); - - if (req->event == GB_AUDIO_JACK_EVENT_REMOVAL) { - module->jack_type = 0; - if (btn_jack && module->button_status) { - snd_soc_jack_report(&module->button_jack, 0, - module->button_mask); - module->button_status = 0; - } - snd_soc_jack_report(&module->headset_jack, 0, - module->jack_mask); - return 0; - } - - report = req->jack_attribute & module->jack_mask; - if (!report) { - dev_err_ratelimited(module->dev, - "Invalid jack event received:type: %u, event: %u\n", - req->jack_attribute, req->event); - return -EINVAL; - } - - if (module->jack_type) - dev_warn_ratelimited(module->dev, - "Modifying jack from %d to %d\n", - module->jack_type, report); - - module->jack_type = report; - snd_soc_jack_report(&module->headset_jack, report, module->jack_mask); - - return 0; -} - -static int gbaudio_request_button(struct gbaudio_module_info *module, - struct gb_audio_button_event_request *req) -{ - int soc_button_id, report; - struct snd_jack *btn_jack = module->button_jack.jack; - - if (!btn_jack) { - dev_err_ratelimited(module->dev, - "Invalid button event received:type: %u, event: %u\n", - req->button_id, req->event); - return -EINVAL; - } - - dev_warn_ratelimited(module->dev, - "Button Event received: id: %u, event: %u\n", - req->button_id, req->event); - - /* currently supports 4 buttons only */ - if (!module->jack_type) { - dev_err_ratelimited(module->dev, - "Jack not present. Bogus event!!\n"); - return -EINVAL; - } - - report = module->button_status & module->button_mask; - soc_button_id = 0; - - switch (req->button_id) { - case 1: - soc_button_id = SND_JACK_BTN_0 & module->button_mask; - break; - - case 2: - soc_button_id = SND_JACK_BTN_1 & module->button_mask; - break; - - case 3: - soc_button_id = SND_JACK_BTN_2 & module->button_mask; - break; - - case 4: - soc_button_id = SND_JACK_BTN_3 & module->button_mask; - break; - } - - if (!soc_button_id) { - dev_err_ratelimited(module->dev, - "Invalid button request received\n"); - return -EINVAL; - } - - if (req->event == GB_AUDIO_BUTTON_EVENT_PRESS) - report = report | soc_button_id; - else - report = report & ~soc_button_id; - - module->button_status = report; - - snd_soc_jack_report(&module->button_jack, report, module->button_mask); - - return 0; -} - -static int gbaudio_request_stream(struct gbaudio_module_info *module, - struct gb_audio_streaming_event_request *req) -{ - dev_warn(module->dev, "Audio Event received: cport: %u, event: %u\n", - le16_to_cpu(req->data_cport), req->event); - - return 0; -} - -static int gbaudio_codec_request_handler(struct gb_operation *op) -{ - struct gb_connection *connection = op->connection; - struct gbaudio_module_info *module = - greybus_get_drvdata(connection->bundle); - struct gb_operation_msg_hdr *header = op->request->header; - struct gb_audio_streaming_event_request *stream_req; - struct gb_audio_jack_event_request *jack_req; - struct gb_audio_button_event_request *button_req; - int ret; - - switch (header->type) { - case GB_AUDIO_TYPE_STREAMING_EVENT: - stream_req = op->request->payload; - ret = gbaudio_request_stream(module, stream_req); - break; - - case GB_AUDIO_TYPE_JACK_EVENT: - jack_req = op->request->payload; - ret = gbaudio_request_jack(module, jack_req); - break; - - case GB_AUDIO_TYPE_BUTTON_EVENT: - button_req = op->request->payload; - ret = gbaudio_request_button(module, button_req); - break; - - default: - dev_err_ratelimited(&connection->bundle->dev, - "Invalid Audio Event received\n"); - return -EINVAL; - } - - return ret; -} - -static int gb_audio_add_mgmt_connection(struct gbaudio_module_info *gbmodule, - struct greybus_descriptor_cport *cport_desc, - struct gb_bundle *bundle) -{ - struct gb_connection *connection; - - /* Management Cport */ - if (gbmodule->mgmt_connection) { - dev_err(&bundle->dev, - "Can't have multiple Management connections\n"); - return -ENODEV; - } - - connection = gb_connection_create(bundle, le16_to_cpu(cport_desc->id), - gbaudio_codec_request_handler); - if (IS_ERR(connection)) - return PTR_ERR(connection); - - greybus_set_drvdata(bundle, gbmodule); - gbmodule->mgmt_connection = connection; - - return 0; -} - -static int gb_audio_add_data_connection(struct gbaudio_module_info *gbmodule, - struct greybus_descriptor_cport *cport_desc, - struct gb_bundle *bundle) -{ - struct gb_connection *connection; - struct gbaudio_data_connection *dai; - - dai = devm_kzalloc(gbmodule->dev, sizeof(*dai), GFP_KERNEL); - if (!dai) - return -ENOMEM; - - connection = gb_connection_create_offloaded(bundle, - le16_to_cpu(cport_desc->id), - GB_CONNECTION_FLAG_CSD); - if (IS_ERR(connection)) { - devm_kfree(gbmodule->dev, dai); - return PTR_ERR(connection); - } - - greybus_set_drvdata(bundle, gbmodule); - dai->id = 0; - dai->data_cport = connection->intf_cport_id; - dai->connection = connection; - list_add(&dai->list, &gbmodule->data_list); - - return 0; -} - -/* - * This is the basic hook get things initialized and registered w/ gb - */ - -static int gb_audio_probe(struct gb_bundle *bundle, - const struct greybus_bundle_id *id) -{ - struct device *dev = &bundle->dev; - struct gbaudio_module_info *gbmodule; - struct greybus_descriptor_cport *cport_desc; - struct gb_audio_manager_module_descriptor desc; - struct gbaudio_data_connection *dai, *_dai; - int ret, i; - struct gb_audio_topology *topology; - - /* There should be at least one Management and one Data cport */ - if (bundle->num_cports < 2) - return -ENODEV; - - /* - * There can be only one Management connection and any number of data - * connections. - */ - gbmodule = devm_kzalloc(dev, sizeof(*gbmodule), GFP_KERNEL); - if (!gbmodule) - return -ENOMEM; - - gbmodule->num_data_connections = bundle->num_cports - 1; - INIT_LIST_HEAD(&gbmodule->data_list); - INIT_LIST_HEAD(&gbmodule->widget_list); - INIT_LIST_HEAD(&gbmodule->ctl_list); - INIT_LIST_HEAD(&gbmodule->widget_ctl_list); - gbmodule->dev = dev; - snprintf(gbmodule->name, NAME_SIZE, "%s.%s", dev->driver->name, - dev_name(dev)); - greybus_set_drvdata(bundle, gbmodule); - - /* Create all connections */ - for (i = 0; i < bundle->num_cports; i++) { - cport_desc = &bundle->cport_desc[i]; - - switch (cport_desc->protocol_id) { - case GREYBUS_PROTOCOL_AUDIO_MGMT: - ret = gb_audio_add_mgmt_connection(gbmodule, cport_desc, - bundle); - if (ret) - goto destroy_connections; - break; - case GREYBUS_PROTOCOL_AUDIO_DATA: - ret = gb_audio_add_data_connection(gbmodule, cport_desc, - bundle); - if (ret) - goto destroy_connections; - break; - default: - dev_err(dev, "Unsupported protocol: 0x%02x\n", - cport_desc->protocol_id); - ret = -ENODEV; - goto destroy_connections; - } - } - - /* There must be a management cport */ - if (!gbmodule->mgmt_connection) { - ret = -EINVAL; - dev_err(dev, "Missing management connection\n"); - goto destroy_connections; - } - - /* Initialize management connection */ - ret = gb_connection_enable(gbmodule->mgmt_connection); - if (ret) { - dev_err(dev, "%d: Error while enabling mgmt connection\n", ret); - goto destroy_connections; - } - gbmodule->dev_id = gbmodule->mgmt_connection->intf->interface_id; - - /* - * FIXME: malloc for topology happens via audio_gb driver - * should be done within codec driver itself - */ - ret = gb_audio_gb_get_topology(gbmodule->mgmt_connection, &topology); - if (ret) { - dev_err(dev, "%d:Error while fetching topology\n", ret); - goto disable_connection; - } - - /* process topology data */ - ret = gbaudio_tplg_parse_data(gbmodule, topology); - if (ret) { - dev_err(dev, "%d:Error while parsing topology data\n", - ret); - goto free_topology; - } - gbmodule->topology = topology; - - /* Initialize data connections */ - list_for_each_entry(dai, &gbmodule->data_list, list) { - ret = gb_connection_enable(dai->connection); - if (ret) { - dev_err(dev, - "%d:Error while enabling %d:data connection\n", - ret, dai->data_cport); - goto disable_data_connection; - } - } - - /* register module with gbcodec */ - ret = gbaudio_register_module(gbmodule); - if (ret) - goto disable_data_connection; - - /* inform above layer for uevent */ - dev_dbg(dev, "Inform set_event:%d to above layer\n", 1); - /* prepare for the audio manager */ - strlcpy(desc.name, gbmodule->name, GB_AUDIO_MANAGER_MODULE_NAME_LEN); - desc.vid = 2; /* todo */ - desc.pid = 3; /* todo */ - desc.intf_id = gbmodule->dev_id; - desc.op_devices = gbmodule->op_devices; - desc.ip_devices = gbmodule->ip_devices; - gbmodule->manager_id = gb_audio_manager_add(&desc); - - dev_dbg(dev, "Add GB Audio device:%s\n", gbmodule->name); - - gb_pm_runtime_put_autosuspend(bundle); - - return 0; - -disable_data_connection: - list_for_each_entry_safe(dai, _dai, &gbmodule->data_list, list) - gb_connection_disable(dai->connection); - gbaudio_tplg_release(gbmodule); - gbmodule->topology = NULL; - -free_topology: - kfree(topology); - -disable_connection: - gb_connection_disable(gbmodule->mgmt_connection); - -destroy_connections: - list_for_each_entry_safe(dai, _dai, &gbmodule->data_list, list) { - gb_connection_destroy(dai->connection); - list_del(&dai->list); - devm_kfree(dev, dai); - } - - if (gbmodule->mgmt_connection) - gb_connection_destroy(gbmodule->mgmt_connection); - - devm_kfree(dev, gbmodule); - - return ret; -} - -static void gb_audio_disconnect(struct gb_bundle *bundle) -{ - struct gbaudio_module_info *gbmodule = greybus_get_drvdata(bundle); - struct gbaudio_data_connection *dai, *_dai; - - gb_pm_runtime_get_sync(bundle); - - /* cleanup module related resources first */ - gbaudio_unregister_module(gbmodule); - - /* inform uevent to above layers */ - gb_audio_manager_remove(gbmodule->manager_id); - - gbaudio_tplg_release(gbmodule); - kfree(gbmodule->topology); - gbmodule->topology = NULL; - gb_connection_disable(gbmodule->mgmt_connection); - list_for_each_entry_safe(dai, _dai, &gbmodule->data_list, list) { - gb_connection_disable(dai->connection); - gb_connection_destroy(dai->connection); - list_del(&dai->list); - devm_kfree(gbmodule->dev, dai); - } - gb_connection_destroy(gbmodule->mgmt_connection); - gbmodule->mgmt_connection = NULL; - - devm_kfree(&bundle->dev, gbmodule); -} - -static const struct greybus_bundle_id gb_audio_id_table[] = { - { GREYBUS_DEVICE_CLASS(GREYBUS_CLASS_AUDIO) }, - { } -}; -MODULE_DEVICE_TABLE(greybus, gb_audio_id_table); - -#ifdef CONFIG_PM -static int gb_audio_suspend(struct device *dev) -{ - struct gb_bundle *bundle = to_gb_bundle(dev); - struct gbaudio_module_info *gbmodule = greybus_get_drvdata(bundle); - struct gbaudio_data_connection *dai; - - list_for_each_entry(dai, &gbmodule->data_list, list) - gb_connection_disable(dai->connection); - - gb_connection_disable(gbmodule->mgmt_connection); - - return 0; -} - -static int gb_audio_resume(struct device *dev) -{ - struct gb_bundle *bundle = to_gb_bundle(dev); - struct gbaudio_module_info *gbmodule = greybus_get_drvdata(bundle); - struct gbaudio_data_connection *dai; - int ret; - - ret = gb_connection_enable(gbmodule->mgmt_connection); - if (ret) { - dev_err(dev, "%d:Error while enabling mgmt connection\n", ret); - return ret; - } - - list_for_each_entry(dai, &gbmodule->data_list, list) { - ret = gb_connection_enable(dai->connection); - if (ret) { - dev_err(dev, - "%d:Error while enabling %d:data connection\n", - ret, dai->data_cport); - return ret; - } - } - - return 0; -} -#endif - -static const struct dev_pm_ops gb_audio_pm_ops = { - SET_RUNTIME_PM_OPS(gb_audio_suspend, gb_audio_resume, NULL) -}; - -static struct greybus_driver gb_audio_driver = { - .name = "gb-audio", - .probe = gb_audio_probe, - .disconnect = gb_audio_disconnect, - .id_table = gb_audio_id_table, - .driver.pm = &gb_audio_pm_ops, -}; -module_greybus_driver(gb_audio_driver); - -MODULE_DESCRIPTION("Greybus Audio module driver"); -MODULE_AUTHOR("Vaibhav Agarwal <vaibhav.agarwal(a)linaro.org>"); -MODULE_LICENSE("GPL v2"); -MODULE_ALIAS("platform:gbaudio-module"); diff --git a/drivers/staging/greybus/audio_topology.c b/drivers/staging/greybus/audio_topology.c deleted file mode 100644 index 4ac30accf226..000000000000 --- a/drivers/staging/greybus/audio_topology.c +++ /dev/null @@ -1,1448 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0 -/* - * Greybus audio driver - * Copyright 2015-2016 Google Inc. - * Copyright 2015-2016 Linaro Ltd. - */ - -#include "audio_codec.h" -#include "greybus_protocols.h" - -#define GBAUDIO_INVALID_ID 0xFF - -/* mixer control */ -struct gb_mixer_control { - int min, max; - unsigned int reg, rreg, shift, rshift, invert; -}; - -struct gbaudio_ctl_pvt { - unsigned int ctl_id; - unsigned int data_cport; - unsigned int access; - unsigned int vcount; - struct gb_audio_ctl_elem_info *info; -}; - -static struct gbaudio_module_info *find_gb_module( - struct gbaudio_codec_info *codec, - char const *name) -{ - int dev_id, ret; - char begin[NAME_SIZE]; - struct gbaudio_module_info *module; - - if (!name) - return NULL; - - ret = sscanf(name, "%s %d", begin, &dev_id); - dev_dbg(codec->dev, "%s:Find module#%d\n", __func__, dev_id); - - mutex_lock(&codec->lock); - list_for_each_entry(module, &codec->module_list, list) { - if (module->dev_id == dev_id) { - mutex_unlock(&codec->lock); - return module; - } - } - mutex_unlock(&codec->lock); - dev_warn(codec->dev, "%s: module#%d missing in codec list\n", name, - dev_id); - return NULL; -} - -static const char *gbaudio_map_controlid(struct gbaudio_module_info *module, - __u8 control_id, __u8 index) -{ - struct gbaudio_control *control; - - if (control_id == GBAUDIO_INVALID_ID) - return NULL; - - list_for_each_entry(control, &module->ctl_list, list) { - if (control->id == control_id) { - if (index == GBAUDIO_INVALID_ID) - return control->name; - if (index >= control->items) - return NULL; - return control->texts[index]; - } - } - list_for_each_entry(control, &module->widget_ctl_list, list) { - if (control->id == control_id) { - if (index == GBAUDIO_INVALID_ID) - return control->name; - if (index >= control->items) - return NULL; - return control->texts[index]; - } - } - return NULL; -} - -static int gbaudio_map_controlname(struct gbaudio_module_info *module, - const char *name) -{ - struct gbaudio_control *control; - - list_for_each_entry(control, &module->ctl_list, list) { - if (!strncmp(control->name, name, NAME_SIZE)) - return control->id; - } - - dev_warn(module->dev, "%s: missing in modules controls list\n", name); - - return -EINVAL; -} - -static int gbaudio_map_wcontrolname(struct gbaudio_module_info *module, - const char *name) -{ - struct gbaudio_control *control; - - list_for_each_entry(control, &module->widget_ctl_list, list) { - if (!strncmp(control->wname, name, NAME_SIZE)) - return control->id; - } - dev_warn(module->dev, "%s: missing in modules controls list\n", name); - - return -EINVAL; -} - -static int gbaudio_map_widgetname(struct gbaudio_module_info *module, - const char *name) -{ - struct gbaudio_widget *widget; - - list_for_each_entry(widget, &module->widget_list, list) { - if (!strncmp(widget->name, name, NAME_SIZE)) - return widget->id; - } - dev_warn(module->dev, "%s: missing in modules widgets list\n", name); - - return -EINVAL; -} - -static const char *gbaudio_map_widgetid(struct gbaudio_module_info *module, - __u8 widget_id) -{ - struct gbaudio_widget *widget; - - list_for_each_entry(widget, &module->widget_list, list) { - if (widget->id == widget_id) - return widget->name; - } - return NULL; -} - -static const char **gb_generate_enum_strings(struct gbaudio_module_info *gb, - struct gb_audio_enumerated *gbenum) -{ - const char **strings; - int i; - unsigned int items; - __u8 *data; - - items = le32_to_cpu(gbenum->items); - strings = devm_kcalloc(gb->dev, items, sizeof(char *), GFP_KERNEL); - data = gbenum->names; - - for (i = 0; i < items; i++) { - strings[i] = (const char *)data; - while (*data != '\0') - data++; - data++; - } - - return strings; -} - -static int gbcodec_mixer_ctl_info(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_info *uinfo) -{ - unsigned int max; - const char *name; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_info *info; - struct gbaudio_module_info *module; - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct gbaudio_codec_info *gbcodec = snd_soc_codec_get_drvdata(codec); - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - - if (!info) { - dev_err(codec->dev, "NULL info for %s\n", uinfo->id.name); - return -EINVAL; - } - - /* update uinfo */ - uinfo->access = data->access; - uinfo->count = data->vcount; - uinfo->type = (snd_ctl_elem_type_t)info->type; - - switch (info->type) { - case GB_AUDIO_CTL_ELEM_TYPE_BOOLEAN: - case GB_AUDIO_CTL_ELEM_TYPE_INTEGER: - uinfo->value.integer.min = le32_to_cpu(info->value.integer.min); - uinfo->value.integer.max = le32_to_cpu(info->value.integer.max); - break; - case GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED: - max = le32_to_cpu(info->value.enumerated.items); - uinfo->value.enumerated.items = max; - if (uinfo->value.enumerated.item > max - 1) - uinfo->value.enumerated.item = max - 1; - module = find_gb_module(gbcodec, kcontrol->id.name); - if (!module) - return -EINVAL; - name = gbaudio_map_controlid(module, data->ctl_id, - uinfo->value.enumerated.item); - strlcpy(uinfo->value.enumerated.name, name, NAME_SIZE); - break; - default: - dev_err(codec->dev, "Invalid type: %d for %s:kcontrol\n", - info->type, kcontrol->id.name); - break; - } - return 0; -} - -static int gbcodec_mixer_ctl_get(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret; - struct gb_audio_ctl_elem_info *info; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_get_control(module->mgmt_connection, data->ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - - /* update ucontrol */ - switch (info->type) { - case GB_AUDIO_CTL_ELEM_TYPE_BOOLEAN: - case GB_AUDIO_CTL_ELEM_TYPE_INTEGER: - ucontrol->value.integer.value[0] = - le32_to_cpu(gbvalue.value.integer_value[0]); - if (data->vcount == 2) - ucontrol->value.integer.value[1] = - le32_to_cpu(gbvalue.value.integer_value[1]); - break; - case GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED: - ucontrol->value.enumerated.item[0] = - le32_to_cpu(gbvalue.value.enumerated_item[0]); - if (data->vcount == 2) - ucontrol->value.enumerated.item[1] = - le32_to_cpu(gbvalue.value.enumerated_item[1]); - break; - default: - dev_err(codec->dev, "Invalid type: %d for %s:kcontrol\n", - info->type, kcontrol->id.name); - ret = -EINVAL; - break; - } - return ret; -} - -static int gbcodec_mixer_ctl_put(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret = 0; - struct gb_audio_ctl_elem_info *info; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - bundle = to_gb_bundle(module->dev); - - /* update ucontrol */ - switch (info->type) { - case GB_AUDIO_CTL_ELEM_TYPE_BOOLEAN: - case GB_AUDIO_CTL_ELEM_TYPE_INTEGER: - gbvalue.value.integer_value[0] = - cpu_to_le32(ucontrol->value.integer.value[0]); - if (data->vcount == 2) - gbvalue.value.integer_value[1] = - cpu_to_le32(ucontrol->value.integer.value[1]); - break; - case GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED: - gbvalue.value.enumerated_item[0] = - cpu_to_le32(ucontrol->value.enumerated.item[0]); - if (data->vcount == 2) - gbvalue.value.enumerated_item[1] = - cpu_to_le32(ucontrol->value.enumerated.item[1]); - break; - default: - dev_err(codec->dev, "Invalid type: %d for %s:kcontrol\n", - info->type, kcontrol->id.name); - ret = -EINVAL; - break; - } - - if (ret) - return ret; - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_set_control(module->mgmt_connection, data->ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - } - - return ret; -} - -#define SOC_MIXER_GB(xname, kcount, data) \ -{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ - .count = kcount, .info = gbcodec_mixer_ctl_info, \ - .get = gbcodec_mixer_ctl_get, .put = gbcodec_mixer_ctl_put, \ - .private_value = (unsigned long)data } - -/* - * although below callback functions seems redundant to above functions. - * same are kept to allow provision for different handling in case - * of DAPM related sequencing, etc. - */ -static int gbcodec_mixer_dapm_ctl_info(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_info *uinfo) -{ - int platform_max, platform_min; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_info *info; - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *widget = wlist->widgets[0]; - struct snd_soc_codec *codec = widget->codec; - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - - /* update uinfo */ - platform_max = le32_to_cpu(info->value.integer.max); - platform_min = le32_to_cpu(info->value.integer.min); - - if (platform_max == 1 && - !strnstr(kcontrol->id.name, " Volume", NAME_SIZE)) - uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; - else - uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; - - uinfo->count = data->vcount; - uinfo->value.integer.min = platform_min; - uinfo->value.integer.max = platform_max; - - return 0; -} - -static int gbcodec_mixer_dapm_ctl_get(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret; - struct gb_audio_ctl_elem_info *info; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *widget = wlist->widgets[0]; - struct snd_soc_codec *codec = widget->codec; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - bundle = to_gb_bundle(module->dev); - - if (data->vcount == 2) - dev_warn(widget->dapm->dev, - "GB: Control '%s' is stereo, which is not supported\n", - kcontrol->id.name); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_get_control(module->mgmt_connection, data->ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - /* update ucontrol */ - ucontrol->value.integer.value[0] = - le32_to_cpu(gbvalue.value.integer_value[0]); - - return ret; -} - -static int gbcodec_mixer_dapm_ctl_put(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret, wi, max, connect; - unsigned int mask, val; - struct gb_audio_ctl_elem_info *info; - struct gbaudio_ctl_pvt *data; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *widget = wlist->widgets[0]; - struct snd_soc_codec *codec = widget->codec; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - dev_dbg(codec->dev, "Entered %s:%s\n", __func__, kcontrol->id.name); - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - data = (struct gbaudio_ctl_pvt *)kcontrol->private_value; - info = (struct gb_audio_ctl_elem_info *)data->info; - bundle = to_gb_bundle(module->dev); - - if (data->vcount == 2) - dev_warn(widget->dapm->dev, - "GB: Control '%s' is stereo, which is not supported\n", - kcontrol->id.name); - - max = le32_to_cpu(info->value.integer.max); - mask = (1 << fls(max)) - 1; - val = ucontrol->value.integer.value[0] & mask; - connect = !!val; - - /* update ucontrol */ - if (gbvalue.value.integer_value[0] != val) { - for (wi = 0; wi < wlist->num_widgets; wi++) { - widget = wlist->widgets[wi]; - - widget->value = val; - widget->dapm->update = NULL; - snd_soc_dapm_mixer_update_power(widget, kcontrol, - connect); - } - gbvalue.value.integer_value[0] = - cpu_to_le32(ucontrol->value.integer.value[0]); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_set_control(module->mgmt_connection, - data->ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, - "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - } - - return 0; -} - -#define SOC_DAPM_MIXER_GB(xname, kcount, data) \ -{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ - .count = kcount, .info = gbcodec_mixer_dapm_ctl_info, \ - .get = gbcodec_mixer_dapm_ctl_get, .put = gbcodec_mixer_dapm_ctl_put, \ - .private_value = (unsigned long)data} - -static int gbcodec_event_spk(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *k, int event) -{ - /* Ensure GB speaker is connected */ - - return 0; -} - -static int gbcodec_event_hp(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *k, int event) -{ - /* Ensure GB module supports jack slot */ - - return 0; -} - -static int gbcodec_event_int_mic(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *k, int event) -{ - /* Ensure GB module supports jack slot */ - - return 0; -} - -static int gbaudio_validate_kcontrol_count(struct gb_audio_widget *w) -{ - int ret = 0; - - switch (w->type) { - case snd_soc_dapm_spk: - case snd_soc_dapm_hp: - case snd_soc_dapm_mic: - case snd_soc_dapm_output: - case snd_soc_dapm_input: - if (w->ncontrols) - ret = -EINVAL; - break; - case snd_soc_dapm_switch: - case snd_soc_dapm_mux: - if (w->ncontrols != 1) - ret = -EINVAL; - break; - default: - break; - } - - return ret; -} - -static int gbcodec_enum_ctl_get(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret, ctl_id; - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - ctl_id = gbaudio_map_controlname(module, kcontrol->id.name); - if (ctl_id < 0) - return -EINVAL; - - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_get_control(module->mgmt_connection, ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - - ucontrol->value.enumerated.item[0] = - le32_to_cpu(gbvalue.value.enumerated_item[0]); - if (e->shift_l != e->shift_r) - ucontrol->value.enumerated.item[1] = - le32_to_cpu(gbvalue.value.enumerated_item[1]); - - return 0; -} - -static int gbcodec_enum_ctl_put(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret, ctl_id; - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct gb_bundle *bundle; - - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - ctl_id = gbaudio_map_controlname(module, kcontrol->id.name); - if (ctl_id < 0) - return -EINVAL; - - if (ucontrol->value.enumerated.item[0] > e->max - 1) - return -EINVAL; - gbvalue.value.enumerated_item[0] = - cpu_to_le32(ucontrol->value.enumerated.item[0]); - - if (e->shift_l != e->shift_r) { - if (ucontrol->value.enumerated.item[1] > e->max - 1) - return -EINVAL; - gbvalue.value.enumerated_item[1] = - cpu_to_le32(ucontrol->value.enumerated.item[1]); - } - - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_set_control(module->mgmt_connection, ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - } - - return ret; -} - -static int gbaudio_tplg_create_enum_kctl(struct gbaudio_module_info *gb, - struct snd_kcontrol_new *kctl, - struct gb_audio_control *ctl) -{ - struct soc_enum *gbe; - struct gb_audio_enumerated *gb_enum; - int i; - - gbe = devm_kzalloc(gb->dev, sizeof(*gbe), GFP_KERNEL); - if (!gbe) - return -ENOMEM; - - gb_enum = &ctl->info.value.enumerated; - - /* since count=1, and reg is dummy */ - gbe->max = le32_to_cpu(gb_enum->items); - gbe->texts = gb_generate_enum_strings(gb, gb_enum); - - /* debug enum info */ - dev_dbg(gb->dev, "Max:%d, name_length:%d\n", gbe->max, - le16_to_cpu(gb_enum->names_length)); - for (i = 0; i < gbe->max; i++) - dev_dbg(gb->dev, "src[%d]: %s\n", i, gbe->texts[i]); - - *kctl = (struct snd_kcontrol_new) - SOC_ENUM_EXT(ctl->name, *gbe, gbcodec_enum_ctl_get, - gbcodec_enum_ctl_put); - return 0; -} - -static int gbaudio_tplg_create_kcontrol(struct gbaudio_module_info *gb, - struct snd_kcontrol_new *kctl, - struct gb_audio_control *ctl) -{ - int ret = 0; - struct gbaudio_ctl_pvt *ctldata; - - switch (ctl->iface) { - case SNDRV_CTL_ELEM_IFACE_MIXER: - switch (ctl->info.type) { - case GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED: - ret = gbaudio_tplg_create_enum_kctl(gb, kctl, ctl); - break; - default: - ctldata = devm_kzalloc(gb->dev, - sizeof(struct gbaudio_ctl_pvt), - GFP_KERNEL); - if (!ctldata) - return -ENOMEM; - ctldata->ctl_id = ctl->id; - ctldata->data_cport = le16_to_cpu(ctl->data_cport); - ctldata->access = ctl->access; - ctldata->vcount = ctl->count_values; - ctldata->info = &ctl->info; - *kctl = (struct snd_kcontrol_new) - SOC_MIXER_GB(ctl->name, ctl->count, ctldata); - ctldata = NULL; - break; - } - break; - default: - return -EINVAL; - } - - dev_dbg(gb->dev, "%s:%d control created\n", ctl->name, ctl->id); - return ret; -} - -static int gbcodec_enum_dapm_ctl_get(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret, ctl_id; - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *widget = wlist->widgets[0]; - struct gbaudio_module_info *module; - struct gb_audio_ctl_elem_value gbvalue; - struct snd_soc_codec *codec = widget->codec; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; - struct gb_bundle *bundle; - - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - ctl_id = gbaudio_map_wcontrolname(module, kcontrol->id.name); - if (ctl_id < 0) - return -EINVAL; - - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_get_control(module->mgmt_connection, ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - - ucontrol->value.enumerated.item[0] = gbvalue.value.enumerated_item[0]; - if (e->shift_l != e->shift_r) - ucontrol->value.enumerated.item[1] = - gbvalue.value.enumerated_item[1]; - - return 0; -} - -static int gbcodec_enum_dapm_ctl_put(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - int ret, wi, ctl_id; - unsigned int val, mux, change; - unsigned int mask; - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *widget = wlist->widgets[0]; - struct gb_audio_ctl_elem_value gbvalue; - struct gbaudio_module_info *module; - struct snd_soc_codec *codec = widget->codec; - struct gbaudio_codec_info *gb = snd_soc_codec_get_drvdata(codec); - struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; - struct gb_bundle *bundle; - - if (ucontrol->value.enumerated.item[0] > e->max - 1) - return -EINVAL; - - module = find_gb_module(gb, kcontrol->id.name); - if (!module) - return -EINVAL; - - ctl_id = gbaudio_map_wcontrolname(module, kcontrol->id.name); - if (ctl_id < 0) - return -EINVAL; - - change = 0; - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_get_control(module->mgmt_connection, ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - return ret; - } - - mux = ucontrol->value.enumerated.item[0]; - val = mux << e->shift_l; - mask = e->mask << e->shift_l; - - if (gbvalue.value.enumerated_item[0] != - ucontrol->value.enumerated.item[0]) { - change = 1; - gbvalue.value.enumerated_item[0] = - ucontrol->value.enumerated.item[0]; - } - - if (e->shift_l != e->shift_r) { - if (ucontrol->value.enumerated.item[1] > e->max - 1) - return -EINVAL; - val |= ucontrol->value.enumerated.item[1] << e->shift_r; - mask |= e->mask << e->shift_r; - if (gbvalue.value.enumerated_item[1] != - ucontrol->value.enumerated.item[1]) { - change = 1; - gbvalue.value.enumerated_item[1] = - ucontrol->value.enumerated.item[1]; - } - } - - if (change) { - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - ret = gb_audio_gb_set_control(module->mgmt_connection, ctl_id, - GB_AUDIO_INVALID_INDEX, &gbvalue); - - gb_pm_runtime_put_autosuspend(bundle); - - if (ret) { - dev_err_ratelimited(codec->dev, - "%d:Error in %s for %s\n", ret, - __func__, kcontrol->id.name); - } - for (wi = 0; wi < wlist->num_widgets; wi++) { - widget = wlist->widgets[wi]; - - widget->value = val; - widget->dapm->update = NULL; - snd_soc_dapm_mux_update_power(widget, kcontrol, mux, e); - } - } - - return change; -} - -static int gbaudio_tplg_create_enum_ctl(struct gbaudio_module_info *gb, - struct snd_kcontrol_new *kctl, - struct gb_audio_control *ctl) -{ - struct soc_enum *gbe; - struct gb_audio_enumerated *gb_enum; - int i; - - gbe = devm_kzalloc(gb->dev, sizeof(*gbe), GFP_KERNEL); - if (!gbe) - return -ENOMEM; - - gb_enum = &ctl->info.value.enumerated; - - /* since count=1, and reg is dummy */ - gbe->max = le32_to_cpu(gb_enum->items); - gbe->texts = gb_generate_enum_strings(gb, gb_enum); - - /* debug enum info */ - dev_dbg(gb->dev, "Max:%d, name_length:%d\n", gbe->max, - le16_to_cpu(gb_enum->names_length)); - for (i = 0; i < gbe->max; i++) - dev_dbg(gb->dev, "src[%d]: %s\n", i, gbe->texts[i]); - - *kctl = (struct snd_kcontrol_new) - SOC_DAPM_ENUM_EXT(ctl->name, *gbe, gbcodec_enum_dapm_ctl_get, - gbcodec_enum_dapm_ctl_put); - return 0; -} - -static int gbaudio_tplg_create_mixer_ctl(struct gbaudio_module_info *gb, - struct snd_kcontrol_new *kctl, - struct gb_audio_control *ctl) -{ - struct gbaudio_ctl_pvt *ctldata; - - ctldata = devm_kzalloc(gb->dev, sizeof(struct gbaudio_ctl_pvt), - GFP_KERNEL); - if (!ctldata) - return -ENOMEM; - ctldata->ctl_id = ctl->id; - ctldata->data_cport = le16_to_cpu(ctl->data_cport); - ctldata->access = ctl->access; - ctldata->vcount = ctl->count_values; - ctldata->info = &ctl->info; - *kctl = (struct snd_kcontrol_new) - SOC_DAPM_MIXER_GB(ctl->name, ctl->count, ctldata); - - return 0; -} - -static int gbaudio_tplg_create_wcontrol(struct gbaudio_module_info *gb, - struct snd_kcontrol_new *kctl, - struct gb_audio_control *ctl) -{ - int ret; - - switch (ctl->iface) { - case SNDRV_CTL_ELEM_IFACE_MIXER: - switch (ctl->info.type) { - case GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED: - ret = gbaudio_tplg_create_enum_ctl(gb, kctl, ctl); - break; - default: - ret = gbaudio_tplg_create_mixer_ctl(gb, kctl, ctl); - break; - } - break; - default: - return -EINVAL; - } - - dev_dbg(gb->dev, "%s:%d DAPM control created, ret:%d\n", ctl->name, - ctl->id, ret); - return ret; -} - -static int gbaudio_widget_event(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - int wid; - int ret; - struct snd_soc_codec *codec = w->codec; - struct gbaudio_codec_info *gbcodec = snd_soc_codec_get_drvdata(codec); - struct gbaudio_module_info *module; - struct gb_bundle *bundle; - - dev_dbg(codec->dev, "%s %s %d\n", __func__, w->name, event); - - /* Find relevant module */ - module = find_gb_module(gbcodec, w->name); - if (!module) - return -EINVAL; - - /* map name to widget id */ - wid = gbaudio_map_widgetname(module, w->name); - if (wid < 0) { - dev_err(codec->dev, "Invalid widget name:%s\n", w->name); - return -EINVAL; - } - - bundle = to_gb_bundle(module->dev); - - ret = gb_pm_runtime_get_sync(bundle); - if (ret) - return ret; - - switch (event) { - case SND_SOC_DAPM_PRE_PMU: - ret = gb_audio_gb_enable_widget(module->mgmt_connection, wid); - if (!ret) - ret = gbaudio_module_update(gbcodec, w, module, 1); - break; - case SND_SOC_DAPM_POST_PMD: - ret = gb_audio_gb_disable_widget(module->mgmt_connection, wid); - if (!ret) - ret = gbaudio_module_update(gbcodec, w, module, 0); - break; - } - if (ret) - dev_err_ratelimited(codec->dev, - "%d: widget, event:%d failed:%d\n", wid, - event, ret); - - gb_pm_runtime_put_autosuspend(bundle); - - return ret; -} - -static int gbaudio_tplg_create_widget(struct gbaudio_module_info *module, - struct snd_soc_dapm_widget *dw, - struct gb_audio_widget *w, int *w_size) -{ - int i, ret, csize; - struct snd_kcontrol_new *widget_kctls; - struct gb_audio_control *curr; - struct gbaudio_control *control, *_control; - size_t size; - char temp_name[NAME_SIZE]; - - ret = gbaudio_validate_kcontrol_count(w); - if (ret) { - dev_err(module->dev, "Invalid kcontrol count=%d for %s\n", - w->ncontrols, w->name); - return ret; - } - - /* allocate memory for kcontrol */ - if (w->ncontrols) { - size = sizeof(struct snd_kcontrol_new) * w->ncontrols; - widget_kctls = devm_kzalloc(module->dev, size, GFP_KERNEL); - if (!widget_kctls) - return -ENOMEM; - } - - *w_size = sizeof(struct gb_audio_widget); - - /* create relevant kcontrols */ - curr = w->ctl; - for (i = 0; i < w->ncontrols; i++) { - ret = gbaudio_tplg_create_wcontrol(module, &widget_kctls[i], - curr); - if (ret) { - dev_err(module->dev, - "%s:%d type widget_ctl not supported\n", - curr->name, curr->iface); - goto error; - } - control = devm_kzalloc(module->dev, - sizeof(struct gbaudio_control), - GFP_KERNEL); - if (!control) { - ret = -ENOMEM; - goto error; - } - control->id = curr->id; - control->name = curr->name; - control->wname = w->name; - - if (curr->info.type == GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED) { - struct gb_audio_enumerated *gbenum = - &curr->info.value.enumerated; - - csize = offsetof(struct gb_audio_control, info); - csize += offsetof(struct gb_audio_ctl_elem_info, value); - csize += offsetof(struct gb_audio_enumerated, names); - csize += le16_to_cpu(gbenum->names_length); - control->texts = (const char * const *) - gb_generate_enum_strings(module, gbenum); - control->items = le32_to_cpu(gbenum->items); - } else { - csize = sizeof(struct gb_audio_control); - } - - *w_size += csize; - curr = (void *)curr + csize; - list_add(&control->list, &module->widget_ctl_list); - dev_dbg(module->dev, "%s: control of type %d created\n", - widget_kctls[i].name, widget_kctls[i].iface); - } - - /* Prefix dev_id to widget control_name */ - strlcpy(temp_name, w->name, NAME_SIZE); - snprintf(w->name, NAME_SIZE, "GB %d %s", module->dev_id, temp_name); - - switch (w->type) { - case snd_soc_dapm_spk: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_SPK(w->name, gbcodec_event_spk); - module->op_devices |= GBAUDIO_DEVICE_OUT_SPEAKER; - break; - case snd_soc_dapm_hp: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_HP(w->name, gbcodec_event_hp); - module->op_devices |= (GBAUDIO_DEVICE_OUT_WIRED_HEADSET - | GBAUDIO_DEVICE_OUT_WIRED_HEADPHONE); - module->ip_devices |= GBAUDIO_DEVICE_IN_WIRED_HEADSET; - break; - case snd_soc_dapm_mic: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_MIC(w->name, gbcodec_event_int_mic); - module->ip_devices |= GBAUDIO_DEVICE_IN_BUILTIN_MIC; - break; - case snd_soc_dapm_output: - *dw = (struct snd_soc_dapm_widget)SND_SOC_DAPM_OUTPUT(w->name); - break; - case snd_soc_dapm_input: - *dw = (struct snd_soc_dapm_widget)SND_SOC_DAPM_INPUT(w->name); - break; - case snd_soc_dapm_switch: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_SWITCH_E(w->name, SND_SOC_NOPM, 0, 0, - widget_kctls, - gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - case snd_soc_dapm_pga: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_PGA_E(w->name, SND_SOC_NOPM, 0, 0, NULL, 0, - gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - case snd_soc_dapm_mixer: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_MIXER_E(w->name, SND_SOC_NOPM, 0, 0, NULL, - 0, gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - case snd_soc_dapm_mux: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_MUX_E(w->name, SND_SOC_NOPM, 0, 0, - widget_kctls, gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - case snd_soc_dapm_aif_in: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_AIF_IN_E(w->name, w->sname, 0, - SND_SOC_NOPM, - 0, 0, gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - case snd_soc_dapm_aif_out: - *dw = (struct snd_soc_dapm_widget) - SND_SOC_DAPM_AIF_OUT_E(w->name, w->sname, 0, - SND_SOC_NOPM, - 0, 0, gbaudio_widget_event, - SND_SOC_DAPM_PRE_PMU | - SND_SOC_DAPM_POST_PMD); - break; - default: - ret = -EINVAL; - goto error; - } - - dev_dbg(module->dev, "%s: widget of type %d created\n", dw->name, - dw->id); - return 0; -error: - list_for_each_entry_safe(control, _control, &module->widget_ctl_list, - list) { - list_del(&control->list); - devm_kfree(module->dev, control); - } - return ret; -} - -static int gbaudio_tplg_process_kcontrols(struct gbaudio_module_info *module, - struct gb_audio_control *controls) -{ - int i, csize, ret; - struct snd_kcontrol_new *dapm_kctls; - struct gb_audio_control *curr; - struct gbaudio_control *control, *_control; - size_t size; - char temp_name[NAME_SIZE]; - - size = sizeof(struct snd_kcontrol_new) * module->num_controls; - dapm_kctls = devm_kzalloc(module->dev, size, GFP_KERNEL); - if (!dapm_kctls) - return -ENOMEM; - - curr = controls; - for (i = 0; i < module->num_controls; i++) { - ret = gbaudio_tplg_create_kcontrol(module, &dapm_kctls[i], - curr); - if (ret) { - dev_err(module->dev, "%s:%d type not supported\n", - curr->name, curr->iface); - goto error; - } - control = devm_kzalloc(module->dev, sizeof(struct - gbaudio_control), - GFP_KERNEL); - if (!control) { - ret = -ENOMEM; - goto error; - } - control->id = curr->id; - /* Prefix dev_id to widget_name */ - strlcpy(temp_name, curr->name, NAME_SIZE); - snprintf(curr->name, NAME_SIZE, "GB %d %s", module->dev_id, - temp_name); - control->name = curr->name; - if (curr->info.type == GB_AUDIO_CTL_ELEM_TYPE_ENUMERATED) { - struct gb_audio_enumerated *gbenum = - &curr->info.value.enumerated; - - csize = offsetof(struct gb_audio_control, info); - csize += offsetof(struct gb_audio_ctl_elem_info, value); - csize += offsetof(struct gb_audio_enumerated, names); - csize += le16_to_cpu(gbenum->names_length); - control->texts = (const char * const *) - gb_generate_enum_strings(module, gbenum); - control->items = le32_to_cpu(gbenum->items); - } else { - csize = sizeof(struct gb_audio_control); - } - - list_add(&control->list, &module->ctl_list); - dev_dbg(module->dev, "%d:%s created of type %d\n", curr->id, - curr->name, curr->info.type); - curr = (void *)curr + csize; - } - module->controls = dapm_kctls; - - return 0; -error: - list_for_each_entry_safe(control, _control, &module->ctl_list, - list) { - list_del(&control->list); - devm_kfree(module->dev, control); - } - devm_kfree(module->dev, dapm_kctls); - return ret; -} - -static int gbaudio_tplg_process_widgets(struct gbaudio_module_info *module, - struct gb_audio_widget *widgets) -{ - int i, ret, w_size; - struct snd_soc_dapm_widget *dapm_widgets; - struct gb_audio_widget *curr; - struct gbaudio_widget *widget, *_widget; - size_t size; - - size = sizeof(struct snd_soc_dapm_widget) * module->num_dapm_widgets; - dapm_widgets = devm_kzalloc(module->dev, size, GFP_KERNEL); - if (!dapm_widgets) - return -ENOMEM; - - curr = widgets; - for (i = 0; i < module->num_dapm_widgets; i++) { - ret = gbaudio_tplg_create_widget(module, &dapm_widgets[i], - curr, &w_size); - if (ret) { - dev_err(module->dev, "%s:%d type not supported\n", - curr->name, curr->type); - goto error; - } - widget = devm_kzalloc(module->dev, sizeof(struct - gbaudio_widget), - GFP_KERNEL); - if (!widget) { - ret = -ENOMEM; - goto error; - } - widget->id = curr->id; - widget->name = curr->name; - list_add(&widget->list, &module->widget_list); - curr = (void *)curr + w_size; - } - module->dapm_widgets = dapm_widgets; - - return 0; - -error: - list_for_each_entry_safe(widget, _widget, &module->widget_list, - list) { - list_del(&widget->list); - devm_kfree(module->dev, widget); - } - devm_kfree(module->dev, dapm_widgets); - return ret; -} - -static int gbaudio_tplg_process_routes(struct gbaudio_module_info *module, - struct gb_audio_route *routes) -{ - int i, ret; - struct snd_soc_dapm_route *dapm_routes; - struct gb_audio_route *curr; - size_t size; - - size = sizeof(struct snd_soc_dapm_route) * module->num_dapm_routes; - dapm_routes = devm_kzalloc(module->dev, size, GFP_KERNEL); - if (!dapm_routes) - return -ENOMEM; - - module->dapm_routes = dapm_routes; - curr = routes; - - for (i = 0; i < module->num_dapm_routes; i++) { - dapm_routes->sink = - gbaudio_map_widgetid(module, curr->destination_id); - if (!dapm_routes->sink) { - dev_err(module->dev, "%d:%d:%d:%d - Invalid sink\n", - curr->source_id, curr->destination_id, - curr->control_id, curr->index); - ret = -EINVAL; - goto error; - } - dapm_routes->source = - gbaudio_map_widgetid(module, curr->source_id); - if (!dapm_routes->source) { - dev_err(module->dev, "%d:%d:%d:%d - Invalid source\n", - curr->source_id, curr->destination_id, - curr->control_id, curr->index); - ret = -EINVAL; - goto error; - } - dapm_routes->control = - gbaudio_map_controlid(module, - curr->control_id, - curr->index); - if ((curr->control_id != GBAUDIO_INVALID_ID) && - !dapm_routes->control) { - dev_err(module->dev, "%d:%d:%d:%d - Invalid control\n", - curr->source_id, curr->destination_id, - curr->control_id, curr->index); - ret = -EINVAL; - goto error; - } - dev_dbg(module->dev, "Route {%s, %s, %s}\n", dapm_routes->sink, - (dapm_routes->control) ? dapm_routes->control : "NULL", - dapm_routes->source); - dapm_routes++; - curr++; - } - - return 0; - -error: - devm_kfree(module->dev, module->dapm_routes); - return ret; -} - -static int gbaudio_tplg_process_header(struct gbaudio_module_info *module, - struct gb_audio_topology *tplg_data) -{ - /* fetch no. of kcontrols, widgets & routes */ - module->num_controls = tplg_data->num_controls; - module->num_dapm_widgets = tplg_data->num_widgets; - module->num_dapm_routes = tplg_data->num_routes; - - /* update block offset */ - module->dai_offset = (unsigned long)&tplg_data->data; - module->control_offset = module->dai_offset + - le32_to_cpu(tplg_data->size_dais); - module->widget_offset = module->control_offset + - le32_to_cpu(tplg_data->size_controls); - module->route_offset = module->widget_offset + - le32_to_cpu(tplg_data->size_widgets); - - dev_dbg(module->dev, "DAI offset is 0x%lx\n", module->dai_offset); - dev_dbg(module->dev, "control offset is %lx\n", - module->control_offset); - dev_dbg(module->dev, "widget offset is %lx\n", module->widget_offset); - dev_dbg(module->dev, "route offset is %lx\n", module->route_offset); - - return 0; -} - -int gbaudio_tplg_parse_data(struct gbaudio_module_info *module, - struct gb_audio_topology *tplg_data) -{ - int ret; - struct gb_audio_control *controls; - struct gb_audio_widget *widgets; - struct gb_audio_route *routes; - unsigned int jack_type; - - if (!tplg_data) - return -EINVAL; - - ret = gbaudio_tplg_process_header(module, tplg_data); - if (ret) { - dev_err(module->dev, "%d: Error in parsing topology header\n", - ret); - return ret; - } - - /* process control */ - controls = (struct gb_audio_control *)module->control_offset; - ret = gbaudio_tplg_process_kcontrols(module, controls); - if (ret) { - dev_err(module->dev, - "%d: Error in parsing controls data\n", ret); - return ret; - } - dev_dbg(module->dev, "Control parsing finished\n"); - - /* process widgets */ - widgets = (struct gb_audio_widget *)module->widget_offset; - ret = gbaudio_tplg_process_widgets(module, widgets); - if (ret) { - dev_err(module->dev, - "%d: Error in parsing widgets data\n", ret); - return ret; - } - dev_dbg(module->dev, "Widget parsing finished\n"); - - /* process route */ - routes = (struct gb_audio_route *)module->route_offset; - ret = gbaudio_tplg_process_routes(module, routes); - if (ret) { - dev_err(module->dev, - "%d: Error in parsing routes data\n", ret); - return ret; - } - dev_dbg(module->dev, "Route parsing finished\n"); - - /* parse jack capabilities */ - jack_type = le32_to_cpu(tplg_data->jack_type); - if (jack_type) { - module->jack_mask = jack_type & GBCODEC_JACK_MASK; - module->button_mask = jack_type & GBCODEC_JACK_BUTTON_MASK; - } - - return ret; -} - -void gbaudio_tplg_release(struct gbaudio_module_info *module) -{ - struct gbaudio_control *control, *_control; - struct gbaudio_widget *widget, *_widget; - - if (!module->topology) - return; - - /* release kcontrols */ - list_for_each_entry_safe(control, _control, &module->ctl_list, - list) { - list_del(&control->list); - devm_kfree(module->dev, control); - } - if (module->controls) - devm_kfree(module->dev, module->controls); - - /* release widget controls */ - list_for_each_entry_safe(control, _control, &module->widget_ctl_list, - list) { - list_del(&control->list); - devm_kfree(module->dev, control); - } - - /* release widgets */ - list_for_each_entry_safe(widget, _widget, &module->widget_list, - list) { - list_del(&widget->list); - devm_kfree(module->dev, widget); - } - if (module->dapm_widgets) - devm_kfree(module->dev, module->dapm_widgets); - - /* release routes */ - if (module->dapm_routes) - devm_kfree(module->dev, module->dapm_routes); -} -- 2.26.2

4 years, 7 months

[PATCH] staging: greybus: uart: replace driver line-coding struct

by Johan Hovold

Drop the driver version of the line-coding request and use the protocol definition directly as was originally intended instead. This specifically avoids having the two versions of what is supposed to be the same struct ever getting out of sync. Note that this has in fact already happened once when the protocol definition had its implicit padding removed while the driver struct wasn't updated. The fact that we used the size of the then larger driver struct when memcpying its content to the stack didn't exactly make things better. A later addition of a flow-control field incidentally made the structures match again. Signed-off-by: Johan Hovold <johan(a)kernel.org> --- drivers/staging/greybus/uart.c | 19 ++++--------------- 1 file changed, 4 insertions(+), 15 deletions(-) diff --git a/drivers/staging/greybus/uart.c b/drivers/staging/greybus/uart.c index 55c51143bb09..84de56800a21 100644 --- a/drivers/staging/greybus/uart.c +++ b/drivers/staging/greybus/uart.c @@ -40,14 +40,6 @@ #define GB_UART_FIRMWARE_CREDITS 4096 #define GB_UART_CREDIT_WAIT_TIMEOUT_MSEC 10000 -struct gb_tty_line_coding { - __le32 rate; - __u8 format; - __u8 parity; - __u8 data_bits; - __u8 flow_control; -}; - struct gb_tty { struct gbphy_device *gbphy_dev; struct tty_port port; @@ -66,7 +58,7 @@ struct gb_tty { struct mutex mutex; u8 ctrlin; /* input control lines */ u8 ctrlout; /* output control lines */ - struct gb_tty_line_coding line_coding; + struct gb_uart_set_line_coding_request line_coding; struct work_struct tx_work; struct kfifo write_fifo; bool close_pending; @@ -288,12 +280,9 @@ static void gb_uart_tx_write_work(struct work_struct *work) static int send_line_coding(struct gb_tty *tty) { - struct gb_uart_set_line_coding_request request; - - memcpy(&request, &tty->line_coding, - sizeof(tty->line_coding)); return gb_operation_sync(tty->connection, GB_UART_TYPE_SET_LINE_CODING, - &request, sizeof(request), NULL, 0); + &tty->line_coding, sizeof(tty->line_coding), + NULL, 0); } static int send_control(struct gb_tty *gb_tty, u8 control) @@ -493,9 +482,9 @@ static int gb_tty_break_ctl(struct tty_struct *tty, int state) static void gb_tty_set_termios(struct tty_struct *tty, struct ktermios *termios_old) { + struct gb_uart_set_line_coding_request newline; struct gb_tty *gb_tty = tty->driver_data; struct ktermios *termios = &tty->termios; - struct gb_tty_line_coding newline; u8 newctrl = gb_tty->ctrlout; newline.rate = cpu_to_le32(tty_get_baud_rate(tty)); -- 2.26.2

4 years, 7 months

[PATCH] greybus: uart: fix uninitialized flow control variable

by Arnd Bergmann

gcc-10 points out an uninitialized variable use: drivers/staging/greybus/uart.c: In function 'gb_tty_set_termios': drivers/staging/greybus/uart.c:540:24: error: 'newline.flow_control' is used uninitialized in this function [-Werror=uninitialized] 540 | newline.flow_control |= GB_SERIAL_AUTO_RTSCTS_EN; Instead of using |= and &= on the uninitialized variable, use a direct assignment. Fixes: e55c25206d5c ("greybus: uart: Handle CRTSCTS flag in termios") Signed-off-by: Arnd Bergmann <arnd(a)arndb.de> --- drivers/staging/greybus/uart.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/drivers/staging/greybus/uart.c b/drivers/staging/greybus/uart.c index 55c51143bb09..4ffb334cd5cd 100644 --- a/drivers/staging/greybus/uart.c +++ b/drivers/staging/greybus/uart.c @@ -537,9 +537,9 @@ static void gb_tty_set_termios(struct tty_struct *tty, } if (C_CRTSCTS(tty) && C_BAUD(tty) != B0) - newline.flow_control |= GB_SERIAL_AUTO_RTSCTS_EN; + newline.flow_control = GB_SERIAL_AUTO_RTSCTS_EN; else - newline.flow_control &= ~GB_SERIAL_AUTO_RTSCTS_EN; + newline.flow_control = 0; if (memcmp(&gb_tty->line_coding, &newline, sizeof(newline))) { memcpy(&gb_tty->line_coding, &newline, sizeof(newline)); -- 2.26.0

4 years, 7 months

[PATCH] staging: greybus: Replace zero-length array with flexible-array

by Gustavo A. R. Silva

The current codebase makes use of the zero-length array language extension to the C90 standard, but the preferred mechanism to declare variable-length types such as these ones is a flexible array member[1][2], introduced in C99: struct foo { int stuff; struct boo array[]; }; By making use of the mechanism above, we will get a compiler warning in case the flexible array does not occur last in the structure, which will help us prevent some kind of undefined behavior bugs from being inadvertently introduced[3] to the codebase from now on. Also, notice that, dynamic memory allocations won't be affected by this change: "Flexible array members have incomplete type, and so the sizeof operator may not be applied. As a quirk of the original implementation of zero-length arrays, sizeof evaluates to zero."[1] sizeof(flexible-array-member) triggers a warning because flexible array members have incomplete type[1]. There are some instances of code in which the sizeof operator is being incorrectly/erroneously applied to zero-length arrays and the result is zero. Such instances may be hiding some bugs. So, this work (flexible-array member conversions) will also help to get completely rid of those sorts of issues. This issue was found with the help of Coccinelle. [1] https://gcc.gnu.org/onlinedocs/gcc/Zero-Length.html [2] https://github.com/KSPP/linux/issues/21 [3] commit 76497732932f ("cxgb3/l2t: Fix undefined behaviour") Signed-off-by: Gustavo A. R. Silva <gustavoars(a)kernel.org> --- drivers/greybus/arpc.h | 2 - include/linux/greybus/greybus_protocols.h | 44 +++++++++++++++--------------- 2 files changed, 23 insertions(+), 23 deletions(-) diff --git a/drivers/greybus/arpc.h b/drivers/greybus/arpc.h index c8b83c5cfa79..b9ea81b55b29 100644 --- a/drivers/greybus/arpc.h +++ b/drivers/greybus/arpc.h @@ -21,7 +21,7 @@ struct arpc_request_message { __le16 id; /* RPC unique id */ __le16 size; /* Size in bytes of header + payload */ __u8 type; /* RPC type */ - __u8 data[0]; /* ARPC data */ + __u8 data[]; /* ARPC data */ } __packed; struct arpc_response_message { diff --git a/include/linux/greybus/greybus_protocols.h b/include/linux/greybus/greybus_protocols.h index dfbc6c39a74b..aeb8f9243545 100644 --- a/include/linux/greybus/greybus_protocols.h +++ b/include/linux/greybus/greybus_protocols.h @@ -345,7 +345,7 @@ struct gb_cap_get_ims_certificate_request { struct gb_cap_get_ims_certificate_response { __u8 result_code; - __u8 certificate[0]; + __u8 certificate[]; } __packed; /* CAP authenticate request/response */ @@ -358,7 +358,7 @@ struct gb_cap_authenticate_request { struct gb_cap_authenticate_response { __u8 result_code; __u8 response[64]; - __u8 signature[0]; + __u8 signature[]; } __packed; @@ -642,7 +642,7 @@ struct gb_hid_get_report_request { struct gb_hid_set_report_request { __u8 report_type; __u8 report_id; - __u8 report[0]; + __u8 report[]; } __packed; /* HID input report request, via interrupt pipe */ @@ -680,7 +680,7 @@ struct gb_i2c_transfer_op { struct gb_i2c_transfer_request { __le16 op_count; - struct gb_i2c_transfer_op ops[0]; /* op_count of these */ + struct gb_i2c_transfer_op ops[]; /* op_count of these */ } __packed; struct gb_i2c_transfer_response { __u8 data[0]; /* inbound data */ @@ -908,7 +908,7 @@ struct gb_spi_transfer_request { __u8 chip_select; /* of the spi device */ __u8 mode; /* of the spi device */ __le16 count; - struct gb_spi_transfer transfers[0]; /* count of these */ + struct gb_spi_transfer transfers[]; /* count of these */ } __packed; struct gb_spi_transfer_response { @@ -1188,7 +1188,7 @@ struct gb_svc_pwrmon_rail_count_get_response { struct gb_svc_pwrmon_rail_names_get_response { __u8 status; - __u8 name[0][GB_SVC_PWRMON_RAIL_NAME_BUFSIZE]; + __u8 name[][GB_SVC_PWRMON_RAIL_NAME_BUFSIZE]; } __packed; #define GB_SVC_PWRMON_TYPE_CURR 0x01 @@ -1281,7 +1281,7 @@ struct gb_svc_intf_oops_request { struct gb_raw_send_request { __le32 len; - __u8 data[0]; + __u8 data[]; } __packed; @@ -1300,7 +1300,7 @@ struct gb_raw_send_request { /* Represents data from AP -> Module */ struct gb_uart_send_data_request { __le16 size; - __u8 data[0]; + __u8 data[]; } __packed; /* recv-data-request flags */ @@ -1313,7 +1313,7 @@ struct gb_uart_send_data_request { struct gb_uart_recv_data_request { __le16 size; __u8 flags; - __u8 data[0]; + __u8 data[]; } __packed; struct gb_uart_receive_credits_request { @@ -1382,14 +1382,14 @@ struct gb_loopback_transfer_request { __le32 len; __le32 reserved0; __le32 reserved1; - __u8 data[0]; + __u8 data[]; } __packed; struct gb_loopback_transfer_response { __le32 len; __le32 reserved0; __le32 reserved1; - __u8 data[0]; + __u8 data[]; } __packed; /* SDIO */ @@ -1530,13 +1530,13 @@ struct gb_sdio_transfer_request { __le16 data_blocks; __le16 data_blksz; - __u8 data[0]; + __u8 data[]; } __packed; struct gb_sdio_transfer_response { __le16 data_blocks; __le16 data_blksz; - __u8 data[0]; + __u8 data[]; } __packed; /* event request: generated by module and is defined as unidirectional */ @@ -1572,7 +1572,7 @@ struct gb_camera_configure_streams_request { __u8 flags; #define GB_CAMERA_CONFIGURE_STREAMS_TEST_ONLY 0x01 __le16 padding; - struct gb_camera_stream_config_request config[0]; + struct gb_camera_stream_config_request config[]; } __packed; /* Greybus Camera Configure Streams response payload */ @@ -1593,7 +1593,7 @@ struct gb_camera_configure_streams_response { __u8 flags; __u8 padding[2]; __le32 data_rate; - struct gb_camera_stream_config_response config[0]; + struct gb_camera_stream_config_response config[]; }; /* Greybus Camera Capture request payload - response has no payload */ @@ -1602,7 +1602,7 @@ struct gb_camera_capture_request { __u8 streams; __u8 padding; __le16 num_frames; - __u8 settings[0]; + __u8 settings[]; } __packed; /* Greybus Camera Flush response payload - request has no payload */ @@ -1616,7 +1616,7 @@ struct gb_camera_metadata_request { __le16 frame_number; __u8 stream; __u8 padding; - __u8 metadata[0]; + __u8 metadata[]; } __packed; /* Lights */ @@ -1993,7 +1993,7 @@ struct gb_audio_integer64 { struct gb_audio_enumerated { __le32 items; __le16 names_length; - __u8 names[0]; + __u8 names[]; } __packed; struct gb_audio_ctl_elem_info { /* See snd_ctl_elem_info in Linux source */ @@ -2033,7 +2033,7 @@ struct gb_audio_widget { __u8 type; /* GB_AUDIO_WIDGET_TYPE_* */ __u8 state; /* GB_AUDIO_WIDGET_STATE_* */ __u8 ncontrols; - struct gb_audio_control ctl[0]; /* 'ncontrols' entries */ + struct gb_audio_control ctl[]; /* 'ncontrols' entries */ } __packed; struct gb_audio_route { @@ -2059,7 +2059,7 @@ struct gb_audio_topology { * struct gb_audio_widget widgets[num_widgets]; * struct gb_audio_route routes[num_routes]; */ - __u8 data[0]; + __u8 data[]; } __packed; struct gb_audio_get_topology_size_response { @@ -2157,7 +2157,7 @@ struct gb_audio_streaming_event_request { struct gb_audio_send_data_request { __le64 timestamp; - __u8 data[0]; + __u8 data[]; } __packed; @@ -2171,7 +2171,7 @@ struct gb_audio_send_data_request { struct gb_log_send_log_request { __le16 len; - __u8 msg[0]; + __u8 msg[]; } __packed; #endif /* __GREYBUS_PROTOCOLS_H */

4 years, 7 months

[PATCH] staging: greybus: Fix uninitialized scalar variable

by Oscar Carter

In the "gb_tty_set_termios" function the "newline" variable is declared but not initialized. So the "flow_control" member is not initialized and the OR / AND operations with itself results in an undefined value in this member. The purpose of the code is to set the flow control type, so remove the OR / AND self operator and set the value directly. Addresses-Coverity-ID: 1374016 ("Uninitialized scalar variable") Fixes: e55c25206d5c9 ("greybus: uart: Handle CRTSCTS flag in termios") Signed-off-by: Oscar Carter <oscar.carter(a)gmx.com> --- drivers/staging/greybus/uart.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/drivers/staging/greybus/uart.c b/drivers/staging/greybus/uart.c index 55c51143bb09..4ffb334cd5cd 100644 --- a/drivers/staging/greybus/uart.c +++ b/drivers/staging/greybus/uart.c @@ -537,9 +537,9 @@ static void gb_tty_set_termios(struct tty_struct *tty, } if (C_CRTSCTS(tty) && C_BAUD(tty) != B0) - newline.flow_control |= GB_SERIAL_AUTO_RTSCTS_EN; + newline.flow_control = GB_SERIAL_AUTO_RTSCTS_EN; else - newline.flow_control &= ~GB_SERIAL_AUTO_RTSCTS_EN; + newline.flow_control = 0; if (memcmp(&gb_tty->line_coding, &newline, sizeof(newline))) { memcpy(&gb_tty->line_coding, &newline, sizeof(newline)); -- 2.20.1

4 years, 7 months

2024

2023

2022

2021

2020

2019

2018

2017

2016

greybus-dev May 2020