12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * 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.
- */
- #include <crypto/sha.h>
- #include <linux/acpi.h>
- #include <linux/delay.h>
- #include <linux/device.h>
- #include <linux/io.h>
- #include <linux/jiffies.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/of_address.h>
- #include <linux/platform_data/cros_ec_commands.h>
- #include <linux/platform_data/cros_ec_proto.h>
- #include <linux/platform_device.h>
- #include <sound/pcm.h>
- #include <sound/pcm_params.h>
- #include <sound/soc.h>
- #include <sound/tlv.h>
- struct cros_ec_codec_priv {
- struct device *dev;
- struct cros_ec_device *ec_device;
- /* common */
- uint32_t ec_capabilities;
- uint64_t ec_shm_addr;
- uint32_t ec_shm_len;
- uint64_t ap_shm_phys_addr;
- uint32_t ap_shm_len;
- uint64_t ap_shm_addr;
- uint64_t ap_shm_last_alloc;
- /* DMIC */
- atomic_t dmic_probed;
- /* I2S_RX */
- uint32_t i2s_rx_bclk_ratio;
- /* WoV */
- bool wov_enabled;
- uint8_t *wov_audio_shm_p;
- uint32_t wov_audio_shm_len;
- uint8_t wov_audio_shm_type;
- uint8_t *wov_lang_shm_p;
- uint32_t wov_lang_shm_len;
- uint8_t wov_lang_shm_type;
- struct mutex wov_dma_lock;
- uint8_t wov_buf[64000];
- uint32_t wov_rp, wov_wp;
- size_t wov_dma_offset;
- bool wov_burst_read;
- struct snd_pcm_substream *wov_substream;
- struct delayed_work wov_copy_work;
- struct notifier_block wov_notifier;
- };
- static int ec_codec_capable(struct cros_ec_codec_priv *priv, uint8_t cap)
- {
- return priv->ec_capabilities & BIT(cap);
- }
- 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)
- {
- 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 = cmd;
- msg->outsize = outsize;
- msg->insize = insize;
- if (outsize)
- memcpy(msg->data, out, outsize);
- ret = cros_ec_cmd_xfer_status(ec_dev, msg);
- if (ret < 0)
- goto error;
- if (insize)
- memcpy(in, msg->data, insize);
- ret = 0;
- error:
- kfree(msg);
- return ret;
- }
- static int dmic_get_gain(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct snd_soc_component *component =
- snd_soc_kcontrol_component(kcontrol);
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- struct ec_param_ec_codec_dmic p;
- struct ec_response_ec_codec_dmic_get_gain_idx r;
- int ret;
- p.cmd = EC_CODEC_DMIC_GET_GAIN_IDX;
- p.get_gain_idx_param.channel = EC_CODEC_DMIC_CHANNEL_0;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_DMIC,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret < 0)
- return ret;
- ucontrol->value.integer.value[0] = r.gain;
- p.cmd = EC_CODEC_DMIC_GET_GAIN_IDX;
- p.get_gain_idx_param.channel = EC_CODEC_DMIC_CHANNEL_1;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_DMIC,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret < 0)
- return ret;
- ucontrol->value.integer.value[1] = r.gain;
- return 0;
- }
- static int dmic_put_gain(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- 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_dmic p;
- int ret;
- if (left > max_dmic_gain || right > max_dmic_gain)
- return -EINVAL;
- dev_dbg(component->dev, "set mic gain to %u, %u\n", left, right);
- p.cmd = EC_CODEC_DMIC_SET_GAIN_IDX;
- p.set_gain_idx_param.channel = EC_CODEC_DMIC_CHANNEL_0;
- p.set_gain_idx_param.gain = left;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_DMIC,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- if (ret < 0)
- return ret;
- p.cmd = EC_CODEC_DMIC_SET_GAIN_IDX;
- p.set_gain_idx_param.channel = EC_CODEC_DMIC_CHANNEL_1;
- p.set_gain_idx_param.gain = right;
- return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_DMIC,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- }
- static const DECLARE_TLV_DB_SCALE(dmic_gain_tlv, 0, 100, 0);
- enum {
- DMIC_CTL_GAIN = 0,
- };
- 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 dmic_probe(struct snd_soc_component *component)
- {
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- struct device *dev = priv->dev;
- struct soc_mixer_control *control;
- struct ec_param_ec_codec_dmic p;
- struct ec_response_ec_codec_dmic_get_max_gain r;
- int ret;
- if (!atomic_add_unless(&priv->dmic_probed, 1, 1))
- return 0;
- p.cmd = EC_CODEC_DMIC_GET_MAX_GAIN;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_DMIC,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret < 0) {
- dev_warn(dev, "get_max_gain() unsupported\n");
- return 0;
- }
- dev_dbg(dev, "max gain = %d\n", r.max_gain);
- control = (struct soc_mixer_control *)
- dmic_controls[DMIC_CTL_GAIN].private_value;
- control->max = r.max_gain;
- control->platform_max = r.max_gain;
- return snd_soc_add_component_controls(component,
- &dmic_controls[DMIC_CTL_GAIN], 1);
- }
- 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;
- 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;
- uint32_t bclk;
- int ret;
- if (params_rate(params) != 48000)
- return -EINVAL;
- switch (params_format(params)) {
- case SNDRV_PCM_FORMAT_S16_LE:
- depth = EC_CODEC_I2S_RX_SAMPLE_DEPTH_16;
- break;
- case SNDRV_PCM_FORMAT_S24_LE:
- depth = EC_CODEC_I2S_RX_SAMPLE_DEPTH_24;
- break;
- default:
- return -EINVAL;
- }
- dev_dbg(component->dev, "set depth to %u\n", depth);
- 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;
- if (priv->i2s_rx_bclk_ratio)
- bclk = params_rate(params) * priv->i2s_rx_bclk_ratio;
- else
- bclk = snd_soc_params_to_bclk(params);
- dev_dbg(component->dev, "set bclk to %u\n", bclk);
- p.cmd = EC_CODEC_I2S_RX_SET_BCLK;
- p.set_bclk_param.bclk = bclk;
- return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- }
- static int i2s_rx_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
- {
- struct snd_soc_component *component = dai->component;
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- priv->i2s_rx_bclk_ratio = ratio;
- return 0;
- }
- static int i2s_rx_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
- {
- struct snd_soc_component *component = dai->component;
- 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_daifmt daifmt;
- 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:
- 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;
- }
- dev_dbg(component->dev, "set format to %u\n", daifmt);
- 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 const struct snd_soc_dai_ops i2s_rx_dai_ops = {
- .hw_params = i2s_rx_hw_params,
- .set_fmt = i2s_rx_set_fmt,
- .set_bclk_ratio = i2s_rx_set_bclk_ratio,
- };
- 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, "enable I2S RX\n");
- p.cmd = EC_CODEC_I2S_RX_ENABLE;
- break;
- case SND_SOC_DAPM_PRE_PMD:
- dev_dbg(component->dev, "disable I2S RX\n");
- p.cmd = EC_CODEC_I2S_RX_DISABLE;
- break;
- default:
- return 0;
- }
- return send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_I2S_RX,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- }
- static struct snd_soc_dapm_widget i2s_rx_dapm_widgets[] = {
- SND_SOC_DAPM_INPUT("DMIC"),
- 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),
- };
- static struct snd_soc_dapm_route i2s_rx_dapm_routes[] = {
- {"I2S RX", NULL, "DMIC"},
- {"I2S RX", NULL, "I2S RX 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,
- };
- static int i2s_rx_probe(struct snd_soc_component *component)
- {
- return dmic_probe(component);
- }
- 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),
- };
- static void *wov_map_shm(struct cros_ec_codec_priv *priv,
- uint8_t shm_id, uint32_t *len, uint8_t *type)
- {
- struct ec_param_ec_codec p;
- struct ec_response_ec_codec_get_shm_addr r;
- uint32_t req, offset;
- p.cmd = EC_CODEC_GET_SHM_ADDR;
- p.get_shm_addr_param.shm_id = shm_id;
- if (send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r)) < 0) {
- dev_err(priv->dev, "failed to EC_CODEC_GET_SHM_ADDR\n");
- return NULL;
- }
- dev_dbg(priv->dev, "phys_addr=%#llx, len=%#x\n", r.phys_addr, r.len);
- *len = r.len;
- *type = r.type;
- switch (r.type) {
- case EC_CODEC_SHM_TYPE_EC_RAM:
- return (void __force *)devm_ioremap_wc(priv->dev,
- r.phys_addr + priv->ec_shm_addr, r.len);
- case EC_CODEC_SHM_TYPE_SYSTEM_RAM:
- if (r.phys_addr) {
- dev_err(priv->dev, "unknown status\n");
- return NULL;
- }
- req = round_up(r.len, PAGE_SIZE);
- dev_dbg(priv->dev, "round up from %u to %u\n", r.len, req);
- if (priv->ap_shm_last_alloc + req >
- priv->ap_shm_phys_addr + priv->ap_shm_len) {
- dev_err(priv->dev, "insufficient space for AP SHM\n");
- return NULL;
- }
- dev_dbg(priv->dev, "alloc AP SHM addr=%#llx, len=%#x\n",
- priv->ap_shm_last_alloc, req);
- p.cmd = EC_CODEC_SET_SHM_ADDR;
- p.set_shm_addr_param.phys_addr = priv->ap_shm_last_alloc;
- p.set_shm_addr_param.len = req;
- p.set_shm_addr_param.shm_id = shm_id;
- if (send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC,
- (uint8_t *)&p, sizeof(p),
- NULL, 0) < 0) {
- dev_err(priv->dev, "failed to EC_CODEC_SET_SHM_ADDR\n");
- return NULL;
- }
- /*
- * Note: EC codec only requests for `r.len' but we allocate
- * round up PAGE_SIZE `req'.
- */
- offset = priv->ap_shm_last_alloc - priv->ap_shm_phys_addr;
- priv->ap_shm_last_alloc += req;
- return (void *)(uintptr_t)(priv->ap_shm_addr + offset);
- default:
- return NULL;
- }
- }
- static bool wov_queue_full(struct cros_ec_codec_priv *priv)
- {
- return ((priv->wov_wp + 1) % sizeof(priv->wov_buf)) == priv->wov_rp;
- }
- static size_t wov_queue_size(struct cros_ec_codec_priv *priv)
- {
- if (priv->wov_wp >= priv->wov_rp)
- return priv->wov_wp - priv->wov_rp;
- else
- return sizeof(priv->wov_buf) - priv->wov_rp + priv->wov_wp;
- }
- static void wov_queue_dequeue(struct cros_ec_codec_priv *priv, size_t len)
- {
- struct snd_pcm_runtime *runtime = priv->wov_substream->runtime;
- size_t req;
- while (len) {
- req = min(len, runtime->dma_bytes - priv->wov_dma_offset);
- if (priv->wov_wp >= priv->wov_rp)
- req = min(req, (size_t)priv->wov_wp - priv->wov_rp);
- else
- req = min(req, sizeof(priv->wov_buf) - priv->wov_rp);
- memcpy(runtime->dma_area + priv->wov_dma_offset,
- priv->wov_buf + priv->wov_rp, req);
- priv->wov_dma_offset += req;
- if (priv->wov_dma_offset == runtime->dma_bytes)
- priv->wov_dma_offset = 0;
- priv->wov_rp += req;
- if (priv->wov_rp == sizeof(priv->wov_buf))
- priv->wov_rp = 0;
- len -= req;
- }
- snd_pcm_period_elapsed(priv->wov_substream);
- }
- static void wov_queue_try_dequeue(struct cros_ec_codec_priv *priv)
- {
- size_t period_bytes = snd_pcm_lib_period_bytes(priv->wov_substream);
- while (period_bytes && wov_queue_size(priv) >= period_bytes) {
- wov_queue_dequeue(priv, period_bytes);
- period_bytes = snd_pcm_lib_period_bytes(priv->wov_substream);
- }
- }
- static void wov_queue_enqueue(struct cros_ec_codec_priv *priv,
- uint8_t *addr, size_t len, bool iomem)
- {
- size_t req;
- while (len) {
- if (wov_queue_full(priv)) {
- wov_queue_try_dequeue(priv);
- if (wov_queue_full(priv)) {
- dev_err(priv->dev, "overrun detected\n");
- return;
- }
- }
- if (priv->wov_wp >= priv->wov_rp)
- req = sizeof(priv->wov_buf) - priv->wov_wp;
- else
- /* Note: waste 1-byte to differentiate full and empty */
- req = priv->wov_rp - priv->wov_wp - 1;
- req = min(req, len);
- if (iomem)
- memcpy_fromio(priv->wov_buf + priv->wov_wp,
- (void __force __iomem *)addr, req);
- else
- memcpy(priv->wov_buf + priv->wov_wp, addr, req);
- priv->wov_wp += req;
- if (priv->wov_wp == sizeof(priv->wov_buf))
- priv->wov_wp = 0;
- addr += req;
- len -= req;
- }
- wov_queue_try_dequeue(priv);
- }
- static int wov_read_audio_shm(struct cros_ec_codec_priv *priv)
- {
- struct ec_param_ec_codec_wov p;
- struct ec_response_ec_codec_wov_read_audio_shm r;
- int ret;
- p.cmd = EC_CODEC_WOV_READ_AUDIO_SHM;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret) {
- dev_err(priv->dev, "failed to EC_CODEC_WOV_READ_AUDIO_SHM\n");
- return ret;
- }
- if (!r.len)
- dev_dbg(priv->dev, "no data, sleep\n");
- else
- wov_queue_enqueue(priv, priv->wov_audio_shm_p + r.offset, r.len,
- priv->wov_audio_shm_type == EC_CODEC_SHM_TYPE_EC_RAM);
- return -EAGAIN;
- }
- static int wov_read_audio(struct cros_ec_codec_priv *priv)
- {
- struct ec_param_ec_codec_wov p;
- struct ec_response_ec_codec_wov_read_audio r;
- int remain = priv->wov_burst_read ? 16000 : 320;
- int ret;
- while (remain >= 0) {
- p.cmd = EC_CODEC_WOV_READ_AUDIO;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret) {
- dev_err(priv->dev,
- "failed to EC_CODEC_WOV_READ_AUDIO\n");
- return ret;
- }
- if (!r.len) {
- dev_dbg(priv->dev, "no data, sleep\n");
- priv->wov_burst_read = false;
- break;
- }
- wov_queue_enqueue(priv, r.buf, r.len, false);
- remain -= r.len;
- }
- return -EAGAIN;
- }
- static void wov_copy_work(struct work_struct *w)
- {
- struct cros_ec_codec_priv *priv =
- container_of(w, struct cros_ec_codec_priv, wov_copy_work.work);
- int ret;
- mutex_lock(&priv->wov_dma_lock);
- if (!priv->wov_substream) {
- dev_warn(priv->dev, "no pcm substream\n");
- goto leave;
- }
- if (ec_codec_capable(priv, EC_CODEC_CAP_WOV_AUDIO_SHM))
- ret = wov_read_audio_shm(priv);
- else
- ret = wov_read_audio(priv);
- if (ret == -EAGAIN)
- schedule_delayed_work(&priv->wov_copy_work,
- msecs_to_jiffies(10));
- else if (ret)
- dev_err(priv->dev, "failed to read audio data\n");
- leave:
- mutex_unlock(&priv->wov_dma_lock);
- }
- static int wov_enable_get(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct snd_soc_component *c = snd_soc_kcontrol_component(kcontrol);
- struct cros_ec_codec_priv *priv = snd_soc_component_get_drvdata(c);
- ucontrol->value.integer.value[0] = priv->wov_enabled;
- return 0;
- }
- static int wov_enable_put(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct snd_soc_component *c = snd_soc_kcontrol_component(kcontrol);
- struct cros_ec_codec_priv *priv = snd_soc_component_get_drvdata(c);
- int enabled = ucontrol->value.integer.value[0];
- struct ec_param_ec_codec_wov p;
- int ret;
- if (priv->wov_enabled != enabled) {
- if (enabled)
- p.cmd = EC_CODEC_WOV_ENABLE;
- else
- p.cmd = EC_CODEC_WOV_DISABLE;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- if (ret) {
- dev_err(priv->dev, "failed to %s wov\n",
- enabled ? "enable" : "disable");
- return ret;
- }
- priv->wov_enabled = enabled;
- }
- return 0;
- }
- static int wov_set_lang_shm(struct cros_ec_codec_priv *priv,
- uint8_t *buf, size_t size, uint8_t *digest)
- {
- struct ec_param_ec_codec_wov p;
- struct ec_param_ec_codec_wov_set_lang_shm *pp = &p.set_lang_shm_param;
- int ret;
- if (size > priv->wov_lang_shm_len) {
- dev_err(priv->dev, "no enough SHM size: %d\n",
- priv->wov_lang_shm_len);
- return -EIO;
- }
- switch (priv->wov_lang_shm_type) {
- case EC_CODEC_SHM_TYPE_EC_RAM:
- memcpy_toio((void __force __iomem *)priv->wov_lang_shm_p,
- buf, size);
- memset_io((void __force __iomem *)priv->wov_lang_shm_p + size,
- 0, priv->wov_lang_shm_len - size);
- break;
- case EC_CODEC_SHM_TYPE_SYSTEM_RAM:
- memcpy(priv->wov_lang_shm_p, buf, size);
- memset(priv->wov_lang_shm_p + size, 0,
- priv->wov_lang_shm_len - size);
- /* make sure write to memory before calling host command */
- wmb();
- break;
- }
- p.cmd = EC_CODEC_WOV_SET_LANG_SHM;
- memcpy(pp->hash, digest, SHA256_DIGEST_SIZE);
- pp->total_len = size;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- if (ret) {
- dev_err(priv->dev, "failed to EC_CODEC_WOV_SET_LANG_SHM\n");
- return ret;
- }
- return 0;
- }
- static int wov_set_lang(struct cros_ec_codec_priv *priv,
- uint8_t *buf, size_t size, uint8_t *digest)
- {
- struct ec_param_ec_codec_wov p;
- struct ec_param_ec_codec_wov_set_lang *pp = &p.set_lang_param;
- size_t i, req;
- int ret;
- for (i = 0; i < size; i += req) {
- req = min(size - i, ARRAY_SIZE(pp->buf));
- p.cmd = EC_CODEC_WOV_SET_LANG;
- memcpy(pp->hash, digest, SHA256_DIGEST_SIZE);
- pp->total_len = size;
- pp->offset = i;
- memcpy(pp->buf, buf + i, req);
- pp->len = req;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p), NULL, 0);
- if (ret) {
- dev_err(priv->dev, "failed to EC_CODEC_WOV_SET_LANG\n");
- return ret;
- }
- }
- return 0;
- }
- static int wov_hotword_model_put(struct snd_kcontrol *kcontrol,
- const unsigned int __user *bytes,
- unsigned int size)
- {
- struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- struct ec_param_ec_codec_wov p;
- struct ec_response_ec_codec_wov_get_lang r;
- uint8_t digest[SHA256_DIGEST_SIZE];
- uint8_t *buf;
- int ret;
- /* Skips the TLV header. */
- bytes += 2;
- size -= 8;
- dev_dbg(priv->dev, "%s: size=%d\n", __func__, size);
- buf = memdup_user(bytes, size);
- if (IS_ERR(buf))
- return PTR_ERR(buf);
- sha256(buf, size, digest);
- dev_dbg(priv->dev, "hash=%*phN\n", SHA256_DIGEST_SIZE, digest);
- p.cmd = EC_CODEC_WOV_GET_LANG;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC_WOV,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret)
- goto leave;
- if (memcmp(digest, r.hash, SHA256_DIGEST_SIZE) == 0) {
- dev_dbg(priv->dev, "not updated");
- goto leave;
- }
- if (ec_codec_capable(priv, EC_CODEC_CAP_WOV_LANG_SHM))
- ret = wov_set_lang_shm(priv, buf, size, digest);
- else
- ret = wov_set_lang(priv, buf, size, digest);
- leave:
- kfree(buf);
- return ret;
- }
- static struct snd_kcontrol_new wov_controls[] = {
- SOC_SINGLE_BOOL_EXT("Wake-on-Voice Switch", 0,
- wov_enable_get, wov_enable_put),
- SND_SOC_BYTES_TLV("Hotword Model", 0x11000, NULL,
- wov_hotword_model_put),
- };
- static struct snd_soc_dai_driver wov_dai_driver = {
- .name = "Wake on Voice",
- .capture = {
- .stream_name = "WoV Capture",
- .channels_min = 1,
- .channels_max = 1,
- .rates = SNDRV_PCM_RATE_16000,
- .formats = SNDRV_PCM_FMTBIT_S16_LE,
- },
- };
- static int wov_host_event(struct notifier_block *nb,
- unsigned long queued_during_suspend, void *notify)
- {
- struct cros_ec_codec_priv *priv =
- container_of(nb, struct cros_ec_codec_priv, wov_notifier);
- u32 host_event;
- dev_dbg(priv->dev, "%s\n", __func__);
- host_event = cros_ec_get_host_event(priv->ec_device);
- if (host_event & EC_HOST_EVENT_MASK(EC_HOST_EVENT_WOV)) {
- schedule_delayed_work(&priv->wov_copy_work, 0);
- return NOTIFY_OK;
- } else {
- return NOTIFY_DONE;
- }
- }
- static int wov_probe(struct snd_soc_component *component)
- {
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- int ret;
- mutex_init(&priv->wov_dma_lock);
- INIT_DELAYED_WORK(&priv->wov_copy_work, wov_copy_work);
- priv->wov_notifier.notifier_call = wov_host_event;
- ret = blocking_notifier_chain_register(
- &priv->ec_device->event_notifier, &priv->wov_notifier);
- if (ret)
- return ret;
- if (ec_codec_capable(priv, EC_CODEC_CAP_WOV_LANG_SHM)) {
- priv->wov_lang_shm_p = wov_map_shm(priv,
- EC_CODEC_SHM_ID_WOV_LANG,
- &priv->wov_lang_shm_len,
- &priv->wov_lang_shm_type);
- if (!priv->wov_lang_shm_p)
- return -EFAULT;
- }
- if (ec_codec_capable(priv, EC_CODEC_CAP_WOV_AUDIO_SHM)) {
- priv->wov_audio_shm_p = wov_map_shm(priv,
- EC_CODEC_SHM_ID_WOV_AUDIO,
- &priv->wov_audio_shm_len,
- &priv->wov_audio_shm_type);
- if (!priv->wov_audio_shm_p)
- return -EFAULT;
- }
- return dmic_probe(component);
- }
- static void wov_remove(struct snd_soc_component *component)
- {
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- blocking_notifier_chain_unregister(
- &priv->ec_device->event_notifier, &priv->wov_notifier);
- }
- static int wov_pcm_open(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- static const struct snd_pcm_hardware hw_param = {
- .info = SNDRV_PCM_INFO_MMAP |
- SNDRV_PCM_INFO_INTERLEAVED |
- SNDRV_PCM_INFO_MMAP_VALID,
- .formats = SNDRV_PCM_FMTBIT_S16_LE,
- .rates = SNDRV_PCM_RATE_16000,
- .channels_min = 1,
- .channels_max = 1,
- .period_bytes_min = PAGE_SIZE,
- .period_bytes_max = 0x20000 / 8,
- .periods_min = 8,
- .periods_max = 8,
- .buffer_bytes_max = 0x20000,
- };
- return snd_soc_set_runtime_hwparams(substream, &hw_param);
- }
- static int wov_pcm_hw_params(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *hw_params)
- {
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- mutex_lock(&priv->wov_dma_lock);
- priv->wov_substream = substream;
- priv->wov_rp = priv->wov_wp = 0;
- priv->wov_dma_offset = 0;
- priv->wov_burst_read = true;
- mutex_unlock(&priv->wov_dma_lock);
- return 0;
- }
- static int wov_pcm_hw_free(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- mutex_lock(&priv->wov_dma_lock);
- wov_queue_dequeue(priv, wov_queue_size(priv));
- priv->wov_substream = NULL;
- mutex_unlock(&priv->wov_dma_lock);
- cancel_delayed_work_sync(&priv->wov_copy_work);
- return 0;
- }
- static snd_pcm_uframes_t wov_pcm_pointer(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_pcm_runtime *runtime = substream->runtime;
- struct cros_ec_codec_priv *priv =
- snd_soc_component_get_drvdata(component);
- return bytes_to_frames(runtime, priv->wov_dma_offset);
- }
- static int wov_pcm_new(struct snd_soc_component *component,
- struct snd_soc_pcm_runtime *rtd)
- {
- snd_pcm_set_managed_buffer_all(rtd->pcm, SNDRV_DMA_TYPE_VMALLOC,
- NULL, 0, 0);
- return 0;
- }
- static const struct snd_soc_component_driver wov_component_driver = {
- .probe = wov_probe,
- .remove = wov_remove,
- .controls = wov_controls,
- .num_controls = ARRAY_SIZE(wov_controls),
- .open = wov_pcm_open,
- .hw_params = wov_pcm_hw_params,
- .hw_free = wov_pcm_hw_free,
- .pointer = wov_pcm_pointer,
- .pcm_construct = wov_pcm_new,
- };
- static int cros_ec_codec_platform_probe(struct platform_device *pdev)
- {
- struct device *dev = &pdev->dev;
- struct cros_ec_device *ec_device = dev_get_drvdata(pdev->dev.parent);
- struct cros_ec_codec_priv *priv;
- struct ec_param_ec_codec p;
- struct ec_response_ec_codec_get_capabilities r;
- int ret;
- #ifdef CONFIG_OF
- struct device_node *node;
- struct resource res;
- u64 ec_shm_size;
- const __be32 *regaddr_p;
- #endif
- priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
- return -ENOMEM;
- #ifdef CONFIG_OF
- regaddr_p = of_get_address(dev->of_node, 0, &ec_shm_size, NULL);
- if (regaddr_p) {
- priv->ec_shm_addr = of_read_number(regaddr_p, 2);
- priv->ec_shm_len = ec_shm_size;
- dev_dbg(dev, "ec_shm_addr=%#llx len=%#x\n",
- priv->ec_shm_addr, priv->ec_shm_len);
- }
- node = of_parse_phandle(dev->of_node, "memory-region", 0);
- if (node) {
- ret = of_address_to_resource(node, 0, &res);
- if (!ret) {
- priv->ap_shm_phys_addr = res.start;
- priv->ap_shm_len = resource_size(&res);
- priv->ap_shm_addr =
- (uint64_t)(uintptr_t)devm_ioremap_wc(
- dev, priv->ap_shm_phys_addr,
- priv->ap_shm_len);
- priv->ap_shm_last_alloc = priv->ap_shm_phys_addr;
- dev_dbg(dev, "ap_shm_phys_addr=%#llx len=%#x\n",
- priv->ap_shm_phys_addr, priv->ap_shm_len);
- }
- }
- #endif
- priv->dev = dev;
- priv->ec_device = ec_device;
- atomic_set(&priv->dmic_probed, 0);
- p.cmd = EC_CODEC_GET_CAPABILITIES;
- ret = send_ec_host_command(priv->ec_device, EC_CMD_EC_CODEC,
- (uint8_t *)&p, sizeof(p),
- (uint8_t *)&r, sizeof(r));
- if (ret) {
- dev_err(dev, "failed to EC_CODEC_GET_CAPABILITIES\n");
- return ret;
- }
- priv->ec_capabilities = r.capabilities;
- platform_set_drvdata(pdev, priv);
- ret = devm_snd_soc_register_component(dev, &i2s_rx_component_driver,
- &i2s_rx_dai_driver, 1);
- if (ret)
- return ret;
- return devm_snd_soc_register_component(dev, &wov_component_driver,
- &wov_dai_driver, 1);
- }
- #ifdef CONFIG_OF
- static const struct of_device_id cros_ec_codec_of_match[] = {
- { .compatible = "google,cros-ec-codec" },
- {},
- };
- MODULE_DEVICE_TABLE(of, cros_ec_codec_of_match);
- #endif
- #ifdef CONFIG_ACPI
- static const struct acpi_device_id cros_ec_codec_acpi_id[] = {
- { "GOOG0013", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(acpi, cros_ec_codec_acpi_id);
- #endif
- static struct platform_driver cros_ec_codec_platform_driver = {
- .driver = {
- .name = "cros-ec-codec",
- .of_match_table = of_match_ptr(cros_ec_codec_of_match),
- .acpi_match_table = ACPI_PTR(cros_ec_codec_acpi_id),
- },
- .probe = cros_ec_codec_platform_probe,
- };
- module_platform_driver(cros_ec_codec_platform_driver);
- MODULE_LICENSE("GPL v2");
- MODULE_DESCRIPTION("ChromeOS EC codec driver");
- MODULE_AUTHOR("Cheng-Yi Chiang <cychiang@chromium.org>");
- MODULE_ALIAS("platform:cros-ec-codec");
|