Hi Tzung-Bi, On Mon, Oct 14, 2019 at 06:20:14PM +0800, Tzung-Bi Shih wrote: > Refactor by the following items: > - reformat copyright declaration > - use more specific name "i2s rx" > - use verbose symbol names to separate namespaces > - make some short functions inline > - remove unused TDM-related code > > Signed-off-by: Tzung-Bi Shih <tzungbi@xxxxxxxxxx> Acked-By: Benson Leung <bleung@xxxxxxxxxxxx> Thanks, Benson > --- > drivers/platform/chrome/cros_ec_trace.c | 2 +- > .../linux/platform_data/cros_ec_commands.h | 120 ++--- > sound/soc/codecs/cros_ec_codec.c | 502 +++++++----------- > 3 files changed, 251 insertions(+), 373 deletions(-) > > diff --git a/drivers/platform/chrome/cros_ec_trace.c b/drivers/platform/chrome/cros_ec_trace.c > index 6f80ff4532ae..901850004b2b 100644 > --- a/drivers/platform/chrome/cros_ec_trace.c > +++ b/drivers/platform/chrome/cros_ec_trace.c > @@ -98,7 +98,7 @@ > TRACE_SYMBOL(EC_CMD_SB_READ_BLOCK), \ > TRACE_SYMBOL(EC_CMD_SB_WRITE_BLOCK), \ > TRACE_SYMBOL(EC_CMD_BATTERY_VENDOR_PARAM), \ > - TRACE_SYMBOL(EC_CMD_CODEC_I2S), \ > + TRACE_SYMBOL(EC_CMD_EC_CODEC_I2S_RX), \ > TRACE_SYMBOL(EC_CMD_REBOOT_EC), \ > TRACE_SYMBOL(EC_CMD_GET_PANIC_INFO), \ > TRACE_SYMBOL(EC_CMD_ACPI_READ), \ > diff --git a/include/linux/platform_data/cros_ec_commands.h b/include/linux/platform_data/cros_ec_commands.h > index 43b8f7dae4cc..261ac83bd007 100644 > --- a/include/linux/platform_data/cros_ec_commands.h > +++ b/include/linux/platform_data/cros_ec_commands.h > @@ -4466,92 +4466,74 @@ enum mkbp_cec_event { > > /*****************************************************************************/ > > -/* Commands for I2S recording on audio codec. */ > - > -#define EC_CMD_CODEC_I2S 0x00BC > -#define EC_WOV_I2S_SAMPLE_RATE 48000 > - > -enum ec_codec_i2s_subcmd { > - EC_CODEC_SET_SAMPLE_DEPTH = 0x0, > - EC_CODEC_SET_GAIN = 0x1, > - EC_CODEC_GET_GAIN = 0x2, > - EC_CODEC_I2S_ENABLE = 0x3, > - EC_CODEC_I2S_SET_CONFIG = 0x4, > - EC_CODEC_I2S_SET_TDM_CONFIG = 0x5, > - EC_CODEC_I2S_SET_BCLK = 0x6, > - EC_CODEC_I2S_SUBCMD_COUNT = 0x7, > +/* Commands for I2S RX on audio codec. */ > + > +#define EC_CMD_EC_CODEC_I2S_RX 0x00BC > + > +enum ec_codec_i2s_rx_subcmd { > + EC_CODEC_I2S_RX_ENABLE = 0x0, > + EC_CODEC_I2S_RX_DISABLE = 0x1, > + EC_CODEC_I2S_RX_SET_GAIN = 0x2, > + EC_CODEC_I2S_RX_GET_GAIN = 0x3, > + EC_CODEC_I2S_RX_SET_SAMPLE_DEPTH = 0x4, > + EC_CODEC_I2S_RX_SET_DAIFMT = 0x5, > + EC_CODEC_I2S_RX_SET_BCLK = 0x6, > + EC_CODEC_I2S_RX_SUBCMD_COUNT, > }; > > -enum ec_sample_depth_value { > - EC_CODEC_SAMPLE_DEPTH_16 = 0, > - EC_CODEC_SAMPLE_DEPTH_24 = 1, > +enum ec_codec_i2s_rx_sample_depth { > + EC_CODEC_I2S_RX_SAMPLE_DEPTH_16 = 0x0, > + EC_CODEC_I2S_RX_SAMPLE_DEPTH_24 = 0x1, > + EC_CODEC_I2S_RX_SAMPLE_DEPTH_COUNT, > }; > > -enum ec_i2s_config { > - EC_DAI_FMT_I2S = 0, > - EC_DAI_FMT_RIGHT_J = 1, > - EC_DAI_FMT_LEFT_J = 2, > - EC_DAI_FMT_PCM_A = 3, > - EC_DAI_FMT_PCM_B = 4, > - EC_DAI_FMT_PCM_TDM = 5, > +enum ec_codec_i2s_rx_daifmt { > + EC_CODEC_I2S_RX_DAIFMT_I2S = 0x0, > + EC_CODEC_I2S_RX_DAIFMT_RIGHT_J = 0x1, > + EC_CODEC_I2S_RX_DAIFMT_LEFT_J = 0x2, > + EC_CODEC_I2S_RX_DAIFMT_COUNT, > }; > > -/* > - * For subcommand EC_CODEC_GET_GAIN. > - */ > -struct __ec_align1 ec_codec_i2s_gain { > +struct __ec_align1 ec_param_ec_codec_i2s_rx_set_sample_depth { > + uint8_t depth; > + uint8_t reserved[3]; > +}; > + > +struct __ec_align1 ec_param_ec_codec_i2s_rx_set_gain { > uint8_t left; > uint8_t right; > + uint8_t reserved[2]; > }; > > -struct __ec_todo_unpacked ec_param_codec_i2s_tdm { > - int16_t ch0_delay; /* 0 to 496 */ > - int16_t ch1_delay; /* -1 to 496 */ > - uint8_t adjacent_to_ch0; > - uint8_t adjacent_to_ch1; > +struct __ec_align1 ec_param_ec_codec_i2s_rx_set_daifmt { > + uint8_t daifmt; > + uint8_t reserved[3]; > }; > > -struct __ec_todo_packed ec_param_codec_i2s { > - /* enum ec_codec_i2s_subcmd */ > - uint8_t cmd; > - union { > - /* > - * EC_CODEC_SET_SAMPLE_DEPTH > - * Value should be one of ec_sample_depth_value. > - */ > - uint8_t depth; > - > - /* > - * EC_CODEC_SET_GAIN > - * Value should be 0~43 for both channels. > - */ > - struct ec_codec_i2s_gain gain; > - > - /* > - * EC_CODEC_I2S_ENABLE > - * 1 to enable, 0 to disable. > - */ > - uint8_t i2s_enable; > - > - /* > - * EC_CODEC_I2S_SET_CONFIG > - * Value should be one of ec_i2s_config. > - */ > - uint8_t i2s_config; > +struct __ec_align4 ec_param_ec_codec_i2s_rx_set_bclk { > + uint32_t bclk; > +}; > > - /* > - * EC_CODEC_I2S_SET_TDM_CONFIG > - * Value should be one of ec_i2s_config. > - */ > - struct ec_param_codec_i2s_tdm tdm_param; > +struct __ec_align4 ec_param_ec_codec_i2s_rx { > + uint8_t cmd; /* enum ec_codec_i2s_rx_subcmd */ > + uint8_t reserved[3]; > > - /* > - * EC_CODEC_I2S_SET_BCLK > - */ > - uint32_t bclk; > + union { > + struct ec_param_ec_codec_i2s_rx_set_sample_depth > + set_sample_depth_param; > + struct ec_param_ec_codec_i2s_rx_set_gain > + set_gain_param; > + struct ec_param_ec_codec_i2s_rx_set_daifmt > + set_daifmt_param; > + struct ec_param_ec_codec_i2s_rx_set_bclk > + set_bclk_param; > }; > }; > > +struct __ec_align1 ec_response_ec_codec_i2s_rx_get_gain { > + uint8_t left; > + uint8_t right; > +}; > > /*****************************************************************************/ > /* System commands */ > diff --git a/sound/soc/codecs/cros_ec_codec.c b/sound/soc/codecs/cros_ec_codec.c > index 3c1bd24a1057..179fa77291cd 100644 > --- a/sound/soc/codecs/cros_ec_codec.c > +++ b/sound/soc/codecs/cros_ec_codec.c > @@ -1,6 +1,8 @@ > // SPDX-License-Identifier: GPL-2.0 > /* > - * Driver for ChromeOS Embedded Controller codec. > + * Copyright 2019 Google, Inc. > + * > + * ChromeOS Embedded Controller codec driver. > * > * This driver uses the cros-ec interface to communicate with the ChromeOS > * EC for audio function. > @@ -18,403 +20,297 @@ > #include <sound/soc.h> > #include <sound/tlv.h> > > -#define DRV_NAME "cros-ec-codec" > - > -/** > - * struct cros_ec_codec_data - ChromeOS EC codec driver data. > - * @dev: Device structure used in sysfs. > - * @ec_device: cros_ec_device structure to talk to the physical device. > - * @component: Pointer to the component. > - * @max_dmic_gain: Maximum gain in dB supported by EC codec. > - */ > -struct cros_ec_codec_data { > +struct cros_ec_codec_priv { > struct device *dev; > struct cros_ec_device *ec_device; > - struct snd_soc_component *component; > - unsigned int max_dmic_gain; > }; > > -static const DECLARE_TLV_DB_SCALE(ec_mic_gain_tlv, 0, 100, 0); > - > -static int ec_command_get_gain(struct snd_soc_component *component, > - struct ec_param_codec_i2s *param, > - struct ec_codec_i2s_gain *resp) > +static int send_ec_host_command(struct cros_ec_device *ec_dev, uint32_t cmd, > + uint8_t *out, size_t outsize, > + uint8_t *in, size_t insize) > { > - struct cros_ec_codec_data *codec_data = > - snd_soc_component_get_drvdata(component); > - struct cros_ec_device *ec_device = codec_data->ec_device; > - u8 buffer[sizeof(struct cros_ec_command) + > - max(sizeof(struct ec_param_codec_i2s), > - sizeof(struct ec_codec_i2s_gain))]; > - struct cros_ec_command *msg = (struct cros_ec_command *)&buffer; > int ret; > + struct cros_ec_command *msg; > + > + msg = kmalloc(sizeof(*msg) + max(outsize, insize), GFP_KERNEL); > + if (!msg) > + return -ENOMEM; > > msg->version = 0; > - msg->command = EC_CMD_CODEC_I2S; > - msg->outsize = sizeof(struct ec_param_codec_i2s); > - msg->insize = sizeof(struct ec_codec_i2s_gain); > + msg->command = cmd; > + msg->outsize = outsize; > + msg->insize = insize; > + > + if (outsize) > + memcpy(msg->data, out, outsize); > > - memcpy(msg->data, param, msg->outsize); > + ret = cros_ec_cmd_xfer_status(ec_dev, msg); > + if (ret < 0) > + goto error; > > - ret = cros_ec_cmd_xfer_status(ec_device, msg); > - if (ret > 0) > - memcpy(resp, msg->data, msg->insize); > + if (insize) > + memcpy(in, msg->data, insize); > > + ret = 0; > +error: > + kfree(msg); > return ret; > } > > -/* > - * Wrapper for EC command without response. > - */ > -static int ec_command_no_resp(struct snd_soc_component *component, > - struct ec_param_codec_i2s *param) > +static int dmic_get_gain(struct snd_kcontrol *kcontrol, > + struct snd_ctl_elem_value *ucontrol) > { > - struct cros_ec_codec_data *codec_data = > + struct snd_soc_component *component = > + snd_soc_kcontrol_component(kcontrol); > + struct cros_ec_codec_priv *priv = > snd_soc_component_get_drvdata(component); > - struct cros_ec_device *ec_device = codec_data->ec_device; > - u8 buffer[sizeof(struct cros_ec_command) + > - sizeof(struct ec_param_codec_i2s)]; > - struct cros_ec_command *msg = (struct cros_ec_command *)&buffer; > - > - msg->version = 0; > - msg->command = EC_CMD_CODEC_I2S; > - msg->outsize = sizeof(struct ec_param_codec_i2s); > - msg->insize = 0; > - > - memcpy(msg->data, param, msg->outsize); > - > - return cros_ec_cmd_xfer_status(ec_device, msg); > -} > - > -static int set_i2s_config(struct snd_soc_component *component, > - enum ec_i2s_config i2s_config) > -{ > - struct ec_param_codec_i2s param; > + struct ec_param_ec_codec_i2s_rx p; > + struct ec_response_ec_codec_i2s_rx_get_gain r; > + int ret; > > - dev_dbg(component->dev, "%s set I2S format to %u\n", __func__, > - i2s_config); > + p.cmd = EC_CODEC_I2S_RX_GET_GAIN; > + ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), > + (uint8_t *)&r, sizeof(r)); > + if (ret < 0) > + return ret; > > - param.cmd = EC_CODEC_I2S_SET_CONFIG; > - param.i2s_config = i2s_config; > + ucontrol->value.integer.value[0] = r.left; > + ucontrol->value.integer.value[1] = r.right; > > - return ec_command_no_resp(component, ¶m); > + return 0; > } > > -static int cros_ec_i2s_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) > +static int dmic_put_gain(struct snd_kcontrol *kcontrol, > + struct snd_ctl_elem_value *ucontrol) > { > - struct snd_soc_component *component = dai->component; > - enum ec_i2s_config i2s_config; > - > - switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { > - case SND_SOC_DAIFMT_CBS_CFS: > - break; > - default: > - return -EINVAL; > - } > - > - switch (fmt & SND_SOC_DAIFMT_INV_MASK) { > - case SND_SOC_DAIFMT_NB_NF: > - break; > - default: > - return -EINVAL; > - } > - > - switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { > - case SND_SOC_DAIFMT_I2S: > - i2s_config = EC_DAI_FMT_I2S; > - break; > - > - case SND_SOC_DAIFMT_RIGHT_J: > - i2s_config = EC_DAI_FMT_RIGHT_J; > - break; > - > - case SND_SOC_DAIFMT_LEFT_J: > - i2s_config = EC_DAI_FMT_LEFT_J; > - break; > - > - case SND_SOC_DAIFMT_DSP_A: > - i2s_config = EC_DAI_FMT_PCM_A; > - break; > - > - case SND_SOC_DAIFMT_DSP_B: > - i2s_config = EC_DAI_FMT_PCM_B; > - break; > + struct snd_soc_component *component = > + snd_soc_kcontrol_component(kcontrol); > + struct cros_ec_codec_priv *priv = > + snd_soc_component_get_drvdata(component); > + struct soc_mixer_control *control = > + (struct soc_mixer_control *)kcontrol->private_value; > + int max_dmic_gain = control->max; > + int left = ucontrol->value.integer.value[0]; > + int right = ucontrol->value.integer.value[1]; > + struct ec_param_ec_codec_i2s_rx p; > > - default: > + if (left > max_dmic_gain || right > max_dmic_gain) > return -EINVAL; > - } > > - return set_i2s_config(component, i2s_config); > -} > - > -static int set_i2s_sample_depth(struct snd_soc_component *component, > - enum ec_sample_depth_value depth) > -{ > - struct ec_param_codec_i2s param; > - > - dev_dbg(component->dev, "%s set depth to %u\n", __func__, depth); > - > - param.cmd = EC_CODEC_SET_SAMPLE_DEPTH; > - param.depth = depth; > + dev_dbg(component->dev, "set mic gain to %u, %u\n", left, right); > > - return ec_command_no_resp(component, ¶m); > + p.cmd = EC_CODEC_I2S_RX_SET_GAIN; > + p.set_gain_param.left = left; > + p.set_gain_param.right = right; > + return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), NULL, 0); > } > > -static int set_i2s_bclk(struct snd_soc_component *component, uint32_t bclk) > -{ > - struct ec_param_codec_i2s param; > - > - dev_dbg(component->dev, "%s set i2s bclk to %u\n", __func__, bclk); > +static const DECLARE_TLV_DB_SCALE(dmic_gain_tlv, 0, 100, 0); > > - param.cmd = EC_CODEC_I2S_SET_BCLK; > - param.bclk = bclk; > +enum { > + DMIC_CTL_GAIN = 0, > +}; > > - return ec_command_no_resp(component, ¶m); > -} > +static struct snd_kcontrol_new dmic_controls[] = { > + [DMIC_CTL_GAIN] = > + SOC_DOUBLE_EXT_TLV("EC Mic Gain", SND_SOC_NOPM, SND_SOC_NOPM, > + 0, 0, 0, dmic_get_gain, dmic_put_gain, > + dmic_gain_tlv), > +}; > > -static int cros_ec_i2s_hw_params(struct snd_pcm_substream *substream, > - struct snd_pcm_hw_params *params, > - struct snd_soc_dai *dai) > +static int i2s_rx_hw_params(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params, > + struct snd_soc_dai *dai) > { > struct snd_soc_component *component = dai->component; > - unsigned int rate, bclk; > + struct cros_ec_codec_priv *priv = > + snd_soc_component_get_drvdata(component); > + struct ec_param_ec_codec_i2s_rx p; > + enum ec_codec_i2s_rx_sample_depth depth; > int ret; > > - rate = params_rate(params); > - if (rate != 48000) > + if (params_rate(params) != 48000) > return -EINVAL; > > switch (params_format(params)) { > case SNDRV_PCM_FORMAT_S16_LE: > - ret = set_i2s_sample_depth(component, EC_CODEC_SAMPLE_DEPTH_16); > + depth = EC_CODEC_I2S_RX_SAMPLE_DEPTH_16; > break; > case SNDRV_PCM_FORMAT_S24_LE: > - ret = set_i2s_sample_depth(component, EC_CODEC_SAMPLE_DEPTH_24); > + depth = EC_CODEC_I2S_RX_SAMPLE_DEPTH_24; > break; > default: > return -EINVAL; > } > - if (ret < 0) > - return ret; > - > - bclk = snd_soc_params_to_bclk(params); > - return set_i2s_bclk(component, bclk); > -} > > -static const struct snd_soc_dai_ops cros_ec_i2s_dai_ops = { > - .hw_params = cros_ec_i2s_hw_params, > - .set_fmt = cros_ec_i2s_set_dai_fmt, > -}; > + dev_dbg(component->dev, "set depth to %u\n", depth); > > -static struct snd_soc_dai_driver cros_ec_dai[] = { > - { > - .name = "cros_ec_codec I2S", > - .id = 0, > - .capture = { > - .stream_name = "I2S Capture", > - .channels_min = 2, > - .channels_max = 2, > - .rates = SNDRV_PCM_RATE_48000, > - .formats = SNDRV_PCM_FMTBIT_S16_LE | > - SNDRV_PCM_FMTBIT_S24_LE, > - }, > - .ops = &cros_ec_i2s_dai_ops, > - } > -}; > - > -static int get_ec_mic_gain(struct snd_soc_component *component, > - u8 *left, u8 *right) > -{ > - struct ec_param_codec_i2s param; > - struct ec_codec_i2s_gain resp; > - int ret; > - > - param.cmd = EC_CODEC_GET_GAIN; > - > - ret = ec_command_get_gain(component, ¶m, &resp); > + p.cmd = EC_CODEC_I2S_RX_SET_SAMPLE_DEPTH; > + p.set_sample_depth_param.depth = depth; > + ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), NULL, 0); > if (ret < 0) > return ret; > > - *left = resp.left; > - *right = resp.right; > - > - return 0; > -} > - > -static int mic_gain_get(struct snd_kcontrol *kcontrol, > - struct snd_ctl_elem_value *ucontrol) > -{ > - struct snd_soc_component *component = > - snd_soc_kcontrol_component(kcontrol); > - u8 left, right; > - int ret; > - > - ret = get_ec_mic_gain(component, &left, &right); > - if (ret) > - return ret; > - > - ucontrol->value.integer.value[0] = left; > - ucontrol->value.integer.value[1] = right; > - > - return 0; > -} > - > -static int set_ec_mic_gain(struct snd_soc_component *component, > - u8 left, u8 right) > -{ > - struct ec_param_codec_i2s param; > - > - dev_dbg(component->dev, "%s set mic gain to %u, %u\n", > - __func__, left, right); > + dev_dbg(component->dev, "set bclk to %u\n", > + snd_soc_params_to_bclk(params)); > > - param.cmd = EC_CODEC_SET_GAIN; > - param.gain.left = left; > - param.gain.right = right; > - > - return ec_command_no_resp(component, ¶m); > + p.cmd = EC_CODEC_I2S_RX_SET_BCLK; > + p.set_bclk_param.bclk = snd_soc_params_to_bclk(params); > + return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), NULL, 0); > } > > -static int mic_gain_put(struct snd_kcontrol *kcontrol, > - struct snd_ctl_elem_value *ucontrol) > +static int i2s_rx_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) > { > - struct snd_soc_component *component = > - snd_soc_kcontrol_component(kcontrol); > - struct cros_ec_codec_data *codec_data = > + struct snd_soc_component *component = dai->component; > + struct cros_ec_codec_priv *priv = > snd_soc_component_get_drvdata(component); > - int left = ucontrol->value.integer.value[0]; > - int right = ucontrol->value.integer.value[1]; > - unsigned int max_dmic_gain = codec_data->max_dmic_gain; > + struct ec_param_ec_codec_i2s_rx p; > + enum ec_codec_i2s_rx_daifmt daifmt; > > - if (left > max_dmic_gain || right > max_dmic_gain) > + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { > + case SND_SOC_DAIFMT_CBS_CFS: > + break; > + default: > return -EINVAL; > + } > > - return set_ec_mic_gain(component, (u8)left, (u8)right); > -} > - > -static struct snd_kcontrol_new mic_gain_control = > - SOC_DOUBLE_EXT_TLV("EC Mic Gain", SND_SOC_NOPM, SND_SOC_NOPM, 0, 0, 0, > - mic_gain_get, mic_gain_put, ec_mic_gain_tlv); > - > -static int enable_i2s(struct snd_soc_component *component, int enable) > -{ > - struct ec_param_codec_i2s param; > + switch (fmt & SND_SOC_DAIFMT_INV_MASK) { > + case SND_SOC_DAIFMT_NB_NF: > + break; > + default: > + return -EINVAL; > + } > > - dev_dbg(component->dev, "%s set i2s to %u\n", __func__, enable); > + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { > + case SND_SOC_DAIFMT_I2S: > + daifmt = EC_CODEC_I2S_RX_DAIFMT_I2S; > + break; > + case SND_SOC_DAIFMT_RIGHT_J: > + daifmt = EC_CODEC_I2S_RX_DAIFMT_RIGHT_J; > + break; > + case SND_SOC_DAIFMT_LEFT_J: > + daifmt = EC_CODEC_I2S_RX_DAIFMT_LEFT_J; > + break; > + default: > + return -EINVAL; > + } > > - param.cmd = EC_CODEC_I2S_ENABLE; > - param.i2s_enable = enable; > + dev_dbg(component->dev, "set format to %u\n", daifmt); > > - return ec_command_no_resp(component, ¶m); > + p.cmd = EC_CODEC_I2S_RX_SET_DAIFMT; > + p.set_daifmt_param.daifmt = daifmt; > + return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), NULL, 0); > } > > -static int cros_ec_i2s_enable_event(struct snd_soc_dapm_widget *w, > - struct snd_kcontrol *kcontrol, int event) > +static const struct snd_soc_dai_ops i2s_rx_dai_ops = { > + .hw_params = i2s_rx_hw_params, > + .set_fmt = i2s_rx_set_fmt, > +}; > + > +static int i2s_rx_event(struct snd_soc_dapm_widget *w, > + struct snd_kcontrol *kcontrol, int event) > { > struct snd_soc_component *component = > snd_soc_dapm_to_component(w->dapm); > + struct cros_ec_codec_priv *priv = > + snd_soc_component_get_drvdata(component); > + struct ec_param_ec_codec_i2s_rx p; > > switch (event) { > case SND_SOC_DAPM_PRE_PMU: > - dev_dbg(component->dev, > - "%s got SND_SOC_DAPM_PRE_PMU event\n", __func__); > - return enable_i2s(component, 1); > - > + dev_dbg(component->dev, "enable I2S RX\n"); > + p.cmd = EC_CODEC_I2S_RX_ENABLE; > + break; > case SND_SOC_DAPM_PRE_PMD: > - dev_dbg(component->dev, > - "%s got SND_SOC_DAPM_PRE_PMD event\n", __func__); > - return enable_i2s(component, 0); > + dev_dbg(component->dev, "disable I2S RX\n"); > + p.cmd = EC_CODEC_I2S_RX_DISABLE; > + break; > + default: > + return 0; > } > > - return 0; > + return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX, > + (uint8_t *)&p, sizeof(p), NULL, 0); > } > > -/* > - * The goal of this DAPM route is to turn on/off I2S using EC > - * host command when capture stream is started/stopped. > - */ > -static const struct snd_soc_dapm_widget cros_ec_codec_dapm_widgets[] = { > +static struct snd_soc_dapm_widget i2s_rx_dapm_widgets[] = { > SND_SOC_DAPM_INPUT("DMIC"), > - > - /* > - * Control EC to enable/disable I2S. > - */ > - SND_SOC_DAPM_SUPPLY("I2S Enable", SND_SOC_NOPM, > - 0, 0, cros_ec_i2s_enable_event, > + SND_SOC_DAPM_SUPPLY("I2S RX Enable", SND_SOC_NOPM, 0, 0, i2s_rx_event, > SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD), > + SND_SOC_DAPM_AIF_OUT("I2S RX", "I2S Capture", 0, SND_SOC_NOPM, 0, 0), > +}; > > - SND_SOC_DAPM_AIF_OUT("I2STX", "I2S Capture", 0, SND_SOC_NOPM, 0, 0), > +static struct snd_soc_dapm_route i2s_rx_dapm_routes[] = { > + {"I2S RX", NULL, "DMIC"}, > + {"I2S RX", NULL, "I2S RX Enable"}, > }; > > -static const struct snd_soc_dapm_route cros_ec_codec_dapm_routes[] = { > - { "I2STX", NULL, "DMIC" }, > - { "I2STX", NULL, "I2S Enable" }, > +static struct snd_soc_dai_driver i2s_rx_dai_driver = { > + .name = "EC Codec I2S RX", > + .capture = { > + .stream_name = "I2S Capture", > + .channels_min = 2, > + .channels_max = 2, > + .rates = SNDRV_PCM_RATE_48000, > + .formats = SNDRV_PCM_FMTBIT_S16_LE | > + SNDRV_PCM_FMTBIT_S24_LE, > + }, > + .ops = &i2s_rx_dai_ops, > }; > > -/* > - * Read maximum gain from device property and set it to mixer control. > - */ > -static int cros_ec_set_gain_range(struct device *dev) > +static int i2s_rx_probe(struct snd_soc_component *component) > { > + struct cros_ec_codec_priv *priv = > + snd_soc_component_get_drvdata(component); > + struct device *dev = priv->dev; > + int ret, val; > struct soc_mixer_control *control; > - struct cros_ec_codec_data *codec_data = dev_get_drvdata(dev); > - int rc; > > - rc = device_property_read_u32(dev, "max-dmic-gain", > - &codec_data->max_dmic_gain); > - if (rc) > - return rc; > + ret = device_property_read_u32(dev, "max-dmic-gain", &val); > + if (ret) { > + dev_err(dev, "Failed to read 'max-dmic-gain'\n"); > + return ret; > + } > > control = (struct soc_mixer_control *) > - mic_gain_control.private_value; > - control->max = codec_data->max_dmic_gain; > - control->platform_max = codec_data->max_dmic_gain; > + dmic_controls[DMIC_CTL_GAIN].private_value; > + control->max = val; > + control->platform_max = val; > > - return 0; > -} > - > -static int cros_ec_codec_probe(struct snd_soc_component *component) > -{ > - int rc; > - > - struct cros_ec_codec_data *codec_data = > - snd_soc_component_get_drvdata(component); > - > - rc = cros_ec_set_gain_range(codec_data->dev); > - if (rc) > - return rc; > - > - return snd_soc_add_component_controls(component, &mic_gain_control, 1); > + return snd_soc_add_component_controls(component, > + &dmic_controls[DMIC_CTL_GAIN], 1); > } > > -static const struct snd_soc_component_driver cros_ec_component_driver = { > - .probe = cros_ec_codec_probe, > - .dapm_widgets = cros_ec_codec_dapm_widgets, > - .num_dapm_widgets = ARRAY_SIZE(cros_ec_codec_dapm_widgets), > - .dapm_routes = cros_ec_codec_dapm_routes, > - .num_dapm_routes = ARRAY_SIZE(cros_ec_codec_dapm_routes), > +static const struct snd_soc_component_driver i2s_rx_component_driver = { > + .probe = i2s_rx_probe, > + .dapm_widgets = i2s_rx_dapm_widgets, > + .num_dapm_widgets = ARRAY_SIZE(i2s_rx_dapm_widgets), > + .dapm_routes = i2s_rx_dapm_routes, > + .num_dapm_routes = ARRAY_SIZE(i2s_rx_dapm_routes), > }; > > -/* > - * Platform device and platform driver fro cros-ec-codec. > - */ > -static int cros_ec_codec_platform_probe(struct platform_device *pd) > +static int cros_ec_codec_platform_probe(struct platform_device *pdev) > { > - struct device *dev = &pd->dev; > - struct cros_ec_device *ec_device = dev_get_drvdata(pd->dev.parent); > - struct cros_ec_codec_data *codec_data; > + struct device *dev = &pdev->dev; > + struct cros_ec_device *ec_device = dev_get_drvdata(pdev->dev.parent); > + struct cros_ec_codec_priv *priv; > > - codec_data = devm_kzalloc(dev, sizeof(struct cros_ec_codec_data), > - GFP_KERNEL); > - if (!codec_data) > + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); > + if (!priv) > return -ENOMEM; > > - codec_data->dev = dev; > - codec_data->ec_device = ec_device; > + priv->dev = dev; > + priv->ec_device = ec_device; > > - platform_set_drvdata(pd, codec_data); > + platform_set_drvdata(pdev, priv); > > - return devm_snd_soc_register_component(dev, &cros_ec_component_driver, > - cros_ec_dai, ARRAY_SIZE(cros_ec_dai)); > + return devm_snd_soc_register_component(dev, &i2s_rx_component_driver, > + &i2s_rx_dai_driver, 1); > } > > #ifdef CONFIG_OF > @@ -427,7 +323,7 @@ MODULE_DEVICE_TABLE(of, cros_ec_codec_of_match); > > static struct platform_driver cros_ec_codec_platform_driver = { > .driver = { > - .name = DRV_NAME, > + .name = "cros-ec-codec", > .of_match_table = of_match_ptr(cros_ec_codec_of_match), > }, > .probe = cros_ec_codec_platform_probe, > @@ -438,4 +334,4 @@ module_platform_driver(cros_ec_codec_platform_driver); > MODULE_LICENSE("GPL v2"); > MODULE_DESCRIPTION("ChromeOS EC codec driver"); > MODULE_AUTHOR("Cheng-Yi Chiang <cychiang@xxxxxxxxxxxx>"); > -MODULE_ALIAS("platform:" DRV_NAME); > +MODULE_ALIAS("platform:cros-ec-codec"); > -- > 2.23.0.700.g56cf767bdb-goog > -- Benson Leung Staff Software Engineer Chrome OS Kernel Google Inc. bleung@xxxxxxxxxx Chromium OS Project bleung@xxxxxxxxxxxx
Attachment:
signature.asc
Description: PGP signature