Lines Matching +full:dsp +full:- +full:ctrl
1 // SPDX-License-Identifier: GPL-2.0
3 // cs35l45.c - CS35L45 ALSA SoC audio driver
5 // Copyright 2019-2022 Cirrus Logic, Inc.
53 if (!cs35l45->dsp.cs_dsp.running) { in cs35l45_set_cspl_mbox_cmd()
54 dev_err(cs35l45->dev, "DSP not running\n"); in cs35l45_set_cspl_mbox_cmd()
55 return -EPERM; in cs35l45_set_cspl_mbox_cmd()
62 dev_err(cs35l45->dev, "Failed to write MBOX: %d\n", ret); in cs35l45_set_cspl_mbox_cmd()
72 dev_err(cs35l45->dev, "Failed to read MBOX STS: %d\n", ret); in cs35l45_set_cspl_mbox_cmd()
77 dev_dbg(cs35l45->dev, "[%u] cmd %u returned invalid sts %u", i, cmd, sts); in cs35l45_set_cspl_mbox_cmd()
83 dev_err(cs35l45->dev, "Failed to set mailbox cmd %u (status %u)\n", cmd, sts); in cs35l45_set_cspl_mbox_cmd()
85 return -ENOMSG; in cs35l45_set_cspl_mbox_cmd()
91 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); in cs35l45_global_en_ev()
94 dev_dbg(cs35l45->dev, "%s event : %x\n", __func__, event); in cs35l45_global_en_ev()
98 regmap_write(cs35l45->regmap, CS35L45_GLOBAL_ENABLES, in cs35l45_global_en_ev()
106 regmap_write(cs35l45->regmap, CS35L45_GLOBAL_ENABLES, 0); in cs35l45_global_en_ev()
118 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); in cs35l45_dsp_preload_ev()
124 if (cs35l45->dsp.cs_dsp.booted) in cs35l45_dsp_preload_ev()
129 if (cs35l45->dsp.cs_dsp.running) in cs35l45_dsp_preload_ev()
132 regmap_set_bits(cs35l45->regmap, CS35L45_PWRMGT_CTL, in cs35l45_dsp_preload_ev()
137 if (cs35l45->dsp.preloaded) in cs35l45_dsp_preload_ev()
140 if (cs35l45->dsp.cs_dsp.running) { in cs35l45_dsp_preload_ev()
155 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); in cs35l45_dsp_audio_ev()
160 return cs35l45_set_cspl_mbox_cmd(cs35l45, cs35l45->regmap, in cs35l45_dsp_audio_ev()
163 return cs35l45_set_cspl_mbox_cmd(cs35l45, cs35l45->regmap, in cs35l45_dsp_audio_ev()
435 static const DECLARE_TLV_DB_SCALE(cs35l45_dig_pcm_vol_tlv, -10225, 25, true);
442 -409, 48,
443 (CS35L45_AMP_VOL_PCM_WIDTH - 1) - 1,
456 dev_err(cs35l45->dev, "Invalid freq: %u\n", freq); in cs35l45_set_pll()
457 return -EINVAL; in cs35l45_set_pll()
460 regmap_read(cs35l45->regmap, CS35L45_REFCLK_INPUT, &val); in cs35l45_set_pll()
465 regmap_set_bits(cs35l45->regmap, CS35L45_REFCLK_INPUT, CS35L45_PLL_OPEN_LOOP_MASK); in cs35l45_set_pll()
466 regmap_update_bits(cs35l45->regmap, CS35L45_REFCLK_INPUT, in cs35l45_set_pll()
469 regmap_clear_bits(cs35l45->regmap, CS35L45_REFCLK_INPUT, CS35L45_PLL_REFCLK_EN_MASK); in cs35l45_set_pll()
470 regmap_clear_bits(cs35l45->regmap, CS35L45_REFCLK_INPUT, CS35L45_PLL_OPEN_LOOP_MASK); in cs35l45_set_pll()
471 regmap_set_bits(cs35l45->regmap, CS35L45_REFCLK_INPUT, CS35L45_PLL_REFCLK_EN_MASK); in cs35l45_set_pll()
478 struct cs35l45_private *cs35l45 = snd_soc_component_get_drvdata(codec_dai->component); in cs35l45_asp_set_fmt()
485 dev_err(cs35l45->dev, "Invalid DAI clocking\n"); in cs35l45_asp_set_fmt()
486 return -EINVAL; in cs35l45_asp_set_fmt()
497 dev_err(cs35l45->dev, "Invalid DAI format\n"); in cs35l45_asp_set_fmt()
498 return -EINVAL; in cs35l45_asp_set_fmt()
519 dev_warn(cs35l45->dev, "Invalid DAI clock polarity\n"); in cs35l45_asp_set_fmt()
520 return -EINVAL; in cs35l45_asp_set_fmt()
523 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_CONTROL2, in cs35l45_asp_set_fmt()
538 struct cs35l45_private *cs35l45 = snd_soc_component_get_drvdata(dai->component); in cs35l45_asp_hw_params()
556 dev_warn(cs35l45->dev, "Unsupported sample rate (%d)\n", in cs35l45_asp_hw_params()
558 return -EINVAL; in cs35l45_asp_hw_params()
561 regmap_update_bits(cs35l45->regmap, CS35L45_GLOBAL_SAMPLE_RATE, in cs35l45_asp_hw_params()
567 if (cs35l45->slot_width) in cs35l45_asp_hw_params()
568 asp_width = cs35l45->slot_width; in cs35l45_asp_hw_params()
572 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { in cs35l45_asp_hw_params()
573 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_CONTROL2, in cs35l45_asp_hw_params()
577 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_DATA_CONTROL5, in cs35l45_asp_hw_params()
581 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_CONTROL2, in cs35l45_asp_hw_params()
585 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_DATA_CONTROL1, in cs35l45_asp_hw_params()
590 if (cs35l45->sysclk_set) in cs35l45_asp_hw_params()
594 regmap_read(cs35l45->regmap, CS35L45_ASP_CONTROL2, &asp_fmt); in cs35l45_asp_hw_params()
602 cs35l45->slot_count, slot_multiple); in cs35l45_asp_hw_params()
611 struct cs35l45_private *cs35l45 = snd_soc_component_get_drvdata(dai->component); in cs35l45_asp_set_tdm_slot()
614 return -EINVAL; in cs35l45_asp_set_tdm_slot()
616 cs35l45->slot_width = slot_width; in cs35l45_asp_set_tdm_slot()
617 cs35l45->slot_count = slots; in cs35l45_asp_set_tdm_slot()
625 struct cs35l45_private *cs35l45 = snd_soc_component_get_drvdata(dai->component); in cs35l45_asp_set_sysclk()
629 dev_err(cs35l45->dev, "Invalid clk_id %d\n", clk_id); in cs35l45_asp_set_sysclk()
630 return -EINVAL; in cs35l45_asp_set_sysclk()
633 cs35l45->sysclk_set = false; in cs35l45_asp_set_sysclk()
639 return -EINVAL; in cs35l45_asp_set_sysclk()
641 cs35l45->sysclk_set = true; in cs35l45_asp_set_sysclk()
648 struct cs35l45_private *cs35l45 = snd_soc_component_get_drvdata(dai->component); in cs35l45_mute_stream()
654 regmap_read(cs35l45->regmap, CS35L45_GLOBAL_SAMPLE_RATE, &global_fs); in cs35l45_mute_stream()
668 regmap_read(cs35l45->regmap, CS35L45_AMP_PCM_HPF_TST, &val); in cs35l45_mute_stream()
679 regmap_multi_reg_write(cs35l45->regmap, hpf_override_seq, in cs35l45_mute_stream()
721 return wm_adsp2_component_probe(&cs35l45->dsp, component); in cs35l45_component_probe()
728 wm_adsp2_component_remove(&cs35l45->dsp, component); in cs35l45_component_remove()
753 if (cs35l45->bus_type == CONTROL_BUS_I2C) in cs35l45_setup_hibernate()
758 regmap_update_bits(cs35l45->regmap, CS35L45_WAKESRC_CTL, in cs35l45_setup_hibernate()
762 regmap_set_bits(cs35l45->regmap, CS35L45_WAKESRC_CTL, in cs35l45_setup_hibernate()
765 regmap_update_bits(cs35l45->regmap, CS35L45_WKI2C_CTL, in cs35l45_setup_hibernate()
766 CS35L45_WKI2C_ADDR_MASK, cs35l45->i2c_addr); in cs35l45_setup_hibernate()
768 regmap_set_bits(cs35l45->regmap, CS35L45_WKI2C_CTL, in cs35l45_setup_hibernate()
774 dev_dbg(cs35l45->dev, "Enter hibernate\n"); in cs35l45_enter_hibernate()
778 regmap_set_bits(cs35l45->regmap, CS35L45_IRQ1_MASK_2, CS35L45_DSP_VIRT2_MBOX_MASK); in cs35l45_enter_hibernate()
781 regmap_write(cs35l45->regmap, CS35L45_DSP_VIRT1_MBOX_1, CSPL_MBOX_CMD_HIBERNATE); in cs35l45_enter_hibernate()
793 dev_dbg(cs35l45->dev, "Exit hibernate\n"); in cs35l45_exit_hibernate()
796 ret = cs35l45_set_cspl_mbox_cmd(cs35l45, cs35l45->regmap, in cs35l45_exit_hibernate()
799 dev_dbg(cs35l45->dev, "Wake success at cycle: %d\n", j); in cs35l45_exit_hibernate()
800 regmap_clear_bits(cs35l45->regmap, CS35L45_IRQ1_MASK_2, in cs35l45_exit_hibernate()
807 dev_err(cs35l45->dev, "Wake failed, re-enter hibernate: %d\n", ret); in cs35l45_exit_hibernate()
812 dev_err(cs35l45->dev, "Timed out waking device\n"); in cs35l45_exit_hibernate()
814 return -ETIMEDOUT; in cs35l45_exit_hibernate()
821 if (!cs35l45->dsp.preloaded || !cs35l45->dsp.cs_dsp.running) in cs35l45_runtime_suspend()
826 regcache_cache_only(cs35l45->regmap, true); in cs35l45_runtime_suspend()
827 regcache_mark_dirty(cs35l45->regmap); in cs35l45_runtime_suspend()
829 dev_dbg(cs35l45->dev, "Runtime suspended\n"); in cs35l45_runtime_suspend()
839 if (!cs35l45->dsp.preloaded || !cs35l45->dsp.cs_dsp.running) in cs35l45_runtime_resume()
842 dev_dbg(cs35l45->dev, "Runtime resume\n"); in cs35l45_runtime_resume()
844 regcache_cache_only(cs35l45->regmap, false); in cs35l45_runtime_resume()
850 ret = regcache_sync(cs35l45->regmap); in cs35l45_runtime_resume()
852 dev_warn(cs35l45->dev, "regcache_sync failed: %d\n", ret); in cs35l45_runtime_resume()
855 regmap_clear_bits(cs35l45->regmap, CS35L45_ERROR_RELEASE, CS35L45_GLOBAL_ERR_RLS_MASK); in cs35l45_runtime_resume()
856 regmap_set_bits(cs35l45->regmap, CS35L45_ERROR_RELEASE, CS35L45_GLOBAL_ERR_RLS_MASK); in cs35l45_runtime_resume()
857 regmap_clear_bits(cs35l45->regmap, CS35L45_ERROR_RELEASE, CS35L45_GLOBAL_ERR_RLS_MASK); in cs35l45_runtime_resume()
865 dev_dbg(cs35l45->dev, "System suspend, disabling IRQ\n"); in cs35l45_sys_suspend()
866 disable_irq(cs35l45->irq); in cs35l45_sys_suspend()
875 dev_dbg(cs35l45->dev, "Late system suspend, reenabling IRQ\n"); in cs35l45_sys_suspend_noirq()
876 enable_irq(cs35l45->irq); in cs35l45_sys_suspend_noirq()
885 dev_dbg(cs35l45->dev, "Early system resume, disabling IRQ\n"); in cs35l45_sys_resume_noirq()
886 disable_irq(cs35l45->irq); in cs35l45_sys_resume_noirq()
895 dev_dbg(cs35l45->dev, "System resume, reenabling IRQ\n"); in cs35l45_sys_resume()
896 enable_irq(cs35l45->irq); in cs35l45_sys_resume()
903 struct device_node *node = cs35l45->dev->of_node; in cs35l45_apply_property_config()
917 sprintf(of_name, "cirrus,gpio-ctrl%d", i + 1); in cs35l45_apply_property_config()
922 ret = of_property_read_u32(child, "gpio-dir", &val); in cs35l45_apply_property_config()
924 regmap_update_bits(cs35l45->regmap, gpio_regs[i], in cs35l45_apply_property_config()
928 ret = of_property_read_u32(child, "gpio-lvl", &val); in cs35l45_apply_property_config()
930 regmap_update_bits(cs35l45->regmap, gpio_regs[i], in cs35l45_apply_property_config()
934 ret = of_property_read_u32(child, "gpio-op-cfg", &val); in cs35l45_apply_property_config()
936 regmap_update_bits(cs35l45->regmap, gpio_regs[i], in cs35l45_apply_property_config()
940 ret = of_property_read_u32(child, "gpio-pol", &val); in cs35l45_apply_property_config()
942 regmap_update_bits(cs35l45->regmap, gpio_regs[i], in cs35l45_apply_property_config()
946 ret = of_property_read_u32(child, "gpio-ctrl", &val); in cs35l45_apply_property_config()
948 regmap_update_bits(cs35l45->regmap, pad_regs[i], in cs35l45_apply_property_config()
952 ret = of_property_read_u32(child, "gpio-invert", &val); in cs35l45_apply_property_config()
954 regmap_update_bits(cs35l45->regmap, pad_regs[i], in cs35l45_apply_property_config()
958 cs35l45->irq_invert = val; in cs35l45_apply_property_config()
964 if (device_property_read_u32(cs35l45->dev, in cs35l45_apply_property_config()
965 "cirrus,asp-sdout-hiz-ctrl", &val) == 0) { in cs35l45_apply_property_config()
966 regmap_update_bits(cs35l45->regmap, CS35L45_ASP_CONTROL3, in cs35l45_apply_property_config()
994 dev_info(cs35l45->dev, "MBOX event (SPEAKER_STATUS): %s\n", in cs35l45_dsp_virt2_mbox3_irq_handle()
998 dev_dbg(cs35l45->dev, "MBOX event (BOOT_DONE)\n"); in cs35l45_dsp_virt2_mbox3_irq_handle()
1001 dev_err(cs35l45->dev, "MBOX event not supported %u\n", cmd); in cs35l45_dsp_virt2_mbox3_irq_handle()
1002 return -EINVAL; in cs35l45_dsp_virt2_mbox3_irq_handle()
1014 ret = regmap_read(cs35l45->regmap, CS35L45_DSP_VIRT2_MBOX_3, &mbox_val); in cs35l45_dsp_virt2_mbox_cb()
1019 /* Handle DSP trace log IRQ */ in cs35l45_dsp_virt2_mbox_cb()
1020 ret = regmap_read(cs35l45->regmap, CS35L45_DSP_VIRT2_MBOX_4, &mbox_val); in cs35l45_dsp_virt2_mbox_cb()
1022 dev_err(cs35l45->dev, "Spurious DSP MBOX4 IRQ\n"); in cs35l45_dsp_virt2_mbox_cb()
1032 dev_dbg(cs35l45->dev, "PLL unlock detected!"); in cs35l45_pll_unlock()
1041 dev_dbg(cs35l45->dev, "PLL lock detected!"); in cs35l45_pll_lock()
1057 CS35L45_IRQ(DSP_WDT_EXPIRE, "DSP Watchdog Timer", cs35l45_spk_safe_err),
1060 CS35L45_IRQ(DSP_VIRT2_MBOX, "DSP virtual MBOX 2 write flag", cs35l45_dsp_virt2_mbox_cb),
1068 i = irq - regmap_irq_get_virq(cs35l45->irq_data, 0); in cs35l45_spk_safe_err()
1071 dev_err(cs35l45->dev, "Unspecified global error condition (%d) detected!\n", irq); in cs35l45_spk_safe_err()
1073 dev_err(cs35l45->dev, "%s condition detected!\n", cs35l45_irqs[i].name); in cs35l45_spk_safe_err()
1107 struct device *dev = cs35l45->dev; in cs35l45_initialize()
1112 ret = regmap_read_poll_timeout(cs35l45->regmap, CS35L45_IRQ1_EINT_4, sts, in cs35l45_initialize()
1116 dev_err(cs35l45->dev, "Timeout waiting for OTP boot\n"); in cs35l45_initialize()
1120 ret = regmap_bulk_read(cs35l45->regmap, CS35L45_DEVID, dev_id, ARRAY_SIZE(dev_id)); in cs35l45_initialize()
1122 dev_err(cs35l45->dev, "Get Device ID failed: %d\n", ret); in cs35l45_initialize()
1131 dev_err(cs35l45->dev, "Bad DEVID 0x%x\n", dev_id[0]); in cs35l45_initialize()
1132 return -ENODEV; in cs35l45_initialize()
1135 dev_info(cs35l45->dev, "Cirrus Logic CS35L45: REVID %02X OTPID %02X\n", in cs35l45_initialize()
1138 regmap_write(cs35l45->regmap, CS35L45_IRQ1_EINT_4, in cs35l45_initialize()
1183 struct wm_adsp *dsp = &cs35l45->dsp; in cs35l45_dsp_init() local
1186 dsp->part = "cs35l45"; in cs35l45_dsp_init()
1187 dsp->fw = 9; /* 9 is WM_ADSP_FW_SPK_PROT in wm_adsp.c */ in cs35l45_dsp_init()
1188 dsp->toggle_preload = true; in cs35l45_dsp_init()
1189 dsp->cs_dsp.num = 1; in cs35l45_dsp_init()
1190 dsp->cs_dsp.type = WMFW_HALO; in cs35l45_dsp_init()
1191 dsp->cs_dsp.rev = 0; in cs35l45_dsp_init()
1192 dsp->cs_dsp.dev = cs35l45->dev; in cs35l45_dsp_init()
1193 dsp->cs_dsp.regmap = cs35l45->regmap; in cs35l45_dsp_init()
1194 dsp->cs_dsp.base = CS35L45_DSP1_CLOCK_FREQ; in cs35l45_dsp_init()
1195 dsp->cs_dsp.base_sysinfo = CS35L45_DSP1_SYS_ID; in cs35l45_dsp_init()
1196 dsp->cs_dsp.mem = cs35l45_dsp1_regions; in cs35l45_dsp_init()
1197 dsp->cs_dsp.num_mems = ARRAY_SIZE(cs35l45_dsp1_regions); in cs35l45_dsp_init()
1198 dsp->cs_dsp.lock_regions = 0xFFFFFFFF; in cs35l45_dsp_init()
1200 ret = wm_halo_init(dsp); in cs35l45_dsp_init()
1202 regmap_multi_reg_write(cs35l45->regmap, cs35l45_fs_errata_patch, in cs35l45_dsp_init()
1210 struct device *dev = cs35l45->dev; in cs35l45_probe()
1214 cs35l45->vdd_batt = devm_regulator_get(dev, "vdd-batt"); in cs35l45_probe()
1215 if (IS_ERR(cs35l45->vdd_batt)) in cs35l45_probe()
1216 return dev_err_probe(dev, PTR_ERR(cs35l45->vdd_batt), in cs35l45_probe()
1217 "Failed to request vdd-batt\n"); in cs35l45_probe()
1219 cs35l45->vdd_a = devm_regulator_get(dev, "vdd-a"); in cs35l45_probe()
1220 if (IS_ERR(cs35l45->vdd_a)) in cs35l45_probe()
1221 return dev_err_probe(dev, PTR_ERR(cs35l45->vdd_a), in cs35l45_probe()
1222 "Failed to request vdd-a\n"); in cs35l45_probe()
1225 ret = regulator_enable(cs35l45->vdd_batt); in cs35l45_probe()
1227 return dev_err_probe(dev, ret, "Failed to enable vdd-batt\n"); in cs35l45_probe()
1229 ret = regulator_enable(cs35l45->vdd_a); in cs35l45_probe()
1231 return dev_err_probe(dev, ret, "Failed to enable vdd-a\n"); in cs35l45_probe()
1234 cs35l45->reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW); in cs35l45_probe()
1235 if (IS_ERR(cs35l45->reset_gpio)) { in cs35l45_probe()
1236 ret = PTR_ERR(cs35l45->reset_gpio); in cs35l45_probe()
1237 cs35l45->reset_gpio = NULL; in cs35l45_probe()
1238 if (ret == -EBUSY) { in cs35l45_probe()
1246 if (cs35l45->reset_gpio) { in cs35l45_probe()
1248 gpiod_set_value_cansleep(cs35l45->reset_gpio, 1); in cs35l45_probe()
1261 pm_runtime_set_autosuspend_delay(cs35l45->dev, 3000); in cs35l45_probe()
1262 pm_runtime_use_autosuspend(cs35l45->dev); in cs35l45_probe()
1263 pm_runtime_mark_last_busy(cs35l45->dev); in cs35l45_probe()
1264 pm_runtime_set_active(cs35l45->dev); in cs35l45_probe()
1265 pm_runtime_get_noresume(cs35l45->dev); in cs35l45_probe()
1266 pm_runtime_enable(cs35l45->dev); in cs35l45_probe()
1268 if (cs35l45->irq) { in cs35l45_probe()
1269 if (cs35l45->irq_invert) in cs35l45_probe()
1274 ret = devm_regmap_add_irq_chip(dev, cs35l45->regmap, cs35l45->irq, irq_pol, 0, in cs35l45_probe()
1275 &cs35l45_regmap_irq_chip, &cs35l45->irq_data); in cs35l45_probe()
1282 irq = regmap_irq_get_virq(cs35l45->irq_data, cs35l45_irqs[i].irq); in cs35l45_probe()
1305 pm_runtime_put_autosuspend(cs35l45->dev); in cs35l45_probe()
1310 pm_runtime_disable(cs35l45->dev); in cs35l45_probe()
1311 pm_runtime_put_noidle(cs35l45->dev); in cs35l45_probe()
1312 wm_adsp2_remove(&cs35l45->dsp); in cs35l45_probe()
1315 gpiod_set_value_cansleep(cs35l45->reset_gpio, 0); in cs35l45_probe()
1317 regulator_disable(cs35l45->vdd_a); in cs35l45_probe()
1318 regulator_disable(cs35l45->vdd_batt); in cs35l45_probe()
1326 pm_runtime_get_sync(cs35l45->dev); in cs35l45_remove()
1327 pm_runtime_disable(cs35l45->dev); in cs35l45_remove()
1328 wm_adsp2_remove(&cs35l45->dsp); in cs35l45_remove()
1330 gpiod_set_value_cansleep(cs35l45->reset_gpio, 0); in cs35l45_remove()
1332 pm_runtime_put_noidle(cs35l45->dev); in cs35l45_remove()
1333 regulator_disable(cs35l45->vdd_a); in cs35l45_remove()
1334 /* VDD_BATT must be the last to power-off */ in cs35l45_remove()
1335 regulator_disable(cs35l45->vdd_batt); in cs35l45_remove()