1 // SPDX-License-Identifier: GPL-2.0
3 // tas2781-lib.c -- TAS2781 Common functions for HDA and ASoC Audio drivers
5 // Copyright 2023 Texas Instruments, Inc.
7 // Author: Shenghao Ding <shenghao-ding@ti.com>
9 #include <linux/crc8.h>
10 #include <linux/firmware.h>
11 #include <linux/gpio/consumer.h>
12 #include <linux/i2c.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/module.h>
17 #include <linux/of_gpio.h>
18 #include <linux/of_irq.h>
19 #include <linux/regmap.h>
20 #include <linux/slab.h>
21 #include <sound/pcm_params.h>
22 #include <sound/soc.h>
23 #include <sound/tas2781.h>
25 #define TASDEVICE_CRC8_POLYNOMIAL 0x4d
27 static const struct regmap_range_cfg tasdevice_ranges[] = {
30 .range_max = 256 * 128,
31 .selector_reg = TASDEVICE_PAGE_SELECT,
32 .selector_mask = 0xff,
39 static const struct regmap_config tasdevice_regmap = {
42 .cache_type = REGCACHE_NONE,
43 .ranges = tasdevice_ranges,
44 .num_ranges = ARRAY_SIZE(tasdevice_ranges),
45 .max_register = 256 * 128,
48 static int tasdevice_change_chn_book(struct tasdevice_priv *tas_priv,
49 unsigned short chn, int book)
51 struct i2c_client *client = (struct i2c_client *)tas_priv->client;
54 if (chn < tas_priv->ndev) {
55 struct tasdevice *tasdev = &tas_priv->tasdevice[chn];
56 struct regmap *map = tas_priv->regmap;
58 if (client->addr != tasdev->dev_addr) {
59 client->addr = tasdev->dev_addr;
60 /* All tas2781s share the same regmap, clear the page
61 * inside regmap once switching to another tas2781.
62 * Register 0 at any pages and any books inside tas2781
63 * is the same one for page-switching.
65 ret = regmap_write(map, TASDEVICE_PAGE_SELECT, 0);
67 dev_err(tas_priv->dev, "%s, E=%d\n",
73 if (tasdev->cur_book != book) {
74 ret = regmap_write(map, TASDEVICE_BOOKCTL_REG, book);
76 dev_err(tas_priv->dev, "%s, E=%d\n",
80 tasdev->cur_book = book;
84 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
92 int tasdevice_dev_read(struct tasdevice_priv *tas_priv,
93 unsigned short chn, unsigned int reg, unsigned int *val)
97 if (chn < tas_priv->ndev) {
98 struct regmap *map = tas_priv->regmap;
100 ret = tasdevice_change_chn_book(tas_priv, chn,
101 TASDEVICE_BOOK_ID(reg));
105 ret = regmap_read(map, TASDEVICE_PGRG(reg), val);
107 dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
110 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
117 EXPORT_SYMBOL_GPL(tasdevice_dev_read);
119 int tasdevice_dev_write(struct tasdevice_priv *tas_priv,
120 unsigned short chn, unsigned int reg, unsigned int value)
124 if (chn < tas_priv->ndev) {
125 struct regmap *map = tas_priv->regmap;
127 ret = tasdevice_change_chn_book(tas_priv, chn,
128 TASDEVICE_BOOK_ID(reg));
132 ret = regmap_write(map, TASDEVICE_PGRG(reg),
135 dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
138 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
145 EXPORT_SYMBOL_GPL(tasdevice_dev_write);
147 int tasdevice_dev_bulk_write(
148 struct tasdevice_priv *tas_priv, unsigned short chn,
149 unsigned int reg, unsigned char *data,
154 if (chn < tas_priv->ndev) {
155 struct regmap *map = tas_priv->regmap;
157 ret = tasdevice_change_chn_book(tas_priv, chn,
158 TASDEVICE_BOOK_ID(reg));
162 ret = regmap_bulk_write(map, TASDEVICE_PGRG(reg),
165 dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
168 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
175 EXPORT_SYMBOL_GPL(tasdevice_dev_bulk_write);
177 int tasdevice_dev_bulk_read(struct tasdevice_priv *tas_priv,
178 unsigned short chn, unsigned int reg, unsigned char *data,
183 if (chn < tas_priv->ndev) {
184 struct regmap *map = tas_priv->regmap;
186 ret = tasdevice_change_chn_book(tas_priv, chn,
187 TASDEVICE_BOOK_ID(reg));
191 ret = regmap_bulk_read(map, TASDEVICE_PGRG(reg), data, len);
193 dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
195 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
201 EXPORT_SYMBOL_GPL(tasdevice_dev_bulk_read);
203 int tasdevice_dev_update_bits(
204 struct tasdevice_priv *tas_priv, unsigned short chn,
205 unsigned int reg, unsigned int mask, unsigned int value)
209 if (chn < tas_priv->ndev) {
210 struct regmap *map = tas_priv->regmap;
212 ret = tasdevice_change_chn_book(tas_priv, chn,
213 TASDEVICE_BOOK_ID(reg));
217 ret = regmap_update_bits(map, TASDEVICE_PGRG(reg),
220 dev_err(tas_priv->dev, "%s, E=%d\n", __func__, ret);
222 dev_err(tas_priv->dev, "%s, no such channel(%d)\n", __func__,
230 EXPORT_SYMBOL_GPL(tasdevice_dev_update_bits);
232 struct tasdevice_priv *tasdevice_kzalloc(struct i2c_client *i2c)
234 struct tasdevice_priv *tas_priv;
236 tas_priv = devm_kzalloc(&i2c->dev, sizeof(*tas_priv), GFP_KERNEL);
239 tas_priv->dev = &i2c->dev;
240 tas_priv->client = (void *)i2c;
244 EXPORT_SYMBOL_GPL(tasdevice_kzalloc);
246 void tas2781_reset(struct tasdevice_priv *tas_dev)
250 if (tas_dev->reset) {
251 gpiod_set_value_cansleep(tas_dev->reset, 0);
252 usleep_range(500, 1000);
253 gpiod_set_value_cansleep(tas_dev->reset, 1);
255 for (i = 0; i < tas_dev->ndev; i++) {
256 ret = tasdevice_dev_write(tas_dev, i,
258 TAS2781_REG_SWRESET_RESET);
260 dev_err(tas_dev->dev,
261 "dev %d swreset fail, %d\n",
265 usleep_range(1000, 1050);
267 EXPORT_SYMBOL_GPL(tas2781_reset);
269 int tascodec_init(struct tasdevice_priv *tas_priv, void *codec,
270 struct module *module,
271 void (*cont)(const struct firmware *fw, void *context))
275 /* Codec Lock Hold to ensure that codec_probe and firmware parsing and
276 * loading do not simultaneously execute.
278 mutex_lock(&tas_priv->codec_lock);
280 scnprintf(tas_priv->rca_binaryname, 64, "%sRCA%d.bin",
281 tas_priv->dev_name, tas_priv->ndev);
282 crc8_populate_msb(tas_priv->crc8_lkp_tbl, TASDEVICE_CRC8_POLYNOMIAL);
283 tas_priv->codec = codec;
284 ret = request_firmware_nowait(module, FW_ACTION_UEVENT,
285 tas_priv->rca_binaryname, tas_priv->dev, GFP_KERNEL, tas_priv,
288 dev_err(tas_priv->dev, "request_firmware_nowait err:0x%08x\n",
291 /* Codec Lock Release*/
292 mutex_unlock(&tas_priv->codec_lock);
295 EXPORT_SYMBOL_GPL(tascodec_init);
297 int tasdevice_init(struct tasdevice_priv *tas_priv)
302 tas_priv->regmap = devm_regmap_init_i2c(tas_priv->client,
304 if (IS_ERR(tas_priv->regmap)) {
305 ret = PTR_ERR(tas_priv->regmap);
306 dev_err(tas_priv->dev, "Failed to allocate register map: %d\n",
311 tas_priv->cur_prog = -1;
312 tas_priv->cur_conf = -1;
314 for (i = 0; i < tas_priv->ndev; i++) {
315 tas_priv->tasdevice[i].cur_book = -1;
316 tas_priv->tasdevice[i].cur_prog = -1;
317 tas_priv->tasdevice[i].cur_conf = -1;
320 mutex_init(&tas_priv->codec_lock);
325 EXPORT_SYMBOL_GPL(tasdevice_init);
327 static void tasdev_dsp_prog_blk_remove(struct tasdevice_prog *prog)
329 struct tasdevice_data *tas_dt;
330 struct tasdev_blk *blk;
336 tas_dt = &(prog->dev_data);
338 if (!tas_dt->dev_blks)
341 for (i = 0; i < tas_dt->nr_blk; i++) {
342 blk = &(tas_dt->dev_blks[i]);
345 kfree(tas_dt->dev_blks);
348 static void tasdev_dsp_prog_remove(struct tasdevice_prog *prog,
353 for (i = 0; i < nr; i++)
354 tasdev_dsp_prog_blk_remove(&prog[i]);
358 static void tasdev_dsp_cfg_blk_remove(struct tasdevice_config *cfg)
360 struct tasdevice_data *tas_dt;
361 struct tasdev_blk *blk;
365 tas_dt = &(cfg->dev_data);
367 if (!tas_dt->dev_blks)
370 for (i = 0; i < tas_dt->nr_blk; i++) {
371 blk = &(tas_dt->dev_blks[i]);
374 kfree(tas_dt->dev_blks);
378 static void tasdev_dsp_cfg_remove(struct tasdevice_config *config,
383 for (i = 0; i < nr; i++)
384 tasdev_dsp_cfg_blk_remove(&config[i]);
388 void tasdevice_dsp_remove(void *context)
390 struct tasdevice_priv *tas_dev = (struct tasdevice_priv *) context;
391 struct tasdevice_fw *tas_fmw = tas_dev->fmw;
396 if (tas_fmw->programs)
397 tasdev_dsp_prog_remove(tas_fmw->programs,
398 tas_fmw->nr_programs);
399 if (tas_fmw->configs)
400 tasdev_dsp_cfg_remove(tas_fmw->configs,
401 tas_fmw->nr_configurations);
405 EXPORT_SYMBOL_GPL(tasdevice_dsp_remove);
407 void tasdevice_remove(struct tasdevice_priv *tas_priv)
409 if (gpio_is_valid(tas_priv->irq_info.irq_gpio))
410 gpio_free(tas_priv->irq_info.irq_gpio);
411 kfree(tas_priv->acpi_subsystem_id);
412 mutex_destroy(&tas_priv->codec_lock);
414 EXPORT_SYMBOL_GPL(tasdevice_remove);
416 int tasdevice_save_calibration(struct tasdevice_priv *tas_priv)
418 if (tas_priv->save_calibration)
419 return tas_priv->save_calibration(tas_priv);
422 EXPORT_SYMBOL_GPL(tasdevice_save_calibration);
424 void tasdevice_apply_calibration(struct tasdevice_priv *tas_priv)
426 if (tas_priv->apply_calibration && tas_priv->cali_data.total_sz)
427 tas_priv->apply_calibration(tas_priv);
429 EXPORT_SYMBOL_GPL(tasdevice_apply_calibration);
431 static int tasdevice_clamp(int val, int max, unsigned int invert)
442 int tasdevice_amp_putvol(struct tasdevice_priv *tas_priv,
443 struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
445 unsigned int invert = mc->invert;
451 mask = (1 << fls(max)) - 1;
453 val = tasdevice_clamp(ucontrol->value.integer.value[0], max, invert);
454 for (i = 0; i < tas_priv->ndev; i++) {
455 ret = tasdevice_dev_update_bits(tas_priv, i,
456 mc->reg, mask, (unsigned int)(val << mc->shift));
460 dev_err(tas_priv->dev, "set AMP vol error in dev %d\n", i);
463 /* All the devices set error, return 0 */
464 return (err_cnt == tas_priv->ndev) ? 0 : 1;
466 EXPORT_SYMBOL_GPL(tasdevice_amp_putvol);
468 int tasdevice_amp_getvol(struct tasdevice_priv *tas_priv,
469 struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
471 unsigned int invert = mc->invert;
472 unsigned char mask = 0;
477 /* Read the primary device */
478 ret = tasdevice_dev_read(tas_priv, 0, mc->reg, &val);
480 dev_err(tas_priv->dev, "%s, get AMP vol error\n", __func__);
484 mask = (1 << fls(max)) - 1;
486 val = (val & mask) >> mc->shift;
487 val = tasdevice_clamp(val, max, invert);
488 ucontrol->value.integer.value[0] = val;
494 EXPORT_SYMBOL_GPL(tasdevice_amp_getvol);
496 int tasdevice_digital_putvol(struct tasdevice_priv *tas_priv,
497 struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
499 unsigned int invert = mc->invert;
505 val = tasdevice_clamp(ucontrol->value.integer.value[0], max, invert);
507 for (i = 0; i < tas_priv->ndev; i++) {
508 ret = tasdevice_dev_write(tas_priv, i, mc->reg,
513 dev_err(tas_priv->dev,
514 "set digital vol err in dev %d\n", i);
517 /* All the devices set error, return 0 */
518 return (err_cnt == tas_priv->ndev) ? 0 : 1;
521 EXPORT_SYMBOL_GPL(tasdevice_digital_putvol);
523 int tasdevice_digital_getvol(struct tasdevice_priv *tas_priv,
524 struct snd_ctl_elem_value *ucontrol, struct soc_mixer_control *mc)
526 unsigned int invert = mc->invert;
530 /* Read the primary device as the whole */
531 ret = tasdevice_dev_read(tas_priv, 0, mc->reg, &val);
533 dev_err(tas_priv->dev, "%s, get digital vol error\n",
538 val = tasdevice_clamp(val, max, invert);
539 ucontrol->value.integer.value[0] = val;
545 EXPORT_SYMBOL_GPL(tasdevice_digital_getvol);
547 MODULE_DESCRIPTION("TAS2781 common library");
548 MODULE_AUTHOR("Shenghao Ding, TI, <shenghao-ding@ti.com>");
549 MODULE_LICENSE("GPL");