| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947 |
- // SPDX-License-Identifier: GPL-2.0
- //
- // TAS2781 HDA SPI driver
- //
- // Copyright 2024 - 2026 Texas Instruments, Inc.
- //
- // Author: Baojun Xu <baojun.xu@ti.com>
- #include <linux/acpi.h>
- #include <linux/array_size.h>
- #include <linux/bits.h>
- #include <linux/cleanup.h>
- #include <linux/crc8.h>
- #include <linux/crc32.h>
- #include <linux/efi.h>
- #include <linux/firmware.h>
- #include <linux/mod_devicetable.h>
- #include <linux/module.h>
- #include <linux/mutex.h>
- #include <linux/pm_runtime.h>
- #include <linux/property.h>
- #include <linux/regmap.h>
- #include <linux/spi/spi.h>
- #include <linux/time.h>
- #include <linux/types.h>
- #include <linux/units.h>
- #include <sound/hda_codec.h>
- #include <sound/soc.h>
- #include <sound/tas2781.h>
- #include <sound/tlv.h>
- #include <sound/tas2781-tlv.h>
- #include "hda_local.h"
- #include "hda_auto_parser.h"
- #include "hda_component.h"
- #include "hda_jack.h"
- #include "../generic.h"
- #include "tas2781_hda.h"
- #define TASDEVICE_RANGE_MAX_SIZE (256 * 128)
- #define TASDEVICE_WIN_LEN 128
- #define TAS2781_SPI_MAX_FREQ (4 * HZ_PER_MHZ)
- /* System Reset Check Register */
- #define TAS2781_REG_CLK_CONFIG TASDEVICE_REG(0x0, 0x0, 0x5c)
- #define TAS2781_REG_CLK_CONFIG_RESET 0x19
- struct tas2781_hda_spi_priv {
- struct snd_kcontrol *snd_ctls[3];
- };
- static const struct regmap_range_cfg tasdevice_ranges[] = {
- {
- .range_min = 0,
- .range_max = TASDEVICE_RANGE_MAX_SIZE,
- .selector_reg = TASDEVICE_PAGE_SELECT,
- .selector_mask = GENMASK(7, 0),
- .selector_shift = 0,
- .window_start = 0,
- .window_len = TASDEVICE_WIN_LEN,
- },
- };
- static const struct regmap_config tasdevice_regmap = {
- .reg_bits = 8,
- .val_bits = 8,
- .zero_flag_mask = true,
- .read_flag_mask = 0x01,
- .reg_shift = -1,
- .cache_type = REGCACHE_NONE,
- .ranges = tasdevice_ranges,
- .num_ranges = ARRAY_SIZE(tasdevice_ranges),
- .max_register = TASDEVICE_RANGE_MAX_SIZE,
- };
- static int tasdevice_spi_dev_read(struct tasdevice_priv *tas_priv,
- unsigned short chn, unsigned int reg, unsigned int *val)
- {
- int ret;
- /*
- * In our TAS2781 SPI mode, if read from other book (not book 0),
- * or read from page number larger than 1 in book 0, one more byte
- * read is needed, and first byte is a dummy byte, need to be ignored.
- */
- if ((TASDEVICE_BOOK_ID(reg) > 0) || (TASDEVICE_PAGE_ID(reg) > 1)) {
- unsigned char data[2];
- ret = tasdevice_dev_bulk_read(tas_priv, chn, reg,
- data, sizeof(data));
- *val = data[1];
- } else {
- ret = tasdevice_dev_read(tas_priv, chn, reg, val);
- }
- if (ret < 0)
- dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
- return ret;
- }
- static int tasdevice_spi_dev_bulk_read(struct tasdevice_priv *tas_priv,
- unsigned short chn, unsigned int reg, unsigned char *data,
- unsigned int len)
- {
- int ret;
- /*
- * In our TAS2781 SPI mode, if read from other book (not book 0),
- * or read from page number larger than 1 in book 0, one more byte
- * read is needed, and first byte is a dummy byte, need to be ignored.
- */
- if ((TASDEVICE_BOOK_ID(reg) > 0) || (TASDEVICE_PAGE_ID(reg) > 1)) {
- unsigned char buf[TASDEVICE_WIN_LEN + 1];
- ret = tasdevice_dev_bulk_read(tas_priv, chn, reg,
- buf, len + 1);
- memcpy(data, buf + 1, len);
- } else {
- ret = tasdevice_dev_bulk_read(tas_priv, chn, reg, data, len);
- }
- if (ret < 0)
- dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
- return ret;
- }
- static int tasdevice_spi_dev_update_bits(struct tasdevice_priv *tas_priv,
- unsigned short chn, unsigned int reg, unsigned int mask,
- unsigned int value)
- {
- int ret, val;
- /*
- * In our TAS2781 SPI mode, read/write was masked in last bit of
- * address, it cause regmap_update_bits() not work as expected.
- */
- ret = tasdevice_dev_read(tas_priv, chn, reg, &val);
- if (ret < 0) {
- dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
- return ret;
- }
- ret = tasdevice_dev_write(tas_priv, chn, TASDEVICE_PAGE_REG(reg),
- (val & ~mask) | (mask & value));
- if (ret < 0)
- dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
- return ret;
- }
- static int tasdevice_spi_change_chn_book(struct tasdevice_priv *p,
- unsigned short chn, int book)
- {
- int ret = 0;
- if (chn == p->index) {
- struct tasdevice *tasdev = &p->tasdevice[chn];
- struct regmap *map = p->regmap;
- if (tasdev->cur_book != book) {
- ret = regmap_write(map, TASDEVICE_BOOKCTL_REG, book);
- if (ret < 0)
- dev_err(p->dev, "%s, E=%d\n", __func__, ret);
- else
- tasdev->cur_book = book;
- }
- } else {
- ret = -EXDEV;
- dev_dbg(p->dev, "Not error, %s ignore channel(%d)\n",
- __func__, chn);
- }
- return ret;
- }
- static void tas2781_spi_reset(struct tasdevice_priv *tas_dev)
- {
- int ret;
- if (tas_dev->reset) {
- gpiod_set_value_cansleep(tas_dev->reset, 0);
- fsleep(800);
- gpiod_set_value_cansleep(tas_dev->reset, 1);
- } else {
- ret = tasdevice_dev_write(tas_dev, tas_dev->index,
- TASDEVICE_REG_SWRESET, TASDEVICE_REG_SWRESET_RESET);
- if (ret < 0) {
- dev_err(tas_dev->dev, "dev sw-reset fail, %d\n", ret);
- return;
- }
- fsleep(1000);
- }
- }
- static int tascodec_spi_init(struct tasdevice_priv *tas_priv,
- void *codec, struct module *module,
- void (*cont)(const struct firmware *fw, void *context))
- {
- int ret;
- /*
- * Codec Lock Hold to ensure that codec_probe and firmware parsing and
- * loading do not simultaneously execute.
- */
- guard(mutex)(&tas_priv->codec_lock);
- scnprintf(tas_priv->rca_binaryname,
- sizeof(tas_priv->rca_binaryname), "%sRCA%d.bin",
- tas_priv->dev_name, tas_priv->ndev);
- crc8_populate_msb(tas_priv->crc8_lkp_tbl, TASDEVICE_CRC8_POLYNOMIAL);
- tas_priv->codec = codec;
- ret = request_firmware_nowait(module, FW_ACTION_UEVENT,
- tas_priv->rca_binaryname, tas_priv->dev, GFP_KERNEL, tas_priv,
- cont);
- if (ret)
- dev_err(tas_priv->dev, "request_firmware_nowait err:0x%08x\n",
- ret);
- return ret;
- }
- static void tasdevice_spi_init(struct tasdevice_priv *tas_priv)
- {
- tas_priv->tasdevice[tas_priv->index].cur_book = -1;
- tas_priv->tasdevice[tas_priv->index].cur_conf = -1;
- tas_priv->tasdevice[tas_priv->index].cur_prog = -1;
- tas_priv->isspi = true;
- tas_priv->update_bits = tasdevice_spi_dev_update_bits;
- tas_priv->change_chn_book = tasdevice_spi_change_chn_book;
- tas_priv->dev_read = tasdevice_spi_dev_read;
- tas_priv->dev_bulk_read = tasdevice_spi_dev_bulk_read;
- mutex_init(&tas_priv->codec_lock);
- }
- static int tasdevice_spi_amp_putvol(struct tasdevice_priv *tas_priv,
- struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
- {
- unsigned int invert = mc->invert;
- unsigned char mask;
- int max = mc->max;
- int val, ret;
- mask = rounddown_pow_of_two(max);
- mask <<= mc->shift;
- val = clamp(invert ? max - ucontrol->value.integer.value[0] :
- ucontrol->value.integer.value[0], 0, max);
- ret = tasdevice_spi_dev_update_bits(tas_priv, tas_priv->index,
- mc->reg, mask, (unsigned int)(val << mc->shift));
- if (ret)
- dev_err(tas_priv->dev, "set AMP vol error in dev %d\n",
- tas_priv->index);
- return ret;
- }
- static int tasdevice_spi_amp_getvol(struct tasdevice_priv *tas_priv,
- struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
- {
- unsigned int invert = mc->invert;
- unsigned char mask = 0;
- int max = mc->max;
- int ret, val;
- ret = tasdevice_spi_dev_read(tas_priv, tas_priv->index, mc->reg, &val);
- if (ret) {
- dev_err(tas_priv->dev, "%s, get AMP vol error\n", __func__);
- return ret;
- }
- mask = rounddown_pow_of_two(max);
- mask <<= mc->shift;
- val = (val & mask) >> mc->shift;
- val = clamp(invert ? max - val : val, 0, max);
- ucontrol->value.integer.value[0] = val;
- return ret;
- }
- static int tasdevice_spi_digital_putvol(struct tasdevice_priv *p,
- struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
- {
- unsigned int invert = mc->invert;
- int max = mc->max;
- int val, ret;
- val = clamp(invert ? max - ucontrol->value.integer.value[0] :
- ucontrol->value.integer.value[0], 0, max);
- ret = tasdevice_dev_write(p, p->index, mc->reg, (unsigned int)val);
- if (ret)
- dev_err(p->dev, "set digital vol err in dev %d\n", p->index);
- return ret;
- }
- static int tasdevice_spi_digital_getvol(struct tasdevice_priv *p,
- struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
- {
- unsigned int invert = mc->invert;
- int max = mc->max;
- int ret, val;
- ret = tasdevice_spi_dev_read(p, p->index, mc->reg, &val);
- if (ret) {
- dev_err(p->dev, "%s, get digital vol err\n", __func__);
- return ret;
- }
- val = clamp(invert ? max - val : val, 0, max);
- ucontrol->value.integer.value[0] = val;
- return ret;
- }
- static int tas2781_read_acpi(struct tas2781_hda *tas_hda,
- const char *hid, int id)
- {
- struct tasdevice_priv *p = tas_hda->priv;
- struct acpi_device *adev;
- struct device *physdev;
- u32 values[HDA_MAX_COMPONENTS];
- const char *property;
- size_t nval;
- int ret, i;
- adev = acpi_dev_get_first_match_dev(hid, NULL, -1);
- if (!adev) {
- dev_err(p->dev, "Failed to find ACPI device: %s\n", hid);
- return -ENODEV;
- }
- strscpy(p->dev_name, hid, sizeof(p->dev_name));
- physdev = get_device(acpi_get_first_physical_node(adev));
- acpi_dev_put(adev);
- property = "ti,dev-index";
- ret = device_property_count_u32(physdev, property);
- if (ret <= 0 || ret > ARRAY_SIZE(values)) {
- ret = -EINVAL;
- goto err;
- }
- p->ndev = nval = ret;
- ret = device_property_read_u32_array(physdev, property, values, nval);
- if (ret)
- goto err;
- p->index = U8_MAX;
- for (i = 0; i < nval; i++) {
- if (values[i] == id) {
- p->index = i;
- break;
- }
- }
- if (p->index == U8_MAX) {
- dev_dbg(p->dev, "No index found in %s\n", property);
- ret = -ENODEV;
- goto err;
- }
- if (p->index == 0) {
- /* All of amps share same RESET pin. */
- p->reset = devm_gpiod_get_index_optional(physdev, "reset",
- p->index, GPIOD_OUT_LOW);
- if (IS_ERR(p->reset)) {
- ret = PTR_ERR(p->reset);
- dev_err_probe(p->dev, ret, "Failed on reset GPIO\n");
- goto err;
- }
- }
- put_device(physdev);
- return 0;
- err:
- dev_err(p->dev, "read acpi error, ret: %d\n", ret);
- put_device(physdev);
- acpi_dev_put(adev);
- return ret;
- }
- static void tas2781_hda_playback_hook(struct device *dev, int action)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- if (action == HDA_GEN_PCM_ACT_OPEN) {
- pm_runtime_get_sync(dev);
- guard(mutex)(&tas_priv->codec_lock);
- if (tas_priv->fw_state == TASDEVICE_DSP_FW_ALL_OK)
- tasdevice_tuning_switch(tas_hda->priv, 0);
- } else if (action == HDA_GEN_PCM_ACT_CLOSE) {
- guard(mutex)(&tas_priv->codec_lock);
- if (tas_priv->fw_state == TASDEVICE_DSP_FW_ALL_OK)
- tasdevice_tuning_switch(tas_priv, 1);
- pm_runtime_put_autosuspend(dev);
- }
- }
- /*
- * tas2781_digital_getvol - get the volum control
- * @kcontrol: control pointer
- * @ucontrol: User data
- *
- * Customer Kcontrol for tas2781 is primarily for regmap booking, paging
- * depends on internal regmap mechanism.
- * tas2781 contains book and page two-level register map, especially
- * book switching will set the register BXXP00R7F, after switching to the
- * correct book, then leverage the mechanism for paging to access the
- * register.
- *
- * Return 0 if succeeded.
- */
- static int tas2781_digital_getvol(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- struct soc_mixer_control *mc =
- (struct soc_mixer_control *)kcontrol->private_value;
- guard(mutex)(&tas_priv->codec_lock);
- return tasdevice_spi_digital_getvol(tas_priv, ucontrol, mc);
- }
- static int tas2781_amp_getvol(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- struct soc_mixer_control *mc =
- (struct soc_mixer_control *)kcontrol->private_value;
- guard(mutex)(&tas_priv->codec_lock);
- return tasdevice_spi_amp_getvol(tas_priv, ucontrol, mc);
- }
- static int tas2781_digital_putvol(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- struct soc_mixer_control *mc =
- (struct soc_mixer_control *)kcontrol->private_value;
- guard(mutex)(&tas_priv->codec_lock);
- return tasdevice_spi_digital_putvol(tas_priv, ucontrol, mc);
- }
- static int tas2781_amp_putvol(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- struct soc_mixer_control *mc =
- (struct soc_mixer_control *)kcontrol->private_value;
- guard(mutex)(&tas_priv->codec_lock);
- return tasdevice_spi_amp_putvol(tas_priv, ucontrol, mc);
- }
- static int tas2781_force_fwload_get(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- ucontrol->value.integer.value[0] = (int)tas_priv->force_fwload_status;
- dev_dbg(tas_priv->dev, "%s : Force FWload %s\n", __func__,
- str_on_off(tas_priv->force_fwload_status));
- return 0;
- }
- static int tas2781_force_fwload_put(struct snd_kcontrol *kcontrol,
- struct snd_ctl_elem_value *ucontrol)
- {
- struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
- bool change, val = (bool)ucontrol->value.integer.value[0];
- if (tas_priv->force_fwload_status == val) {
- change = false;
- } else {
- change = true;
- tas_priv->force_fwload_status = val;
- }
- dev_dbg(tas_priv->dev, "%s : Force FWload %s\n", __func__,
- str_on_off(tas_priv->force_fwload_status));
- return change;
- }
- static struct snd_kcontrol_new tas2781_snd_ctls[] = {
- ACARD_SINGLE_RANGE_EXT_TLV(NULL, TAS2781_AMP_LEVEL, 1, 0, 20, 0,
- tas2781_amp_getvol, tas2781_amp_putvol,
- tas2781_amp_tlv),
- ACARD_SINGLE_RANGE_EXT_TLV(NULL, TAS2781_DVC_LVL, 0, 0, 200, 1,
- tas2781_digital_getvol, tas2781_digital_putvol,
- tas2781_dvc_tlv),
- ACARD_SINGLE_BOOL_EXT(NULL, 0, tas2781_force_fwload_get,
- tas2781_force_fwload_put),
- };
- static struct snd_kcontrol_new tas2781_prof_ctl = {
- .iface = SNDRV_CTL_ELEM_IFACE_CARD,
- .info = tasdevice_info_profile,
- .get = tasdevice_get_profile_id,
- .put = tasdevice_set_profile_id,
- };
- static struct snd_kcontrol_new tas2781_dsp_ctls[] = {
- /* Speaker Program */
- {
- .iface = SNDRV_CTL_ELEM_IFACE_CARD,
- .info = tasdevice_info_programs,
- .get = tasdevice_program_get,
- .put = tasdevice_program_put,
- },
- /* Speaker Config */
- {
- .iface = SNDRV_CTL_ELEM_IFACE_CARD,
- .info = tasdevice_info_config,
- .get = tasdevice_config_get,
- .put = tasdevice_config_put,
- },
- };
- static void tas2781_hda_remove_controls(struct tas2781_hda *tas_hda)
- {
- struct hda_codec *codec = tas_hda->priv->codec;
- struct tas2781_hda_spi_priv *h_priv = tas_hda->hda_priv;
- snd_ctl_remove(codec->card, tas_hda->dsp_prog_ctl);
- snd_ctl_remove(codec->card, tas_hda->dsp_conf_ctl);
- for (int i = ARRAY_SIZE(h_priv->snd_ctls) - 1; i >= 0; i--)
- snd_ctl_remove(codec->card, h_priv->snd_ctls[i]);
- snd_ctl_remove(codec->card, tas_hda->prof_ctl);
- }
- static int tas2781_hda_spi_prf_ctl(struct tas2781_hda *h)
- {
- struct tasdevice_priv *p = h->priv;
- struct hda_codec *c = p->codec;
- char name[64];
- int rc;
- snprintf(name, sizeof(name), "Speaker-%d Profile Id", p->index);
- tas2781_prof_ctl.name = name;
- h->prof_ctl = snd_ctl_new1(&tas2781_prof_ctl, p);
- rc = snd_ctl_add(c->card, h->prof_ctl);
- if (rc)
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_prof_ctl.name, rc);
- return rc;
- }
- static int tas2781_hda_spi_snd_ctls(struct tas2781_hda *h)
- {
- struct tas2781_hda_spi_priv *h_priv = h->hda_priv;
- struct tasdevice_priv *p = h->priv;
- struct hda_codec *c = p->codec;
- char name[64];
- int i = 0;
- int rc;
- snprintf(name, sizeof(name), "Speaker-%d Analog Volume", p->index);
- tas2781_snd_ctls[i].name = name;
- h_priv->snd_ctls[i] = snd_ctl_new1(&tas2781_snd_ctls[i], p);
- rc = snd_ctl_add(c->card, h_priv->snd_ctls[i]);
- if (rc) {
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_snd_ctls[i].name, rc);
- return rc;
- }
- i++;
- snprintf(name, sizeof(name), "Speaker-%d Digital Volume", p->index);
- tas2781_snd_ctls[i].name = name;
- h_priv->snd_ctls[i] = snd_ctl_new1(&tas2781_snd_ctls[i], p);
- rc = snd_ctl_add(c->card, h_priv->snd_ctls[i]);
- if (rc) {
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_snd_ctls[i].name, rc);
- return rc;
- }
- i++;
- snprintf(name, sizeof(name), "Froce Speaker-%d FW Load", p->index);
- tas2781_snd_ctls[i].name = name;
- h_priv->snd_ctls[i] = snd_ctl_new1(&tas2781_snd_ctls[i], p);
- rc = snd_ctl_add(c->card, h_priv->snd_ctls[i]);
- if (rc) {
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_snd_ctls[i].name, rc);
- }
- return rc;
- }
- static int tas2781_hda_spi_dsp_ctls(struct tas2781_hda *h)
- {
- struct tasdevice_priv *p = h->priv;
- struct hda_codec *c = p->codec;
- char name[64];
- int i = 0;
- int rc;
- snprintf(name, sizeof(name), "Speaker-%d Program Id", p->index);
- tas2781_dsp_ctls[i].name = name;
- h->dsp_prog_ctl = snd_ctl_new1(&tas2781_dsp_ctls[i], p);
- rc = snd_ctl_add(c->card, h->dsp_prog_ctl);
- if (rc) {
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_dsp_ctls[i].name, rc);
- return rc;
- }
- i++;
- snprintf(name, sizeof(name), "Speaker-%d Config Id", p->index);
- tas2781_dsp_ctls[i].name = name;
- h->dsp_conf_ctl = snd_ctl_new1(&tas2781_dsp_ctls[i], p);
- rc = snd_ctl_add(c->card, h->dsp_conf_ctl);
- if (rc) {
- dev_err(p->dev, "Failed to add KControl: %s, rc = %d\n",
- tas2781_dsp_ctls[i].name, rc);
- }
- return rc;
- }
- static void tasdev_fw_ready(const struct firmware *fmw, void *context)
- {
- struct tasdevice_priv *tas_priv = context;
- struct tas2781_hda *tas_hda = dev_get_drvdata(tas_priv->dev);
- struct hda_codec *codec = tas_priv->codec;
- int ret;
- guard(pm_runtime_active_auto)(tas_priv->dev);
- guard(mutex)(&tas_priv->codec_lock);
- ret = tasdevice_rca_parser(tas_priv, fmw);
- if (ret)
- goto out;
- /* Add control one time only. */
- ret = tas2781_hda_spi_prf_ctl(tas_hda);
- if (ret)
- goto out;
- ret = tas2781_hda_spi_snd_ctls(tas_hda);
- if (ret)
- goto out;
- tasdevice_dsp_remove(tas_priv);
- tas_priv->fw_state = TASDEVICE_DSP_FW_PENDING;
- scnprintf(tas_priv->coef_binaryname, 64, "TAS2XXX%04X-%01d.bin",
- lower_16_bits(codec->core.subsystem_id), tas_priv->index);
- ret = tasdevice_dsp_parser(tas_priv);
- if (ret) {
- dev_err(tas_priv->dev, "dspfw load %s error\n",
- tas_priv->coef_binaryname);
- tas_priv->fw_state = TASDEVICE_DSP_FW_FAIL;
- goto out;
- }
- ret = tas2781_hda_spi_dsp_ctls(tas_hda);
- if (ret)
- goto out;
- /* Perform AMP reset before firmware download. */
- tas2781_spi_reset(tas_priv);
- tas_priv->rcabin.profile_cfg_id = 0;
- tas_priv->fw_state = TASDEVICE_DSP_FW_ALL_OK;
- ret = tasdevice_prmg_load(tas_priv, 0);
- if (ret < 0) {
- dev_err(tas_priv->dev, "FW download failed = %d\n", ret);
- goto out;
- }
- tas_priv->fw_state = TASDEVICE_DSP_FW_ALL_OK;
- if (tas_priv->fmw->nr_programs > 0)
- tas_priv->tasdevice[tas_priv->index].cur_prog = 0;
- if (tas_priv->fmw->nr_configurations > 0)
- tas_priv->tasdevice[tas_priv->index].cur_conf = 0;
- /*
- * If calibrated data occurs error, dsp will still works with default
- * calibrated data inside algo.
- */
- tas2781_save_calibration(tas_hda);
- out:
- release_firmware(fmw);
- }
- static int tas2781_hda_bind(struct device *dev, struct device *master,
- void *master_data)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct hda_component_parent *parent = master_data;
- struct hda_component *comp;
- struct hda_codec *codec;
- int ret;
- comp = hda_component_from_index(parent, tas_hda->priv->index);
- if (!comp)
- return -EINVAL;
- if (comp->dev)
- return -EBUSY;
- codec = parent->codec;
- guard(pm_runtime_active_auto)(dev);
- comp->dev = dev;
- strscpy(comp->name, dev_name(dev), sizeof(comp->name));
- ret = tascodec_spi_init(tas_hda->priv, codec, THIS_MODULE,
- tasdev_fw_ready);
- if (!ret)
- comp->playback_hook = tas2781_hda_playback_hook;
- /* Only HP Laptop support SPI-based TAS2781 */
- tas_hda->catlog_id = HP;
- return ret;
- }
- static void tas2781_hda_unbind(struct device *dev, struct device *master,
- void *master_data)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct hda_component_parent *parent = master_data;
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- struct hda_component *comp;
- comp = hda_component_from_index(parent, tas_priv->index);
- if (comp && (comp->dev == dev)) {
- comp->dev = NULL;
- memset(comp->name, 0, sizeof(comp->name));
- comp->playback_hook = NULL;
- }
- tas2781_hda_remove_controls(tas_hda);
- tasdevice_config_info_remove(tas_priv);
- tasdevice_dsp_remove(tas_priv);
- tas_hda->priv->fw_state = TASDEVICE_DSP_FW_PENDING;
- }
- static const struct component_ops tas2781_hda_comp_ops = {
- .bind = tas2781_hda_bind,
- .unbind = tas2781_hda_unbind,
- };
- static int tas2781_hda_spi_probe(struct spi_device *spi)
- {
- struct tas2781_hda_spi_priv *hda_priv;
- struct tasdevice_priv *tas_priv;
- struct tas2781_hda *tas_hda;
- const char *device_name;
- int ret = 0;
- tas_hda = devm_kzalloc(&spi->dev, sizeof(*tas_hda), GFP_KERNEL);
- if (!tas_hda)
- return -ENOMEM;
- hda_priv = devm_kzalloc(&spi->dev, sizeof(*hda_priv), GFP_KERNEL);
- if (!hda_priv)
- return -ENOMEM;
- tas_hda->hda_priv = hda_priv;
- spi->max_speed_hz = TAS2781_SPI_MAX_FREQ;
- tas_priv = devm_kzalloc(&spi->dev, sizeof(*tas_priv), GFP_KERNEL);
- if (!tas_priv)
- return -ENOMEM;
- tas_priv->dev = &spi->dev;
- tas_hda->priv = tas_priv;
- tas_priv->regmap = devm_regmap_init_spi(spi, &tasdevice_regmap);
- if (IS_ERR(tas_priv->regmap)) {
- ret = PTR_ERR(tas_priv->regmap);
- dev_err(tas_priv->dev, "Failed to allocate regmap: %d\n",
- ret);
- return ret;
- }
- if (strstr(dev_name(&spi->dev), "TXNW2781")) {
- device_name = "TXNW2781";
- } else {
- dev_err(tas_priv->dev, "Unmatched spi dev %s\n",
- dev_name(&spi->dev));
- return -ENODEV;
- }
- tas_priv->irq = spi->irq;
- dev_set_drvdata(&spi->dev, tas_hda);
- ret = tas2781_read_acpi(tas_hda, device_name,
- spi_get_chipselect(spi, 0));
- if (ret)
- return dev_err_probe(tas_priv->dev, ret,
- "Platform not supported\n");
- tasdevice_spi_init(tas_priv);
- pm_runtime_set_autosuspend_delay(tas_priv->dev, 3000);
- pm_runtime_use_autosuspend(tas_priv->dev);
- pm_runtime_set_active(tas_priv->dev);
- pm_runtime_get_noresume(tas_priv->dev);
- pm_runtime_enable(tas_priv->dev);
- pm_runtime_put_autosuspend(tas_priv->dev);
- ret = component_add(tas_priv->dev, &tas2781_hda_comp_ops);
- if (ret) {
- dev_err(tas_priv->dev, "Register component fail: %d\n", ret);
- pm_runtime_disable(tas_priv->dev);
- tas2781_hda_remove(&spi->dev, &tas2781_hda_comp_ops);
- }
- return ret;
- }
- static void tas2781_hda_spi_remove(struct spi_device *spi)
- {
- tas2781_hda_remove(&spi->dev, &tas2781_hda_comp_ops);
- }
- static int tas2781_runtime_suspend(struct device *dev)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- guard(mutex)(&tas_priv->codec_lock);
- if (tas_priv->fw_state == TASDEVICE_DSP_FW_ALL_OK
- && tas_priv->playback_started)
- tasdevice_tuning_switch(tas_priv, 1);
- tas_priv->tasdevice[tas_priv->index].cur_book = -1;
- tas_priv->tasdevice[tas_priv->index].cur_conf = -1;
- return 0;
- }
- static int tas2781_runtime_resume(struct device *dev)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- guard(mutex)(&tas_priv->codec_lock);
- if (tas_priv->fw_state == TASDEVICE_DSP_FW_ALL_OK
- && tas_priv->playback_started)
- tasdevice_tuning_switch(tas_priv, 0);
- return 0;
- }
- static int tas2781_system_suspend(struct device *dev)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- int ret;
- ret = pm_runtime_force_suspend(dev);
- if (ret)
- return ret;
- /* Shutdown chip before system suspend */
- if (tas_priv->fw_state == TASDEVICE_DSP_FW_ALL_OK
- && tas_priv->playback_started)
- tasdevice_tuning_switch(tas_priv, 1);
- return 0;
- }
- static int tas2781_system_resume(struct device *dev)
- {
- struct tas2781_hda *tas_hda = dev_get_drvdata(dev);
- struct tasdevice_priv *tas_priv = tas_hda->priv;
- int ret, val;
- ret = pm_runtime_force_resume(dev);
- if (ret)
- return ret;
- guard(mutex)(&tas_priv->codec_lock);
- ret = tas_priv->dev_read(tas_priv, tas_priv->index,
- TAS2781_REG_CLK_CONFIG, &val);
- if (ret < 0)
- return ret;
- if (val == TAS2781_REG_CLK_CONFIG_RESET) {
- tas_priv->tasdevice[tas_priv->index].cur_book = -1;
- tas_priv->tasdevice[tas_priv->index].cur_conf = -1;
- tas_priv->tasdevice[tas_priv->index].cur_prog = -1;
- ret = tasdevice_prmg_load(tas_priv, 0);
- if (ret < 0) {
- dev_err(tas_priv->dev,
- "FW download failed = %d\n", ret);
- return ret;
- }
- tas_priv->fw_state = TASDEVICE_DSP_FW_ALL_OK;
- if (tas_priv->playback_started)
- tasdevice_tuning_switch(tas_priv, 0);
- }
- return ret;
- }
- static const struct dev_pm_ops tas2781_hda_pm_ops = {
- RUNTIME_PM_OPS(tas2781_runtime_suspend, tas2781_runtime_resume, NULL)
- SYSTEM_SLEEP_PM_OPS(tas2781_system_suspend, tas2781_system_resume)
- };
- static const struct spi_device_id tas2781_hda_spi_id[] = {
- { "tas2781-hda", },
- {}
- };
- static const struct acpi_device_id tas2781_acpi_hda_match[] = {
- {"TXNW2781", },
- {}
- };
- MODULE_DEVICE_TABLE(acpi, tas2781_acpi_hda_match);
- static struct spi_driver tas2781_hda_spi_driver = {
- .driver = {
- .name = "tas2781-hda",
- .acpi_match_table = tas2781_acpi_hda_match,
- .pm = &tas2781_hda_pm_ops,
- },
- .id_table = tas2781_hda_spi_id,
- .probe = tas2781_hda_spi_probe,
- .remove = tas2781_hda_spi_remove,
- };
- module_spi_driver(tas2781_hda_spi_driver);
- MODULE_DESCRIPTION("TAS2781 HDA SPI Driver");
- MODULE_AUTHOR("Baojun, Xu, <baojun.xug@ti.com>");
- MODULE_LICENSE("GPL");
- MODULE_IMPORT_NS("SND_SOC_TAS2781_FMWLIB");
- MODULE_IMPORT_NS("SND_HDA_SCODEC_TAS2781");
|