1 // SPDX-License-Identifier: GPL-2.0
3 // TAS2781 HDA I2C driver
5 // Copyright 2023 Texas Instruments, Inc.
7 // Author: Shenghao Ding <shenghao-ding@ti.com>
9 #include <linux/acpi.h>
10 #include <linux/crc8.h>
11 #include <linux/crc32.h>
12 #include <linux/efi.h>
13 #include <linux/firmware.h>
14 #include <linux/i2c.h>
15 #include <linux/mod_devicetable.h>
16 #include <linux/module.h>
17 #include <linux/pm_runtime.h>
18 #include <linux/regmap.h>
19 #include <sound/hda_codec.h>
20 #include <sound/soc.h>
21 #include <sound/tas2781.h>
22 #include <sound/tlv.h>
23 #include <sound/tas2781-tlv.h>
25 #include "hda_local.h"
26 #include "hda_auto_parser.h"
27 #include "hda_component.h"
29 #include "hda_generic.h"
31 #define TASDEVICE_SPEAKER_CALIBRATION_SIZE 20
33 /* No standard control callbacks for SNDRV_CTL_ELEM_IFACE_CARD
34 * Define two controls, one is Volume control callbacks, the other is
35 * flag setting control callbacks.
38 /* Volume control callbacks for tas2781 */
39 #define ACARD_SINGLE_RANGE_EXT_TLV(xname, xreg, xshift, xmin, xmax, xinvert, \
40 xhandler_get, xhandler_put, tlv_array) \
41 { .iface = SNDRV_CTL_ELEM_IFACE_CARD, .name = (xname),\
42 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
43 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
44 .tlv.p = (tlv_array), \
45 .info = snd_soc_info_volsw_range, \
46 .get = xhandler_get, .put = xhandler_put, \
47 .private_value = (unsigned long)&(struct soc_mixer_control) \
48 {.reg = xreg, .rreg = xreg, .shift = xshift, \
49 .rshift = xshift, .min = xmin, .max = xmax, \
52 /* Flag control callbacks for tas2781 */
53 #define ACARD_SINGLE_BOOL_EXT(xname, xdata, xhandler_get, xhandler_put) \
54 { .iface = SNDRV_CTL_ELEM_IFACE_CARD, .name = xname, \
55 .info = snd_ctl_boolean_mono_info, \
56 .get = xhandler_get, .put = xhandler_put, \
57 .private_value = xdata }
68 static int tas2781_get_i2c_res(struct acpi_resource *ares, void *data)
70 struct tasdevice_priv *tas_priv = data;
71 struct acpi_resource_i2c_serialbus *sb;
73 if (i2c_acpi_get_i2c_resource(ares, &sb)) {
74 if (tas_priv->ndev < TASDEVICE_MAX_CHANNELS &&
75 sb->slave_address != TAS2781_GLOBAL_ADDR) {
76 tas_priv->tasdevice[tas_priv->ndev].dev_addr =
77 (unsigned int)sb->slave_address;
84 static int tas2781_read_acpi(struct tasdevice_priv *p, const char *hid)
86 struct acpi_device *adev;
87 struct device *physdev;
92 adev = acpi_dev_get_first_match_dev(hid, NULL, -1);
95 "Failed to find an ACPI device for %s\n", hid);
99 ret = acpi_dev_get_resources(adev, &resources, tas2781_get_i2c_res, p);
103 acpi_dev_free_resource_list(&resources);
104 strscpy(p->dev_name, hid, sizeof(p->dev_name));
105 physdev = get_device(acpi_get_first_physical_node(adev));
108 /* No side-effect to the playback even if subsystem_id is NULL*/
109 sub = acpi_get_subsystem_id(ACPI_HANDLE(physdev));
113 p->acpi_subsystem_id = sub;
120 dev_err(p->dev, "read acpi error, ret: %d\n", ret);
126 static void tas2781_hda_playback_hook(struct device *dev, int action)
128 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
130 dev_dbg(tas_priv->dev, "%s: action = %d\n", __func__, action);
132 case HDA_GEN_PCM_ACT_OPEN:
133 pm_runtime_get_sync(dev);
134 mutex_lock(&tas_priv->codec_lock);
135 tasdevice_tuning_switch(tas_priv, 0);
136 mutex_unlock(&tas_priv->codec_lock);
138 case HDA_GEN_PCM_ACT_CLOSE:
139 mutex_lock(&tas_priv->codec_lock);
140 tasdevice_tuning_switch(tas_priv, 1);
141 mutex_unlock(&tas_priv->codec_lock);
143 pm_runtime_mark_last_busy(dev);
144 pm_runtime_put_autosuspend(dev);
147 dev_dbg(tas_priv->dev, "Playback action not supported: %d\n",
153 static int tasdevice_info_profile(struct snd_kcontrol *kcontrol,
154 struct snd_ctl_elem_info *uinfo)
156 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
158 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
160 uinfo->value.integer.min = 0;
161 uinfo->value.integer.max = tas_priv->rcabin.ncfgs - 1;
166 static int tasdevice_get_profile_id(struct snd_kcontrol *kcontrol,
167 struct snd_ctl_elem_value *ucontrol)
169 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
171 ucontrol->value.integer.value[0] = tas_priv->rcabin.profile_cfg_id;
176 static int tasdevice_hda_clamp(int val, int max)
186 static int tasdevice_set_profile_id(struct snd_kcontrol *kcontrol,
187 struct snd_ctl_elem_value *ucontrol)
189 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
190 int nr_profile = ucontrol->value.integer.value[0];
191 int max = tas_priv->rcabin.ncfgs - 1;
194 val = tasdevice_hda_clamp(nr_profile, max);
196 if (tas_priv->rcabin.profile_cfg_id != val) {
197 tas_priv->rcabin.profile_cfg_id = val;
204 static int tasdevice_info_programs(struct snd_kcontrol *kcontrol,
205 struct snd_ctl_elem_info *uinfo)
207 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
208 struct tasdevice_fw *tas_fw = tas_priv->fmw;
210 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
212 uinfo->value.integer.min = 0;
213 uinfo->value.integer.max = tas_fw->nr_programs - 1;
218 static int tasdevice_info_config(struct snd_kcontrol *kcontrol,
219 struct snd_ctl_elem_info *uinfo)
221 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
222 struct tasdevice_fw *tas_fw = tas_priv->fmw;
224 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
226 uinfo->value.integer.min = 0;
227 uinfo->value.integer.max = tas_fw->nr_configurations - 1;
232 static int tasdevice_program_get(struct snd_kcontrol *kcontrol,
233 struct snd_ctl_elem_value *ucontrol)
235 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
237 ucontrol->value.integer.value[0] = tas_priv->cur_prog;
242 static int tasdevice_program_put(struct snd_kcontrol *kcontrol,
243 struct snd_ctl_elem_value *ucontrol)
245 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
246 struct tasdevice_fw *tas_fw = tas_priv->fmw;
247 int nr_program = ucontrol->value.integer.value[0];
248 int max = tas_fw->nr_programs - 1;
251 val = tasdevice_hda_clamp(nr_program, max);
253 if (tas_priv->cur_prog != val) {
254 tas_priv->cur_prog = val;
261 static int tasdevice_config_get(struct snd_kcontrol *kcontrol,
262 struct snd_ctl_elem_value *ucontrol)
264 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
266 ucontrol->value.integer.value[0] = tas_priv->cur_conf;
271 static int tasdevice_config_put(struct snd_kcontrol *kcontrol,
272 struct snd_ctl_elem_value *ucontrol)
274 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
275 struct tasdevice_fw *tas_fw = tas_priv->fmw;
276 int nr_config = ucontrol->value.integer.value[0];
277 int max = tas_fw->nr_configurations - 1;
280 val = tasdevice_hda_clamp(nr_config, max);
282 if (tas_priv->cur_conf != val) {
283 tas_priv->cur_conf = val;
291 * tas2781_digital_getvol - get the volum control
292 * @kcontrol: control pointer
293 * @ucontrol: User data
294 * Customer Kcontrol for tas2781 is primarily for regmap booking, paging
295 * depends on internal regmap mechanism.
296 * tas2781 contains book and page two-level register map, especially
297 * book switching will set the register BXXP00R7F, after switching to the
298 * correct book, then leverage the mechanism for paging to access the
301 static int tas2781_digital_getvol(struct snd_kcontrol *kcontrol,
302 struct snd_ctl_elem_value *ucontrol)
304 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
305 struct soc_mixer_control *mc =
306 (struct soc_mixer_control *)kcontrol->private_value;
308 return tasdevice_digital_getvol(tas_priv, ucontrol, mc);
311 static int tas2781_amp_getvol(struct snd_kcontrol *kcontrol,
312 struct snd_ctl_elem_value *ucontrol)
314 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
315 struct soc_mixer_control *mc =
316 (struct soc_mixer_control *)kcontrol->private_value;
318 return tasdevice_amp_getvol(tas_priv, ucontrol, mc);
321 static int tas2781_digital_putvol(struct snd_kcontrol *kcontrol,
322 struct snd_ctl_elem_value *ucontrol)
324 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
325 struct soc_mixer_control *mc =
326 (struct soc_mixer_control *)kcontrol->private_value;
328 /* The check of the given value is in tasdevice_digital_putvol. */
329 return tasdevice_digital_putvol(tas_priv, ucontrol, mc);
332 static int tas2781_amp_putvol(struct snd_kcontrol *kcontrol,
333 struct snd_ctl_elem_value *ucontrol)
335 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
336 struct soc_mixer_control *mc =
337 (struct soc_mixer_control *)kcontrol->private_value;
339 /* The check of the given value is in tasdevice_amp_putvol. */
340 return tasdevice_amp_putvol(tas_priv, ucontrol, mc);
343 static int tas2781_force_fwload_get(struct snd_kcontrol *kcontrol,
344 struct snd_ctl_elem_value *ucontrol)
346 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
348 ucontrol->value.integer.value[0] = (int)tas_priv->force_fwload_status;
349 dev_dbg(tas_priv->dev, "%s : Force FWload %s\n", __func__,
350 tas_priv->force_fwload_status ? "ON" : "OFF");
355 static int tas2781_force_fwload_put(struct snd_kcontrol *kcontrol,
356 struct snd_ctl_elem_value *ucontrol)
358 struct tasdevice_priv *tas_priv = snd_kcontrol_chip(kcontrol);
359 bool change, val = (bool)ucontrol->value.integer.value[0];
361 if (tas_priv->force_fwload_status == val)
365 tas_priv->force_fwload_status = val;
367 dev_dbg(tas_priv->dev, "%s : Force FWload %s\n", __func__,
368 tas_priv->force_fwload_status ? "ON" : "OFF");
373 static const struct snd_kcontrol_new tas2781_snd_controls[] = {
374 ACARD_SINGLE_RANGE_EXT_TLV("Speaker Analog Gain", TAS2781_AMP_LEVEL,
375 1, 0, 20, 0, tas2781_amp_getvol,
376 tas2781_amp_putvol, amp_vol_tlv),
377 ACARD_SINGLE_RANGE_EXT_TLV("Speaker Digital Gain", TAS2781_DVC_LVL,
378 0, 0, 200, 1, tas2781_digital_getvol,
379 tas2781_digital_putvol, dvc_tlv),
380 ACARD_SINGLE_BOOL_EXT("Speaker Force Firmware Load", 0,
381 tas2781_force_fwload_get, tas2781_force_fwload_put),
384 static const struct snd_kcontrol_new tas2781_prof_ctrl = {
385 .name = "Speaker Profile Id",
386 .iface = SNDRV_CTL_ELEM_IFACE_CARD,
387 .info = tasdevice_info_profile,
388 .get = tasdevice_get_profile_id,
389 .put = tasdevice_set_profile_id,
392 static const struct snd_kcontrol_new tas2781_dsp_prog_ctrl = {
393 .name = "Speaker Program Id",
394 .iface = SNDRV_CTL_ELEM_IFACE_CARD,
395 .info = tasdevice_info_programs,
396 .get = tasdevice_program_get,
397 .put = tasdevice_program_put,
400 static const struct snd_kcontrol_new tas2781_dsp_conf_ctrl = {
401 .name = "Speaker Config Id",
402 .iface = SNDRV_CTL_ELEM_IFACE_CARD,
403 .info = tasdevice_info_config,
404 .get = tasdevice_config_get,
405 .put = tasdevice_config_put,
408 static void tas2781_apply_calib(struct tasdevice_priv *tas_priv)
410 static const unsigned char page_array[CALIB_MAX] = {
411 0x17, 0x18, 0x18, 0x0d, 0x18
413 static const unsigned char rgno_array[CALIB_MAX] = {
414 0x74, 0x0c, 0x14, 0x3c, 0x7c
419 for (i = 0; i < tas_priv->ndev; i++) {
420 data = tas_priv->cali_data.data +
421 i * TASDEVICE_SPEAKER_CALIBRATION_SIZE;
422 for (j = 0; j < CALIB_MAX; j++) {
423 rc = tasdevice_dev_bulk_write(tas_priv, i,
424 TASDEVICE_REG(0, page_array[j], rgno_array[j]),
427 dev_err(tas_priv->dev,
428 "chn %d calib %d bulk_wr err = %d\n",
434 /* Update the calibrate data, including speaker impedance, f0, etc, into algo.
435 * Calibrate data is done by manufacturer in the factory. These data are used
436 * by Algo for calucating the speaker temperature, speaker membrance excursion
437 * and f0 in real time during playback.
439 static int tas2781_save_calibration(struct tasdevice_priv *tas_priv)
441 efi_guid_t efi_guid = EFI_GUID(0x02f9af02, 0x7734, 0x4233, 0xb4, 0x3d,
442 0x93, 0xfe, 0x5a, 0xa3, 0x5d, 0xb3);
443 static efi_char16_t efi_name[] = L"CALI_DATA";
444 struct tm *tm = &tas_priv->tm;
445 unsigned int attr, crc;
446 unsigned int *tmp_val;
450 if (tas_priv->catlog_id == LENOVO)
451 efi_guid = EFI_GUID(0x1f52d2a1, 0xbb3a, 0x457d, 0xbc, 0x09,
452 0x43, 0xa3, 0xf4, 0x31, 0x0a, 0x92);
454 tas_priv->cali_data.total_sz = 0;
455 /* Get real size of UEFI variable */
456 status = efi.get_variable(efi_name, &efi_guid, &attr,
457 &tas_priv->cali_data.total_sz, tas_priv->cali_data.data);
458 if (status == EFI_BUFFER_TOO_SMALL) {
459 /* Allocate data buffer of data_size bytes */
460 tas_priv->cali_data.data = devm_kzalloc(tas_priv->dev,
461 tas_priv->cali_data.total_sz, GFP_KERNEL);
462 if (!tas_priv->cali_data.data)
464 /* Get variable contents into buffer */
465 status = efi.get_variable(efi_name, &efi_guid, &attr,
466 &tas_priv->cali_data.total_sz,
467 tas_priv->cali_data.data);
468 if (status != EFI_SUCCESS)
472 tmp_val = (unsigned int *)tas_priv->cali_data.data;
474 crc = crc32(~0, tas_priv->cali_data.data, 84) ^ ~0;
475 dev_dbg(tas_priv->dev, "cali crc 0x%08x PK tmp_val 0x%08x\n",
478 if (crc == tmp_val[21]) {
479 time64_to_tm(tmp_val[20], 0, tm);
480 dev_dbg(tas_priv->dev, "%4ld-%2d-%2d, %2d:%2d:%2d\n",
481 tm->tm_year, tm->tm_mon, tm->tm_mday,
482 tm->tm_hour, tm->tm_min, tm->tm_sec);
483 tas2781_apply_calib(tas_priv);
485 tas_priv->cali_data.total_sz = 0;
490 static void tasdev_fw_ready(const struct firmware *fmw, void *context)
492 struct tasdevice_priv *tas_priv = context;
493 struct hda_codec *codec = tas_priv->codec;
496 pm_runtime_get_sync(tas_priv->dev);
497 mutex_lock(&tas_priv->codec_lock);
499 ret = tasdevice_rca_parser(tas_priv, fmw);
503 ret = snd_ctl_add(codec->card,
504 snd_ctl_new1(&tas2781_prof_ctrl, tas_priv));
506 dev_err(tas_priv->dev,
507 "Failed to add KControl %s = %d\n",
508 tas2781_prof_ctrl.name, ret);
512 for (i = 0; i < ARRAY_SIZE(tas2781_snd_controls); i++) {
513 ret = snd_ctl_add(codec->card,
514 snd_ctl_new1(&tas2781_snd_controls[i], tas_priv));
516 dev_err(tas_priv->dev,
517 "Failed to add KControl %s = %d\n",
518 tas2781_snd_controls[i].name, ret);
523 tasdevice_dsp_remove(tas_priv);
525 tas_priv->fw_state = TASDEVICE_DSP_FW_PENDING;
526 scnprintf(tas_priv->coef_binaryname, 64, "TAS2XXX%04X.bin",
527 codec->core.subsystem_id & 0xffff);
528 ret = tasdevice_dsp_parser(tas_priv);
530 dev_err(tas_priv->dev, "dspfw load %s error\n",
531 tas_priv->coef_binaryname);
532 tas_priv->fw_state = TASDEVICE_DSP_FW_FAIL;
536 ret = snd_ctl_add(codec->card,
537 snd_ctl_new1(&tas2781_dsp_prog_ctrl, tas_priv));
539 dev_err(tas_priv->dev,
540 "Failed to add KControl %s = %d\n",
541 tas2781_dsp_prog_ctrl.name, ret);
545 ret = snd_ctl_add(codec->card,
546 snd_ctl_new1(&tas2781_dsp_conf_ctrl, tas_priv));
548 dev_err(tas_priv->dev,
549 "Failed to add KControl %s = %d\n",
550 tas2781_dsp_conf_ctrl.name, ret);
554 tas_priv->fw_state = TASDEVICE_DSP_FW_ALL_OK;
555 tasdevice_prmg_load(tas_priv, 0);
557 /* If calibrated data occurs error, dsp will still works with default
558 * calibrated data inside algo.
560 tas2781_save_calibration(tas_priv);
563 if (tas_priv->fw_state == TASDEVICE_DSP_FW_FAIL) {
564 /*If DSP FW fail, kcontrol won't be created */
565 tasdevice_config_info_remove(tas_priv);
566 tasdevice_dsp_remove(tas_priv);
568 mutex_unlock(&tas_priv->codec_lock);
570 release_firmware(fmw);
571 pm_runtime_mark_last_busy(tas_priv->dev);
572 pm_runtime_put_autosuspend(tas_priv->dev);
575 static int tas2781_hda_bind(struct device *dev, struct device *master,
578 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
579 struct hda_component *comps = master_data;
580 struct hda_codec *codec;
584 if (!comps || tas_priv->index < 0 ||
585 tas_priv->index >= HDA_MAX_COMPONENTS)
588 comps = &comps[tas_priv->index];
592 codec = comps->codec;
593 subid = codec->core.subsystem_id >> 16;
597 tas_priv->catlog_id = LENOVO;
600 tas_priv->catlog_id = OTHERS;
604 pm_runtime_get_sync(dev);
608 strscpy(comps->name, dev_name(dev), sizeof(comps->name));
610 ret = tascodec_init(tas_priv, codec, tasdev_fw_ready);
612 comps->playback_hook = tas2781_hda_playback_hook;
614 pm_runtime_mark_last_busy(dev);
615 pm_runtime_put_autosuspend(dev);
620 static void tas2781_hda_unbind(struct device *dev,
621 struct device *master, void *master_data)
623 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
624 struct hda_component *comps = master_data;
626 if (comps[tas_priv->index].dev == dev)
627 memset(&comps[tas_priv->index], 0, sizeof(*comps));
629 tasdevice_config_info_remove(tas_priv);
630 tasdevice_dsp_remove(tas_priv);
632 tas_priv->fw_state = TASDEVICE_DSP_FW_PENDING;
635 static const struct component_ops tas2781_hda_comp_ops = {
636 .bind = tas2781_hda_bind,
637 .unbind = tas2781_hda_unbind,
640 static void tas2781_hda_remove(struct device *dev)
642 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
644 pm_runtime_get_sync(tas_priv->dev);
645 pm_runtime_disable(tas_priv->dev);
647 component_del(tas_priv->dev, &tas2781_hda_comp_ops);
649 pm_runtime_put_noidle(tas_priv->dev);
651 tasdevice_remove(tas_priv);
654 static int tas2781_hda_i2c_probe(struct i2c_client *clt)
656 struct tasdevice_priv *tas_priv;
657 const char *device_name;
660 if (strstr(dev_name(&clt->dev), "TIAS2781"))
661 device_name = "TIAS2781";
665 tas_priv = tasdevice_kzalloc(clt);
669 tas_priv->irq_info.irq = clt->irq;
670 ret = tas2781_read_acpi(tas_priv, device_name);
672 return dev_err_probe(tas_priv->dev, ret,
673 "Platform not supported\n");
675 ret = tasdevice_init(tas_priv);
679 pm_runtime_set_autosuspend_delay(tas_priv->dev, 3000);
680 pm_runtime_use_autosuspend(tas_priv->dev);
681 pm_runtime_mark_last_busy(tas_priv->dev);
682 pm_runtime_set_active(tas_priv->dev);
683 pm_runtime_get_noresume(tas_priv->dev);
684 pm_runtime_enable(tas_priv->dev);
686 pm_runtime_put_autosuspend(tas_priv->dev);
688 ret = component_add(tas_priv->dev, &tas2781_hda_comp_ops);
690 dev_err(tas_priv->dev, "Register component failed: %d\n", ret);
691 pm_runtime_disable(tas_priv->dev);
695 tas2781_reset(tas_priv);
698 tas2781_hda_remove(&clt->dev);
702 static void tas2781_hda_i2c_remove(struct i2c_client *clt)
704 tas2781_hda_remove(&clt->dev);
707 static int tas2781_runtime_suspend(struct device *dev)
709 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
712 dev_dbg(tas_priv->dev, "Runtime Suspend\n");
714 mutex_lock(&tas_priv->codec_lock);
716 if (tas_priv->playback_started) {
717 tasdevice_tuning_switch(tas_priv, 1);
718 tas_priv->playback_started = false;
721 for (i = 0; i < tas_priv->ndev; i++) {
722 tas_priv->tasdevice[i].cur_book = -1;
723 tas_priv->tasdevice[i].cur_prog = -1;
724 tas_priv->tasdevice[i].cur_conf = -1;
727 regcache_cache_only(tas_priv->regmap, true);
728 regcache_mark_dirty(tas_priv->regmap);
730 mutex_unlock(&tas_priv->codec_lock);
735 static int tas2781_runtime_resume(struct device *dev)
737 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
738 unsigned long calib_data_sz =
739 tas_priv->ndev * TASDEVICE_SPEAKER_CALIBRATION_SIZE;
742 dev_dbg(tas_priv->dev, "Runtime Resume\n");
744 mutex_lock(&tas_priv->codec_lock);
746 regcache_cache_only(tas_priv->regmap, false);
747 ret = regcache_sync(tas_priv->regmap);
749 dev_err(tas_priv->dev,
750 "Failed to restore register cache: %d\n", ret);
754 tasdevice_prmg_load(tas_priv, tas_priv->cur_prog);
756 /* If calibrated data occurs error, dsp will still works with default
757 * calibrated data inside algo.
759 if (tas_priv->cali_data.total_sz > calib_data_sz)
760 tas2781_apply_calib(tas_priv);
763 mutex_unlock(&tas_priv->codec_lock);
768 static int tas2781_system_suspend(struct device *dev)
770 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
773 dev_dbg(tas_priv->dev, "System Suspend\n");
775 ret = pm_runtime_force_suspend(dev);
779 /* Shutdown chip before system suspend */
780 regcache_cache_only(tas_priv->regmap, false);
781 tasdevice_tuning_switch(tas_priv, 1);
782 regcache_cache_only(tas_priv->regmap, true);
783 regcache_mark_dirty(tas_priv->regmap);
786 * Reset GPIO may be shared, so cannot reset here.
787 * However beyond this point, amps may be powered down.
792 static int tas2781_system_resume(struct device *dev)
794 struct tasdevice_priv *tas_priv = dev_get_drvdata(dev);
795 unsigned long calib_data_sz =
796 tas_priv->ndev * TASDEVICE_SPEAKER_CALIBRATION_SIZE;
799 dev_dbg(tas_priv->dev, "System Resume\n");
801 ret = pm_runtime_force_resume(dev);
805 mutex_lock(&tas_priv->codec_lock);
807 for (i = 0; i < tas_priv->ndev; i++) {
808 tas_priv->tasdevice[i].cur_book = -1;
809 tas_priv->tasdevice[i].cur_prog = -1;
810 tas_priv->tasdevice[i].cur_conf = -1;
812 tas2781_reset(tas_priv);
813 tasdevice_prmg_load(tas_priv, tas_priv->cur_prog);
815 /* If calibrated data occurs error, dsp will still work with default
816 * calibrated data inside algo.
818 if (tas_priv->cali_data.total_sz > calib_data_sz)
819 tas2781_apply_calib(tas_priv);
820 mutex_unlock(&tas_priv->codec_lock);
825 static const struct dev_pm_ops tas2781_hda_pm_ops = {
826 RUNTIME_PM_OPS(tas2781_runtime_suspend, tas2781_runtime_resume, NULL)
827 SYSTEM_SLEEP_PM_OPS(tas2781_system_suspend, tas2781_system_resume)
830 static const struct i2c_device_id tas2781_hda_i2c_id[] = {
831 { "tas2781-hda", 0 },
835 static const struct acpi_device_id tas2781_acpi_hda_match[] = {
839 MODULE_DEVICE_TABLE(acpi, tas2781_acpi_hda_match);
841 static struct i2c_driver tas2781_hda_i2c_driver = {
843 .name = "tas2781-hda",
844 .acpi_match_table = tas2781_acpi_hda_match,
845 .pm = &tas2781_hda_pm_ops,
847 .id_table = tas2781_hda_i2c_id,
848 .probe = tas2781_hda_i2c_probe,
849 .remove = tas2781_hda_i2c_remove,
851 module_i2c_driver(tas2781_hda_i2c_driver);
853 MODULE_DESCRIPTION("TAS2781 HDA Driver");
854 MODULE_AUTHOR("Shenghao Ding, TI, <shenghao-ding@ti.com>");
855 MODULE_LICENSE("GPL");
856 MODULE_IMPORT_NS(SND_SOC_TAS2781_FMWLIB);