1f2644a2cSMark Brown /* 2f2644a2cSMark Brown * wm8960.c -- WM8960 ALSA SoC Audio driver 3f2644a2cSMark Brown * 4656baaebSMark Brown * Copyright 2007-11 Wolfson Microelectronics, plc 5656baaebSMark Brown * 6f2644a2cSMark Brown * Author: Liam Girdwood 7f2644a2cSMark Brown * 8f2644a2cSMark Brown * This program is free software; you can redistribute it and/or modify 9f2644a2cSMark Brown * it under the terms of the GNU General Public License version 2 as 10f2644a2cSMark Brown * published by the Free Software Foundation. 11f2644a2cSMark Brown */ 12f2644a2cSMark Brown 13f2644a2cSMark Brown #include <linux/module.h> 14f2644a2cSMark Brown #include <linux/moduleparam.h> 15f2644a2cSMark Brown #include <linux/init.h> 16f2644a2cSMark Brown #include <linux/delay.h> 17f2644a2cSMark Brown #include <linux/pm.h> 1875aa8868SZidan Wang #include <linux/clk.h> 19f2644a2cSMark Brown #include <linux/i2c.h> 205a0e3ad6STejun Heo #include <linux/slab.h> 21f2644a2cSMark Brown #include <sound/core.h> 22f2644a2cSMark Brown #include <sound/pcm.h> 23f2644a2cSMark Brown #include <sound/pcm_params.h> 24f2644a2cSMark Brown #include <sound/soc.h> 25f2644a2cSMark Brown #include <sound/initval.h> 26f2644a2cSMark Brown #include <sound/tlv.h> 27b6877a47SMark Brown #include <sound/wm8960.h> 28f2644a2cSMark Brown 29f2644a2cSMark Brown #include "wm8960.h" 30f2644a2cSMark Brown 31f2644a2cSMark Brown /* R25 - Power 1 */ 32913d7b4cSMark Brown #define WM8960_VMID_MASK 0x180 33f2644a2cSMark Brown #define WM8960_VREF 0x40 34f2644a2cSMark Brown 35913d7b4cSMark Brown /* R26 - Power 2 */ 36913d7b4cSMark Brown #define WM8960_PWR2_LOUT1 0x40 37913d7b4cSMark Brown #define WM8960_PWR2_ROUT1 0x20 38913d7b4cSMark Brown #define WM8960_PWR2_OUT3 0x02 39913d7b4cSMark Brown 40f2644a2cSMark Brown /* R28 - Anti-pop 1 */ 41f2644a2cSMark Brown #define WM8960_POBCTRL 0x80 42f2644a2cSMark Brown #define WM8960_BUFDCOPEN 0x10 43f2644a2cSMark Brown #define WM8960_BUFIOEN 0x08 44f2644a2cSMark Brown #define WM8960_SOFT_ST 0x04 45f2644a2cSMark Brown #define WM8960_HPSTBY 0x01 46f2644a2cSMark Brown 47f2644a2cSMark Brown /* R29 - Anti-pop 2 */ 48f2644a2cSMark Brown #define WM8960_DISOP 0x40 49913d7b4cSMark Brown #define WM8960_DRES_MASK 0x30 50f2644a2cSMark Brown 513176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target); 52e075fc17SKuninori Morimoto static int wm8960_set_pll(struct snd_soc_component *component, 533176bf2dSZidan Wang unsigned int freq_in, unsigned int freq_out); 54f2644a2cSMark Brown /* 55f2644a2cSMark Brown * wm8960 register cache 56f2644a2cSMark Brown * We can't read the WM8960 register space when we are 57f2644a2cSMark Brown * using 2 wire for device control, so we cache them instead. 58f2644a2cSMark Brown */ 590ebe36c6SMark Brown static const struct reg_default wm8960_reg_defaults[] = { 60b3df026eSMark Brown { 0x0, 0x00a7 }, 61b3df026eSMark Brown { 0x1, 0x00a7 }, 620ebe36c6SMark Brown { 0x2, 0x0000 }, 630ebe36c6SMark Brown { 0x3, 0x0000 }, 640ebe36c6SMark Brown { 0x4, 0x0000 }, 650ebe36c6SMark Brown { 0x5, 0x0008 }, 660ebe36c6SMark Brown { 0x6, 0x0000 }, 670ebe36c6SMark Brown { 0x7, 0x000a }, 680ebe36c6SMark Brown { 0x8, 0x01c0 }, 690ebe36c6SMark Brown { 0x9, 0x0000 }, 700ebe36c6SMark Brown { 0xa, 0x00ff }, 710ebe36c6SMark Brown { 0xb, 0x00ff }, 720ebe36c6SMark Brown 730ebe36c6SMark Brown { 0x10, 0x0000 }, 740ebe36c6SMark Brown { 0x11, 0x007b }, 750ebe36c6SMark Brown { 0x12, 0x0100 }, 760ebe36c6SMark Brown { 0x13, 0x0032 }, 770ebe36c6SMark Brown { 0x14, 0x0000 }, 780ebe36c6SMark Brown { 0x15, 0x00c3 }, 790ebe36c6SMark Brown { 0x16, 0x00c3 }, 800ebe36c6SMark Brown { 0x17, 0x01c0 }, 810ebe36c6SMark Brown { 0x18, 0x0000 }, 820ebe36c6SMark Brown { 0x19, 0x0000 }, 830ebe36c6SMark Brown { 0x1a, 0x0000 }, 840ebe36c6SMark Brown { 0x1b, 0x0000 }, 850ebe36c6SMark Brown { 0x1c, 0x0000 }, 860ebe36c6SMark Brown { 0x1d, 0x0000 }, 870ebe36c6SMark Brown 880ebe36c6SMark Brown { 0x20, 0x0100 }, 890ebe36c6SMark Brown { 0x21, 0x0100 }, 900ebe36c6SMark Brown { 0x22, 0x0050 }, 910ebe36c6SMark Brown 920ebe36c6SMark Brown { 0x25, 0x0050 }, 930ebe36c6SMark Brown { 0x26, 0x0000 }, 940ebe36c6SMark Brown { 0x27, 0x0000 }, 950ebe36c6SMark Brown { 0x28, 0x0000 }, 960ebe36c6SMark Brown { 0x29, 0x0000 }, 970ebe36c6SMark Brown { 0x2a, 0x0040 }, 980ebe36c6SMark Brown { 0x2b, 0x0000 }, 990ebe36c6SMark Brown { 0x2c, 0x0000 }, 1000ebe36c6SMark Brown { 0x2d, 0x0050 }, 1010ebe36c6SMark Brown { 0x2e, 0x0050 }, 1020ebe36c6SMark Brown { 0x2f, 0x0000 }, 1030ebe36c6SMark Brown { 0x30, 0x0002 }, 1040ebe36c6SMark Brown { 0x31, 0x0037 }, 1050ebe36c6SMark Brown 1060ebe36c6SMark Brown { 0x33, 0x0080 }, 1070ebe36c6SMark Brown { 0x34, 0x0008 }, 1080ebe36c6SMark Brown { 0x35, 0x0031 }, 1090ebe36c6SMark Brown { 0x36, 0x0026 }, 1100ebe36c6SMark Brown { 0x37, 0x00e9 }, 111f2644a2cSMark Brown }; 112f2644a2cSMark Brown 1130ebe36c6SMark Brown static bool wm8960_volatile(struct device *dev, unsigned int reg) 1140ebe36c6SMark Brown { 1150ebe36c6SMark Brown switch (reg) { 1160ebe36c6SMark Brown case WM8960_RESET: 1170ebe36c6SMark Brown return true; 1180ebe36c6SMark Brown default: 1190ebe36c6SMark Brown return false; 1200ebe36c6SMark Brown } 1210ebe36c6SMark Brown } 1220ebe36c6SMark Brown 123f2644a2cSMark Brown struct wm8960_priv { 12475aa8868SZidan Wang struct clk *mclk; 1250ebe36c6SMark Brown struct regmap *regmap; 126e075fc17SKuninori Morimoto int (*set_bias_level)(struct snd_soc_component *, 127f0fba2adSLiam Girdwood enum snd_soc_bias_level level); 128913d7b4cSMark Brown struct snd_soc_dapm_widget *lout1; 129913d7b4cSMark Brown struct snd_soc_dapm_widget *rout1; 130913d7b4cSMark Brown struct snd_soc_dapm_widget *out3; 131afd6d36aSMark Brown bool deemph; 1323176bf2dSZidan Wang int lrclk; 1330e50b51aSZidan Wang int bclk; 1340e50b51aSZidan Wang int sysclk; 1353176bf2dSZidan Wang int clk_id; 1363176bf2dSZidan Wang int freq_in; 1373176bf2dSZidan Wang bool is_stream_in_use[2]; 138e2280c90SZidan Wang struct wm8960_data pdata; 139f2644a2cSMark Brown }; 140f2644a2cSMark Brown 1413ad5e861SZidan Wang #define wm8960_reset(c) regmap_write(c, WM8960_RESET, 0) 142f2644a2cSMark Brown 143f2644a2cSMark Brown /* enumerated controls */ 144f2644a2cSMark Brown static const char *wm8960_polarity[] = {"No Inversion", "Left Inverted", 145f2644a2cSMark Brown "Right Inverted", "Stereo Inversion"}; 146f2644a2cSMark Brown static const char *wm8960_3d_upper_cutoff[] = {"High", "Low"}; 147f2644a2cSMark Brown static const char *wm8960_3d_lower_cutoff[] = {"Low", "High"}; 148f2644a2cSMark Brown static const char *wm8960_alcfunc[] = {"Off", "Right", "Left", "Stereo"}; 149f2644a2cSMark Brown static const char *wm8960_alcmode[] = {"ALC", "Limiter"}; 1504a5893cfSZidan Wang static const char *wm8960_adc_data_output_sel[] = { 1514a5893cfSZidan Wang "Left Data = Left ADC; Right Data = Right ADC", 1524a5893cfSZidan Wang "Left Data = Left ADC; Right Data = Left ADC", 1534a5893cfSZidan Wang "Left Data = Right ADC; Right Data = Right ADC", 1544a5893cfSZidan Wang "Left Data = Right ADC; Right Data = Left ADC", 1554a5893cfSZidan Wang }; 156defbf708SZidan Wang static const char *wm8960_dmonomix[] = {"Stereo", "Mono"}; 157f2644a2cSMark Brown 158f2644a2cSMark Brown static const struct soc_enum wm8960_enum[] = { 159f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_DACCTL1, 5, 4, wm8960_polarity), 160f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_DACCTL2, 5, 4, wm8960_polarity), 161f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_3D, 6, 2, wm8960_3d_upper_cutoff), 162f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_3D, 5, 2, wm8960_3d_lower_cutoff), 163f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_ALC1, 7, 4, wm8960_alcfunc), 164f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_ALC3, 8, 2, wm8960_alcmode), 1654a5893cfSZidan Wang SOC_ENUM_SINGLE(WM8960_ADDCTL1, 2, 4, wm8960_adc_data_output_sel), 166defbf708SZidan Wang SOC_ENUM_SINGLE(WM8960_ADDCTL1, 4, 2, wm8960_dmonomix), 167f2644a2cSMark Brown }; 168f2644a2cSMark Brown 169afd6d36aSMark Brown static const int deemph_settings[] = { 0, 32000, 44100, 48000 }; 170afd6d36aSMark Brown 171e075fc17SKuninori Morimoto static int wm8960_set_deemph(struct snd_soc_component *component) 172afd6d36aSMark Brown { 173e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 174afd6d36aSMark Brown int val, i, best; 175afd6d36aSMark Brown 176afd6d36aSMark Brown /* If we're using deemphasis select the nearest available sample 177afd6d36aSMark Brown * rate. 178afd6d36aSMark Brown */ 179afd6d36aSMark Brown if (wm8960->deemph) { 180afd6d36aSMark Brown best = 1; 181afd6d36aSMark Brown for (i = 2; i < ARRAY_SIZE(deemph_settings); i++) { 1823176bf2dSZidan Wang if (abs(deemph_settings[i] - wm8960->lrclk) < 1833176bf2dSZidan Wang abs(deemph_settings[best] - wm8960->lrclk)) 184afd6d36aSMark Brown best = i; 185afd6d36aSMark Brown } 186afd6d36aSMark Brown 187afd6d36aSMark Brown val = best << 1; 188afd6d36aSMark Brown } else { 189afd6d36aSMark Brown val = 0; 190afd6d36aSMark Brown } 191afd6d36aSMark Brown 192e075fc17SKuninori Morimoto dev_dbg(component->dev, "Set deemphasis %d\n", val); 193afd6d36aSMark Brown 194e075fc17SKuninori Morimoto return snd_soc_component_update_bits(component, WM8960_DACCTL1, 195afd6d36aSMark Brown 0x6, val); 196afd6d36aSMark Brown } 197afd6d36aSMark Brown 198afd6d36aSMark Brown static int wm8960_get_deemph(struct snd_kcontrol *kcontrol, 199afd6d36aSMark Brown struct snd_ctl_elem_value *ucontrol) 200afd6d36aSMark Brown { 201e075fc17SKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 202e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 203afd6d36aSMark Brown 204b4a18c8bSTakashi Iwai ucontrol->value.integer.value[0] = wm8960->deemph; 2053f343f85SDmitry Artamonow return 0; 206afd6d36aSMark Brown } 207afd6d36aSMark Brown 208afd6d36aSMark Brown static int wm8960_put_deemph(struct snd_kcontrol *kcontrol, 209afd6d36aSMark Brown struct snd_ctl_elem_value *ucontrol) 210afd6d36aSMark Brown { 211e075fc17SKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 212e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 213c1fe81f2SDan Carpenter unsigned int deemph = ucontrol->value.integer.value[0]; 214afd6d36aSMark Brown 215afd6d36aSMark Brown if (deemph > 1) 216afd6d36aSMark Brown return -EINVAL; 217afd6d36aSMark Brown 218afd6d36aSMark Brown wm8960->deemph = deemph; 219afd6d36aSMark Brown 220e075fc17SKuninori Morimoto return wm8960_set_deemph(component); 221afd6d36aSMark Brown } 222afd6d36aSMark Brown 2233758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1); 2247e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(inpga_tlv, -1725, 75, 0); 2253758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1); 226f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(bypass_tlv, -2100, 300, 0); 227f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1); 2287e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(lineinboost_tlv, -1500, 300, 1); 229b269cebfSTakashi Sakamoto static const SNDRV_CTL_TLVD_DECLARE_DB_RANGE(micboost_tlv, 2307e90f9b2SZidan Wang 0, 1, TLV_DB_SCALE_ITEM(0, 1300, 0), 2317e90f9b2SZidan Wang 2, 3, TLV_DB_SCALE_ITEM(2000, 900, 0), 232b269cebfSTakashi Sakamoto ); 233f2644a2cSMark Brown 234f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_snd_controls[] = { 235f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL, WM8960_RINVOL, 2367e90f9b2SZidan Wang 0, 63, 0, inpga_tlv), 237f2644a2cSMark Brown SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL, WM8960_RINVOL, 238f2644a2cSMark Brown 6, 1, 0), 239f2644a2cSMark Brown SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL, WM8960_RINVOL, 24041a59caeSJongHo Kim 7, 1, 1), 241f2644a2cSMark Brown 24221eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT3 Volume", 24395826a37SStuart Henderson WM8960_INBMIX1, 4, 7, 0, lineinboost_tlv), 24421eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT2 Volume", 24595826a37SStuart Henderson WM8960_INBMIX1, 1, 7, 0, lineinboost_tlv), 24695826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT3 Volume", 24795826a37SStuart Henderson WM8960_INBMIX2, 4, 7, 0, lineinboost_tlv), 24895826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT2 Volume", 2497e90f9b2SZidan Wang WM8960_INBMIX2, 1, 7, 0, lineinboost_tlv), 2507e90f9b2SZidan Wang SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT1 Volume", 2518524bb0cSZidan Wang WM8960_RINPATH, 4, 3, 0, micboost_tlv), 2527e90f9b2SZidan Wang SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT1 Volume", 2538524bb0cSZidan Wang WM8960_LINPATH, 4, 3, 0, micboost_tlv), 25421eb2693SMark Brown 255f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC, WM8960_RDAC, 256f2644a2cSMark Brown 0, 255, 0, dac_tlv), 257f2644a2cSMark Brown 258f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1, WM8960_ROUT1, 259f2644a2cSMark Brown 0, 127, 0, out_tlv), 260f2644a2cSMark Brown SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1, WM8960_ROUT1, 261f2644a2cSMark Brown 7, 1, 0), 262f2644a2cSMark Brown 263f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2, WM8960_ROUT2, 264f2644a2cSMark Brown 0, 127, 0, out_tlv), 265f2644a2cSMark Brown SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2, WM8960_ROUT2, 266f2644a2cSMark Brown 7, 1, 0), 267f2644a2cSMark Brown SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3, 3, 5, 0), 268f2644a2cSMark Brown SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3, 0, 5, 0), 269f2644a2cSMark Brown 270f2644a2cSMark Brown SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1, 7, 1, 0), 2714faaa8d9SMark Brown SOC_ENUM("ADC Polarity", wm8960_enum[0]), 272f2644a2cSMark Brown SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1, 0, 1, 0), 273f2644a2cSMark Brown 274a077e81eSZidan Wang SOC_ENUM("DAC Polarity", wm8960_enum[1]), 275afd6d36aSMark Brown SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, 276afd6d36aSMark Brown wm8960_get_deemph, wm8960_put_deemph), 277f2644a2cSMark Brown 2784faaa8d9SMark Brown SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum[2]), 2794faaa8d9SMark Brown SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum[3]), 280f2644a2cSMark Brown SOC_SINGLE("3D Volume", WM8960_3D, 1, 15, 0), 281f2644a2cSMark Brown SOC_SINGLE("3D Switch", WM8960_3D, 0, 1, 0), 282f2644a2cSMark Brown 2834faaa8d9SMark Brown SOC_ENUM("ALC Function", wm8960_enum[4]), 284f2644a2cSMark Brown SOC_SINGLE("ALC Max Gain", WM8960_ALC1, 4, 7, 0), 285f2644a2cSMark Brown SOC_SINGLE("ALC Target", WM8960_ALC1, 0, 15, 1), 286f2644a2cSMark Brown SOC_SINGLE("ALC Min Gain", WM8960_ALC2, 4, 7, 0), 287f2644a2cSMark Brown SOC_SINGLE("ALC Hold Time", WM8960_ALC2, 0, 15, 0), 2884faaa8d9SMark Brown SOC_ENUM("ALC Mode", wm8960_enum[5]), 289f2644a2cSMark Brown SOC_SINGLE("ALC Decay", WM8960_ALC3, 4, 15, 0), 290f2644a2cSMark Brown SOC_SINGLE("ALC Attack", WM8960_ALC3, 0, 15, 0), 291f2644a2cSMark Brown 292f2644a2cSMark Brown SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG, 3, 31, 0), 293f2644a2cSMark Brown SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG, 0, 1, 0), 294f2644a2cSMark Brown 295c324aac0SMa Haijun SOC_DOUBLE_R_TLV("ADC PCM Capture Volume", WM8960_LADC, WM8960_RADC, 296c324aac0SMa Haijun 0, 255, 0, adc_tlv), 297f2644a2cSMark Brown 298f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume", 299f2644a2cSMark Brown WM8960_BYPASS1, 4, 7, 1, bypass_tlv), 300f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume", 301f2644a2cSMark Brown WM8960_LOUTMIX, 4, 7, 1, bypass_tlv), 302f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume", 303f2644a2cSMark Brown WM8960_BYPASS2, 4, 7, 1, bypass_tlv), 304f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume", 305f2644a2cSMark Brown WM8960_ROUTMIX, 4, 7, 1, bypass_tlv), 3064a5893cfSZidan Wang 3074a5893cfSZidan Wang SOC_ENUM("ADC Data Output Select", wm8960_enum[6]), 308defbf708SZidan Wang SOC_ENUM("DAC Mono Mix", wm8960_enum[7]), 309f2644a2cSMark Brown }; 310f2644a2cSMark Brown 311f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin_boost[] = { 312f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH, 6, 1, 0), 313f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH, 7, 1, 0), 314f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH, 8, 1, 0), 315f2644a2cSMark Brown }; 316f2644a2cSMark Brown 317f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin[] = { 318f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH, 3, 1, 0), 319f2644a2cSMark Brown }; 320f2644a2cSMark Brown 321f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin_boost[] = { 322f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH, 6, 1, 0), 323f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH, 7, 1, 0), 324f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH, 8, 1, 0), 325f2644a2cSMark Brown }; 326f2644a2cSMark Brown 327f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin[] = { 328f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH, 3, 1, 0), 329f2644a2cSMark Brown }; 330f2644a2cSMark Brown 331f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_loutput_mixer[] = { 332f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX, 8, 1, 0), 333f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX, 7, 1, 0), 334f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1, 7, 1, 0), 335f2644a2cSMark Brown }; 336f2644a2cSMark Brown 337f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_routput_mixer[] = { 338f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX, 8, 1, 0), 339f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX, 7, 1, 0), 340f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2, 7, 1, 0), 341f2644a2cSMark Brown }; 342f2644a2cSMark Brown 343f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_mono_out[] = { 344f2644a2cSMark Brown SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1, 7, 1, 0), 345f2644a2cSMark Brown SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2, 7, 1, 0), 346f2644a2cSMark Brown }; 347f2644a2cSMark Brown 348f2644a2cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets[] = { 349f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT1"), 350f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT1"), 351f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT2"), 352f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT2"), 353f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT3"), 354f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT3"), 355f2644a2cSMark Brown 356187774cbSMark Brown SND_SOC_DAPM_SUPPLY("MICB", WM8960_POWER1, 1, 0, NULL, 0), 357f2644a2cSMark Brown 358f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1, 5, 0, 359f2644a2cSMark Brown wm8960_lin_boost, ARRAY_SIZE(wm8960_lin_boost)), 360f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1, 4, 0, 361f2644a2cSMark Brown wm8960_rin_boost, ARRAY_SIZE(wm8960_rin_boost)), 362f2644a2cSMark Brown 363f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3, 5, 0, 364f2644a2cSMark Brown wm8960_lin, ARRAY_SIZE(wm8960_lin)), 365f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3, 4, 0, 366f2644a2cSMark Brown wm8960_rin, ARRAY_SIZE(wm8960_rin)), 367f2644a2cSMark Brown 36844426de4SMark Brown SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER1, 3, 0), 36944426de4SMark Brown SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER1, 2, 0), 370f2644a2cSMark Brown 371f2644a2cSMark Brown SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2, 8, 0), 372f2644a2cSMark Brown SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2, 7, 0), 373f2644a2cSMark Brown 374f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3, 3, 0, 375f2644a2cSMark Brown &wm8960_loutput_mixer[0], 376f2644a2cSMark Brown ARRAY_SIZE(wm8960_loutput_mixer)), 377f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3, 2, 0, 378f2644a2cSMark Brown &wm8960_routput_mixer[0], 379f2644a2cSMark Brown ARRAY_SIZE(wm8960_routput_mixer)), 380f2644a2cSMark Brown 381f2644a2cSMark Brown SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2, 6, 0, NULL, 0), 382f2644a2cSMark Brown SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2, 5, 0, NULL, 0), 383f2644a2cSMark Brown 384f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2, 4, 0, NULL, 0), 385f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2, 3, 0, NULL, 0), 386f2644a2cSMark Brown 387f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1, 7, 0, NULL, 0), 388f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1, 6, 0, NULL, 0), 389f2644a2cSMark Brown 390f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LP"), 391f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LN"), 392f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_L"), 393f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_R"), 394f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RP"), 395f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RN"), 396f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("OUT3"), 397f2644a2cSMark Brown }; 398f2644a2cSMark Brown 399913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3[] = { 400913d7b4cSMark Brown SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2, 1, 0, 401913d7b4cSMark Brown &wm8960_mono_out[0], 402913d7b4cSMark Brown ARRAY_SIZE(wm8960_mono_out)), 403913d7b4cSMark Brown }; 404913d7b4cSMark Brown 405913d7b4cSMark Brown /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */ 406913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless[] = { 407913d7b4cSMark Brown SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2, 1, 0, NULL, 0), 408913d7b4cSMark Brown }; 409913d7b4cSMark Brown 410f2644a2cSMark Brown static const struct snd_soc_dapm_route audio_paths[] = { 411f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" }, 412f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" }, 413f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" }, 414f2644a2cSMark Brown 4152d4a3260SZidan Wang { "Left Input Mixer", "Boost Switch", "Left Boost Mixer" }, 4162d4a3260SZidan Wang { "Left Input Mixer", "Boost Switch", "LINPUT1" }, /* Really Boost Switch */ 417f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT2" }, 418f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT3" }, 419f2644a2cSMark Brown 420f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" }, 421f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" }, 422f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" }, 423f2644a2cSMark Brown 4242d4a3260SZidan Wang { "Right Input Mixer", "Boost Switch", "Right Boost Mixer" }, 4252d4a3260SZidan Wang { "Right Input Mixer", "Boost Switch", "RINPUT1" }, /* Really Boost Switch */ 426f2644a2cSMark Brown { "Right Input Mixer", NULL, "RINPUT2" }, 42785e36a1fSZidan Wang { "Right Input Mixer", NULL, "RINPUT3" }, 428f2644a2cSMark Brown 429f2644a2cSMark Brown { "Left ADC", NULL, "Left Input Mixer" }, 430f2644a2cSMark Brown { "Right ADC", NULL, "Right Input Mixer" }, 431f2644a2cSMark Brown 432f2644a2cSMark Brown { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" }, 433f2644a2cSMark Brown { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer" }, 434f2644a2cSMark Brown { "Left Output Mixer", "PCM Playback Switch", "Left DAC" }, 435f2644a2cSMark Brown 436f2644a2cSMark Brown { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" }, 437f2644a2cSMark Brown { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" }, 438f2644a2cSMark Brown { "Right Output Mixer", "PCM Playback Switch", "Right DAC" }, 439f2644a2cSMark Brown 440f2644a2cSMark Brown { "LOUT1 PGA", NULL, "Left Output Mixer" }, 441f2644a2cSMark Brown { "ROUT1 PGA", NULL, "Right Output Mixer" }, 442f2644a2cSMark Brown 443f2644a2cSMark Brown { "HP_L", NULL, "LOUT1 PGA" }, 444f2644a2cSMark Brown { "HP_R", NULL, "ROUT1 PGA" }, 445f2644a2cSMark Brown 446f2644a2cSMark Brown { "Left Speaker PGA", NULL, "Left Output Mixer" }, 447f2644a2cSMark Brown { "Right Speaker PGA", NULL, "Right Output Mixer" }, 448f2644a2cSMark Brown 449f2644a2cSMark Brown { "Left Speaker Output", NULL, "Left Speaker PGA" }, 450f2644a2cSMark Brown { "Right Speaker Output", NULL, "Right Speaker PGA" }, 451f2644a2cSMark Brown 452f2644a2cSMark Brown { "SPK_LN", NULL, "Left Speaker Output" }, 453f2644a2cSMark Brown { "SPK_LP", NULL, "Left Speaker Output" }, 454f2644a2cSMark Brown { "SPK_RN", NULL, "Right Speaker Output" }, 455f2644a2cSMark Brown { "SPK_RP", NULL, "Right Speaker Output" }, 456913d7b4cSMark Brown }; 457913d7b4cSMark Brown 458913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_out3[] = { 459913d7b4cSMark Brown { "Mono Output Mixer", "Left Switch", "Left Output Mixer" }, 460913d7b4cSMark Brown { "Mono Output Mixer", "Right Switch", "Right Output Mixer" }, 461f2644a2cSMark Brown 462f2644a2cSMark Brown { "OUT3", NULL, "Mono Output Mixer", } 463f2644a2cSMark Brown }; 464f2644a2cSMark Brown 465913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_capless[] = { 466913d7b4cSMark Brown { "HP_L", NULL, "OUT3 VMID" }, 467913d7b4cSMark Brown { "HP_R", NULL, "OUT3 VMID" }, 468913d7b4cSMark Brown 469913d7b4cSMark Brown { "OUT3 VMID", NULL, "Left Output Mixer" }, 470913d7b4cSMark Brown { "OUT3 VMID", NULL, "Right Output Mixer" }, 471913d7b4cSMark Brown }; 472913d7b4cSMark Brown 473e075fc17SKuninori Morimoto static int wm8960_add_widgets(struct snd_soc_component *component) 474f2644a2cSMark Brown { 475e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 476e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 477e075fc17SKuninori Morimoto struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component); 478913d7b4cSMark Brown struct snd_soc_dapm_widget *w; 479913d7b4cSMark Brown 480ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets, 481f2644a2cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets)); 482f2644a2cSMark Brown 483ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths, ARRAY_SIZE(audio_paths)); 484f2644a2cSMark Brown 485913d7b4cSMark Brown /* In capless mode OUT3 is used to provide VMID for the 486913d7b4cSMark Brown * headphone outputs, otherwise it is used as a mono mixer. 487913d7b4cSMark Brown */ 488913d7b4cSMark Brown if (pdata && pdata->capless) { 489ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_capless, 490913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_capless)); 491913d7b4cSMark Brown 492ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_capless, 493913d7b4cSMark Brown ARRAY_SIZE(audio_paths_capless)); 494913d7b4cSMark Brown } else { 495ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_out3, 496913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_out3)); 497913d7b4cSMark Brown 498ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_out3, 499913d7b4cSMark Brown ARRAY_SIZE(audio_paths_out3)); 500913d7b4cSMark Brown } 501913d7b4cSMark Brown 502913d7b4cSMark Brown /* We need to power up the headphone output stage out of 503913d7b4cSMark Brown * sequence for capless mode. To save scanning the widget 504913d7b4cSMark Brown * list each time to find the desired power state do so now 505913d7b4cSMark Brown * and save the result. 506913d7b4cSMark Brown */ 507e075fc17SKuninori Morimoto list_for_each_entry(w, &component->card->widgets, list) { 50893f32f53SLars-Peter Clausen if (w->dapm != dapm) 50997c866deSJarkko Nikula continue; 510913d7b4cSMark Brown if (strcmp(w->name, "LOUT1 PGA") == 0) 511913d7b4cSMark Brown wm8960->lout1 = w; 512913d7b4cSMark Brown if (strcmp(w->name, "ROUT1 PGA") == 0) 513913d7b4cSMark Brown wm8960->rout1 = w; 514913d7b4cSMark Brown if (strcmp(w->name, "OUT3 VMID") == 0) 515913d7b4cSMark Brown wm8960->out3 = w; 516913d7b4cSMark Brown } 517913d7b4cSMark Brown 518f2644a2cSMark Brown return 0; 519f2644a2cSMark Brown } 520f2644a2cSMark Brown 521f2644a2cSMark Brown static int wm8960_set_dai_fmt(struct snd_soc_dai *codec_dai, 522f2644a2cSMark Brown unsigned int fmt) 523f2644a2cSMark Brown { 524e075fc17SKuninori Morimoto struct snd_soc_component *component = codec_dai->component; 525f2644a2cSMark Brown u16 iface = 0; 526f2644a2cSMark Brown 527f2644a2cSMark Brown /* set master/slave audio interface */ 528f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 529f2644a2cSMark Brown case SND_SOC_DAIFMT_CBM_CFM: 530f2644a2cSMark Brown iface |= 0x0040; 531f2644a2cSMark Brown break; 532f2644a2cSMark Brown case SND_SOC_DAIFMT_CBS_CFS: 533f2644a2cSMark Brown break; 534f2644a2cSMark Brown default: 535f2644a2cSMark Brown return -EINVAL; 536f2644a2cSMark Brown } 537f2644a2cSMark Brown 538f2644a2cSMark Brown /* interface format */ 539f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 540f2644a2cSMark Brown case SND_SOC_DAIFMT_I2S: 541f2644a2cSMark Brown iface |= 0x0002; 542f2644a2cSMark Brown break; 543f2644a2cSMark Brown case SND_SOC_DAIFMT_RIGHT_J: 544f2644a2cSMark Brown break; 545f2644a2cSMark Brown case SND_SOC_DAIFMT_LEFT_J: 546f2644a2cSMark Brown iface |= 0x0001; 547f2644a2cSMark Brown break; 548f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_A: 549f2644a2cSMark Brown iface |= 0x0003; 550f2644a2cSMark Brown break; 551f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_B: 552f2644a2cSMark Brown iface |= 0x0013; 553f2644a2cSMark Brown break; 554f2644a2cSMark Brown default: 555f2644a2cSMark Brown return -EINVAL; 556f2644a2cSMark Brown } 557f2644a2cSMark Brown 558f2644a2cSMark Brown /* clock inversion */ 559f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 560f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_NF: 561f2644a2cSMark Brown break; 562f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_IF: 563f2644a2cSMark Brown iface |= 0x0090; 564f2644a2cSMark Brown break; 565f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_NF: 566f2644a2cSMark Brown iface |= 0x0080; 567f2644a2cSMark Brown break; 568f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_IF: 569f2644a2cSMark Brown iface |= 0x0010; 570f2644a2cSMark Brown break; 571f2644a2cSMark Brown default: 572f2644a2cSMark Brown return -EINVAL; 573f2644a2cSMark Brown } 574f2644a2cSMark Brown 575f2644a2cSMark Brown /* set iface */ 576e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_IFACE1, iface); 577f2644a2cSMark Brown return 0; 578f2644a2cSMark Brown } 579f2644a2cSMark Brown 580db059c0fSMark Brown static struct { 581db059c0fSMark Brown int rate; 582db059c0fSMark Brown unsigned int val; 583db059c0fSMark Brown } alc_rates[] = { 584db059c0fSMark Brown { 48000, 0 }, 585db059c0fSMark Brown { 44100, 0 }, 586db059c0fSMark Brown { 32000, 1 }, 587db059c0fSMark Brown { 22050, 2 }, 588db059c0fSMark Brown { 24000, 2 }, 589db059c0fSMark Brown { 16000, 3 }, 59022ee76daSZidan Wang { 11025, 4 }, 591db059c0fSMark Brown { 12000, 4 }, 592db059c0fSMark Brown { 8000, 5 }, 593db059c0fSMark Brown }; 594db059c0fSMark Brown 5953176bf2dSZidan Wang /* -1 for reserved value */ 5963176bf2dSZidan Wang static const int sysclk_divs[] = { 1, -1, 2, -1 }; 5973176bf2dSZidan Wang 5980e50b51aSZidan Wang /* Multiply 256 for internal 256 div */ 5990e50b51aSZidan Wang static const int dac_divs[] = { 256, 384, 512, 768, 1024, 1408, 1536 }; 6000e50b51aSZidan Wang 6010e50b51aSZidan Wang /* Multiply 10 to eliminate decimials */ 6020e50b51aSZidan Wang static const int bclk_divs[] = { 6030e50b51aSZidan Wang 10, 15, 20, 30, 40, 55, 60, 80, 110, 6040e50b51aSZidan Wang 120, 160, 220, 240, 320, 320, 320 6050e50b51aSZidan Wang }; 6060e50b51aSZidan Wang 6073ddc9721SDaniel Baluta /** 6083ddc9721SDaniel Baluta * wm8960_configure_sysclk - checks if there is a sysclk frequency available 6093ddc9721SDaniel Baluta * The sysclk must be chosen such that: 6103ddc9721SDaniel Baluta * - sysclk = MCLK / sysclk_divs 6113ddc9721SDaniel Baluta * - lrclk = sysclk / dac_divs 6123ddc9721SDaniel Baluta * - 10 * bclk = sysclk / bclk_divs 6133ddc9721SDaniel Baluta * 6143c01b9eeSDaniel Baluta * If we cannot find an exact match for (sysclk, lrclk, bclk) 6153c01b9eeSDaniel Baluta * triplet, we relax the bclk such that bclk is chosen as the 6163c01b9eeSDaniel Baluta * closest available frequency greater than expected bclk. 6173c01b9eeSDaniel Baluta * 6183ddc9721SDaniel Baluta * @wm8960_priv: wm8960 codec private data 6193ddc9721SDaniel Baluta * @mclk: MCLK used to derive sysclk 6203ddc9721SDaniel Baluta * @sysclk_idx: sysclk_divs index for found sysclk 6213ddc9721SDaniel Baluta * @dac_idx: dac_divs index for found lrclk 6223ddc9721SDaniel Baluta * @bclk_idx: bclk_divs index for found bclk 6233ddc9721SDaniel Baluta * 6243ddc9721SDaniel Baluta * Returns: 6253ddc9721SDaniel Baluta * -1, in case no sysclk frequency available found 6263c01b9eeSDaniel Baluta * >=0, in case we could derive bclk and lrclk from sysclk using 6273c01b9eeSDaniel Baluta * (@sysclk_idx, @dac_idx, @bclk_idx) dividers 6283ddc9721SDaniel Baluta */ 6293ddc9721SDaniel Baluta static 6303ddc9721SDaniel Baluta int wm8960_configure_sysclk(struct wm8960_priv *wm8960, int mclk, 6313ddc9721SDaniel Baluta int *sysclk_idx, int *dac_idx, int *bclk_idx) 6323ddc9721SDaniel Baluta { 6333ddc9721SDaniel Baluta int sysclk, bclk, lrclk; 6343ddc9721SDaniel Baluta int i, j, k; 6353c01b9eeSDaniel Baluta int diff, closest = mclk; 6363c01b9eeSDaniel Baluta 6373c01b9eeSDaniel Baluta /* marker for no match */ 6383c01b9eeSDaniel Baluta *bclk_idx = -1; 6393ddc9721SDaniel Baluta 6403ddc9721SDaniel Baluta bclk = wm8960->bclk; 6413ddc9721SDaniel Baluta lrclk = wm8960->lrclk; 6423ddc9721SDaniel Baluta 6433ddc9721SDaniel Baluta /* check if the sysclk frequency is available. */ 6443ddc9721SDaniel Baluta for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 6453ddc9721SDaniel Baluta if (sysclk_divs[i] == -1) 6463ddc9721SDaniel Baluta continue; 6473ddc9721SDaniel Baluta sysclk = mclk / sysclk_divs[i]; 6483ddc9721SDaniel Baluta for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 6493ddc9721SDaniel Baluta if (sysclk != dac_divs[j] * lrclk) 6503ddc9721SDaniel Baluta continue; 6513ddc9721SDaniel Baluta for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) { 6523ddc9721SDaniel Baluta diff = sysclk - bclk * bclk_divs[k] / 10; 6533ddc9721SDaniel Baluta if (diff == 0) { 6543ddc9721SDaniel Baluta *sysclk_idx = i; 6553ddc9721SDaniel Baluta *dac_idx = j; 6563ddc9721SDaniel Baluta *bclk_idx = k; 6573ddc9721SDaniel Baluta break; 6583ddc9721SDaniel Baluta } 6593c01b9eeSDaniel Baluta if (diff > 0 && closest > diff) { 6603c01b9eeSDaniel Baluta *sysclk_idx = i; 6613c01b9eeSDaniel Baluta *dac_idx = j; 6623c01b9eeSDaniel Baluta *bclk_idx = k; 6633c01b9eeSDaniel Baluta closest = diff; 6643c01b9eeSDaniel Baluta } 6653ddc9721SDaniel Baluta } 6663ddc9721SDaniel Baluta if (k != ARRAY_SIZE(bclk_divs)) 6673ddc9721SDaniel Baluta break; 6683ddc9721SDaniel Baluta } 6693ddc9721SDaniel Baluta if (j != ARRAY_SIZE(dac_divs)) 6703ddc9721SDaniel Baluta break; 6713ddc9721SDaniel Baluta } 6723c01b9eeSDaniel Baluta return *bclk_idx; 6733ddc9721SDaniel Baluta } 6743ddc9721SDaniel Baluta 67584fdc00dSDaniel Baluta /** 67684fdc00dSDaniel Baluta * wm8960_configure_pll - checks if there is a PLL out frequency available 67784fdc00dSDaniel Baluta * The PLL out frequency must be chosen such that: 67884fdc00dSDaniel Baluta * - sysclk = lrclk * dac_divs 67984fdc00dSDaniel Baluta * - freq_out = sysclk * sysclk_divs 68084fdc00dSDaniel Baluta * - 10 * sysclk = bclk * bclk_divs 68184fdc00dSDaniel Baluta * 68282bab889SDaniel Baluta * If we cannot find an exact match for (sysclk, lrclk, bclk) 68382bab889SDaniel Baluta * triplet, we relax the bclk such that bclk is chosen as the 68482bab889SDaniel Baluta * closest available frequency greater than expected bclk. 68582bab889SDaniel Baluta * 686e075fc17SKuninori Morimoto * @component: component structure 68784fdc00dSDaniel Baluta * @freq_in: input frequency used to derive freq out via PLL 68884fdc00dSDaniel Baluta * @sysclk_idx: sysclk_divs index for found sysclk 68984fdc00dSDaniel Baluta * @dac_idx: dac_divs index for found lrclk 69084fdc00dSDaniel Baluta * @bclk_idx: bclk_divs index for found bclk 69184fdc00dSDaniel Baluta * 69284fdc00dSDaniel Baluta * Returns: 69366772edaSDaniel Baluta * < 0, in case no PLL frequency out available was found 69484fdc00dSDaniel Baluta * >=0, in case we could derive bclk, lrclk, sysclk from PLL out using 69584fdc00dSDaniel Baluta * (@sysclk_idx, @dac_idx, @bclk_idx) dividers 69684fdc00dSDaniel Baluta */ 69784fdc00dSDaniel Baluta static 698e075fc17SKuninori Morimoto int wm8960_configure_pll(struct snd_soc_component *component, int freq_in, 69984fdc00dSDaniel Baluta int *sysclk_idx, int *dac_idx, int *bclk_idx) 70084fdc00dSDaniel Baluta { 701e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 70284fdc00dSDaniel Baluta int sysclk, bclk, lrclk, freq_out; 70382bab889SDaniel Baluta int diff, closest, best_freq_out; 70484fdc00dSDaniel Baluta int i, j, k; 70584fdc00dSDaniel Baluta 70684fdc00dSDaniel Baluta bclk = wm8960->bclk; 70784fdc00dSDaniel Baluta lrclk = wm8960->lrclk; 70882bab889SDaniel Baluta closest = freq_in; 70984fdc00dSDaniel Baluta 71082bab889SDaniel Baluta best_freq_out = -EINVAL; 71166772edaSDaniel Baluta *sysclk_idx = *dac_idx = *bclk_idx = -1; 71284fdc00dSDaniel Baluta 71384fdc00dSDaniel Baluta for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 71484fdc00dSDaniel Baluta if (sysclk_divs[i] == -1) 71584fdc00dSDaniel Baluta continue; 71684fdc00dSDaniel Baluta for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 71784fdc00dSDaniel Baluta sysclk = lrclk * dac_divs[j]; 71884fdc00dSDaniel Baluta freq_out = sysclk * sysclk_divs[i]; 71984fdc00dSDaniel Baluta 72084fdc00dSDaniel Baluta for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) { 72184fdc00dSDaniel Baluta if (!is_pll_freq_available(freq_in, freq_out)) 72284fdc00dSDaniel Baluta continue; 72384fdc00dSDaniel Baluta 72484fdc00dSDaniel Baluta diff = sysclk - bclk * bclk_divs[k] / 10; 72584fdc00dSDaniel Baluta if (diff == 0) { 72684fdc00dSDaniel Baluta *sysclk_idx = i; 72784fdc00dSDaniel Baluta *dac_idx = j; 72884fdc00dSDaniel Baluta *bclk_idx = k; 72966772edaSDaniel Baluta return freq_out; 73084fdc00dSDaniel Baluta } 73182bab889SDaniel Baluta if (diff > 0 && closest > diff) { 73282bab889SDaniel Baluta *sysclk_idx = i; 73382bab889SDaniel Baluta *dac_idx = j; 73482bab889SDaniel Baluta *bclk_idx = k; 73582bab889SDaniel Baluta closest = diff; 73682bab889SDaniel Baluta best_freq_out = freq_out; 73784fdc00dSDaniel Baluta } 73884fdc00dSDaniel Baluta } 73984fdc00dSDaniel Baluta } 74082bab889SDaniel Baluta } 74182bab889SDaniel Baluta 74282bab889SDaniel Baluta return best_freq_out; 74384fdc00dSDaniel Baluta } 744e075fc17SKuninori Morimoto static int wm8960_configure_clocking(struct snd_soc_component *component) 7450e50b51aSZidan Wang { 746e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 74784fdc00dSDaniel Baluta int freq_out, freq_in; 748e075fc17SKuninori Morimoto u16 iface1 = snd_soc_component_read32(component, WM8960_IFACE1); 7493176bf2dSZidan Wang int i, j, k; 7503ddc9721SDaniel Baluta int ret; 7510e50b51aSZidan Wang 7520e50b51aSZidan Wang if (!(iface1 & (1<<6))) { 753e075fc17SKuninori Morimoto dev_dbg(component->dev, 7540e50b51aSZidan Wang "Codec is slave mode, no need to configure clock\n"); 7553176bf2dSZidan Wang return 0; 7560e50b51aSZidan Wang } 7570e50b51aSZidan Wang 7583176bf2dSZidan Wang if (wm8960->clk_id != WM8960_SYSCLK_MCLK && !wm8960->freq_in) { 759e075fc17SKuninori Morimoto dev_err(component->dev, "No MCLK configured\n"); 7603176bf2dSZidan Wang return -EINVAL; 7610e50b51aSZidan Wang } 7620e50b51aSZidan Wang 7633176bf2dSZidan Wang freq_in = wm8960->freq_in; 7640e50b51aSZidan Wang /* 7653176bf2dSZidan Wang * If it's sysclk auto mode, check if the MCLK can provide sysclk or 7663176bf2dSZidan Wang * not. If MCLK can provide sysclk, using MCLK to provide sysclk 7673176bf2dSZidan Wang * directly. Otherwise, auto select a available pll out frequency 7683176bf2dSZidan Wang * and set PLL. 7690e50b51aSZidan Wang */ 7703176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO) { 7713176bf2dSZidan Wang /* disable the PLL and using MCLK to provide sysclk */ 772e075fc17SKuninori Morimoto wm8960_set_pll(component, 0, 0); 7733176bf2dSZidan Wang freq_out = freq_in; 7743176bf2dSZidan Wang } else if (wm8960->sysclk) { 7753176bf2dSZidan Wang freq_out = wm8960->sysclk; 7763176bf2dSZidan Wang } else { 777e075fc17SKuninori Morimoto dev_err(component->dev, "No SYSCLK configured\n"); 7783176bf2dSZidan Wang return -EINVAL; 7793176bf2dSZidan Wang } 7803176bf2dSZidan Wang 7816bb74514SStuart Henderson if (wm8960->clk_id != WM8960_SYSCLK_PLL) { 7823ddc9721SDaniel Baluta ret = wm8960_configure_sysclk(wm8960, freq_out, &i, &j, &k); 7833c01b9eeSDaniel Baluta if (ret >= 0) { 7843176bf2dSZidan Wang goto configure_clock; 7853176bf2dSZidan Wang } else if (wm8960->clk_id != WM8960_SYSCLK_AUTO) { 786e075fc17SKuninori Morimoto dev_err(component->dev, "failed to configure clock\n"); 7873176bf2dSZidan Wang return -EINVAL; 7883176bf2dSZidan Wang } 7896bb74514SStuart Henderson } 7903176bf2dSZidan Wang 791e075fc17SKuninori Morimoto freq_out = wm8960_configure_pll(component, freq_in, &i, &j, &k); 79266772edaSDaniel Baluta if (freq_out < 0) { 793e075fc17SKuninori Morimoto dev_err(component->dev, "failed to configure clock via PLL\n"); 79466772edaSDaniel Baluta return freq_out; 7953176bf2dSZidan Wang } 796e075fc17SKuninori Morimoto wm8960_set_pll(component, freq_in, freq_out); 7973176bf2dSZidan Wang 7983176bf2dSZidan Wang configure_clock: 7993176bf2dSZidan Wang /* configure sysclk clock */ 800e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 3 << 1, i << 1); 8013176bf2dSZidan Wang 8023176bf2dSZidan Wang /* configure frame clock */ 803e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 0x7 << 3, j << 3); 804e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 0x7 << 6, j << 6); 8050e50b51aSZidan Wang 8060e50b51aSZidan Wang /* configure bit clock */ 807e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK2, 0xf, k); 8083176bf2dSZidan Wang 8093176bf2dSZidan Wang return 0; 8100e50b51aSZidan Wang } 8110e50b51aSZidan Wang 812f2644a2cSMark Brown static int wm8960_hw_params(struct snd_pcm_substream *substream, 813f2644a2cSMark Brown struct snd_pcm_hw_params *params, 814f2644a2cSMark Brown struct snd_soc_dai *dai) 815f2644a2cSMark Brown { 816e075fc17SKuninori Morimoto struct snd_soc_component *component = dai->component; 817e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 818e075fc17SKuninori Morimoto u16 iface = snd_soc_component_read32(component, WM8960_IFACE1) & 0xfff3; 8190e50b51aSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 820db059c0fSMark Brown int i; 821f2644a2cSMark Brown 8220e50b51aSZidan Wang wm8960->bclk = snd_soc_params_to_bclk(params); 8230e50b51aSZidan Wang if (params_channels(params) == 1) 8240e50b51aSZidan Wang wm8960->bclk *= 2; 8250e50b51aSZidan Wang 826f2644a2cSMark Brown /* bit size */ 82739e9cc46SMark Brown switch (params_width(params)) { 82839e9cc46SMark Brown case 16: 829f2644a2cSMark Brown break; 83039e9cc46SMark Brown case 20: 831f2644a2cSMark Brown iface |= 0x0004; 832f2644a2cSMark Brown break; 83339e9cc46SMark Brown case 24: 834f2644a2cSMark Brown iface |= 0x0008; 835f2644a2cSMark Brown break; 8367a8c7867SZidan Wang case 32: 8377a8c7867SZidan Wang /* right justify mode does not support 32 word length */ 8387a8c7867SZidan Wang if ((iface & 0x3) != 0) { 8397a8c7867SZidan Wang iface |= 0x000c; 8407a8c7867SZidan Wang break; 8417a8c7867SZidan Wang } 8424c2474c0STimur Tabi default: 843e075fc17SKuninori Morimoto dev_err(component->dev, "unsupported width %d\n", 84439e9cc46SMark Brown params_width(params)); 8454c2474c0STimur Tabi return -EINVAL; 846f2644a2cSMark Brown } 847f2644a2cSMark Brown 8483176bf2dSZidan Wang wm8960->lrclk = params_rate(params); 849afd6d36aSMark Brown /* Update filters for the new rate */ 8503176bf2dSZidan Wang if (tx) { 851e075fc17SKuninori Morimoto wm8960_set_deemph(component); 852db059c0fSMark Brown } else { 853db059c0fSMark Brown for (i = 0; i < ARRAY_SIZE(alc_rates); i++) 854db059c0fSMark Brown if (alc_rates[i].rate == params_rate(params)) 855e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, 856db059c0fSMark Brown WM8960_ADDCTL3, 0x7, 857db059c0fSMark Brown alc_rates[i].val); 858afd6d36aSMark Brown } 859afd6d36aSMark Brown 860f2644a2cSMark Brown /* set iface */ 861e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_IFACE1, iface); 8620e50b51aSZidan Wang 8633176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = true; 8643176bf2dSZidan Wang 865e075fc17SKuninori Morimoto if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_ON && 8663176bf2dSZidan Wang !wm8960->is_stream_in_use[!tx]) 867e075fc17SKuninori Morimoto return wm8960_configure_clocking(component); 8683176bf2dSZidan Wang 8693176bf2dSZidan Wang return 0; 8703176bf2dSZidan Wang } 8713176bf2dSZidan Wang 8723176bf2dSZidan Wang static int wm8960_hw_free(struct snd_pcm_substream *substream, 8733176bf2dSZidan Wang struct snd_soc_dai *dai) 8743176bf2dSZidan Wang { 875e075fc17SKuninori Morimoto struct snd_soc_component *component = dai->component; 876e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 8773176bf2dSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 8783176bf2dSZidan Wang 8793176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = false; 8800e50b51aSZidan Wang 881f2644a2cSMark Brown return 0; 882f2644a2cSMark Brown } 883f2644a2cSMark Brown 884f2644a2cSMark Brown static int wm8960_mute(struct snd_soc_dai *dai, int mute) 885f2644a2cSMark Brown { 886e075fc17SKuninori Morimoto struct snd_soc_component *component = dai->component; 887f2644a2cSMark Brown 888f2644a2cSMark Brown if (mute) 889e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_DACCTL1, 0x8, 0x8); 890f2644a2cSMark Brown else 891e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_DACCTL1, 0x8, 0); 892f2644a2cSMark Brown return 0; 893f2644a2cSMark Brown } 894f2644a2cSMark Brown 895e075fc17SKuninori Morimoto static int wm8960_set_bias_level_out3(struct snd_soc_component *component, 896f2644a2cSMark Brown enum snd_soc_bias_level level) 897f2644a2cSMark Brown { 898e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 899e075fc17SKuninori Morimoto u16 pm2 = snd_soc_component_read32(component, WM8960_POWER2); 90075aa8868SZidan Wang int ret; 9010ebe36c6SMark Brown 902f2644a2cSMark Brown switch (level) { 903f2644a2cSMark Brown case SND_SOC_BIAS_ON: 904f2644a2cSMark Brown break; 905f2644a2cSMark Brown 906f2644a2cSMark Brown case SND_SOC_BIAS_PREPARE: 907e075fc17SKuninori Morimoto switch (snd_soc_component_get_bias_level(component)) { 90875aa8868SZidan Wang case SND_SOC_BIAS_STANDBY: 90975aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 91075aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 91175aa8868SZidan Wang if (ret) { 912e075fc17SKuninori Morimoto dev_err(component->dev, 91375aa8868SZidan Wang "Failed to enable MCLK: %d\n", 91475aa8868SZidan Wang ret); 91575aa8868SZidan Wang return ret; 91675aa8868SZidan Wang } 91775aa8868SZidan Wang } 91875aa8868SZidan Wang 919e075fc17SKuninori Morimoto ret = wm8960_configure_clocking(component); 9203176bf2dSZidan Wang if (ret) 9213176bf2dSZidan Wang return ret; 9223176bf2dSZidan Wang 923f2644a2cSMark Brown /* Set VMID to 2x50k */ 924e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 0x180, 0x80); 925f2644a2cSMark Brown break; 926f2644a2cSMark Brown 92775aa8868SZidan Wang case SND_SOC_BIAS_ON: 9283176bf2dSZidan Wang /* 9293176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 9303176bf2dSZidan Wang * disable the pll 9313176bf2dSZidan Wang */ 9323176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 933e075fc17SKuninori Morimoto wm8960_set_pll(component, 0, 0); 9343176bf2dSZidan Wang 93575aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 93675aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 93775aa8868SZidan Wang break; 93875aa8868SZidan Wang 93975aa8868SZidan Wang default: 94075aa8868SZidan Wang break; 94175aa8868SZidan Wang } 94275aa8868SZidan Wang 94375aa8868SZidan Wang break; 94475aa8868SZidan Wang 945f2644a2cSMark Brown case SND_SOC_BIAS_STANDBY: 946e075fc17SKuninori Morimoto if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { 9470ebe36c6SMark Brown regcache_sync(wm8960->regmap); 948bc45df2dSAxel Lin 949f2644a2cSMark Brown /* Enable anti-pop features */ 950e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_APOP1, 951f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 952f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 953f2644a2cSMark Brown 954f2644a2cSMark Brown /* Enable & ramp VMID at 2x50k */ 955e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 0x80, 0x80); 956f2644a2cSMark Brown msleep(100); 957f2644a2cSMark Brown 958f2644a2cSMark Brown /* Enable VREF */ 959e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, WM8960_VREF, 96016b24881SAxel Lin WM8960_VREF); 961f2644a2cSMark Brown 962f2644a2cSMark Brown /* Disable anti-pop features */ 963e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_APOP1, WM8960_BUFIOEN); 964f2644a2cSMark Brown } 965f2644a2cSMark Brown 966f2644a2cSMark Brown /* Set VMID to 2x250k */ 967e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 0x180, 0x100); 968f2644a2cSMark Brown break; 969f2644a2cSMark Brown 970f2644a2cSMark Brown case SND_SOC_BIAS_OFF: 971f2644a2cSMark Brown /* Enable anti-pop features */ 972e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_APOP1, 973f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 974f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 975f2644a2cSMark Brown 976f2644a2cSMark Brown /* Disable VMID and VREF, let them discharge */ 977e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_POWER1, 0); 978f2644a2cSMark Brown msleep(600); 979913d7b4cSMark Brown break; 980913d7b4cSMark Brown } 981f2644a2cSMark Brown 982913d7b4cSMark Brown return 0; 983913d7b4cSMark Brown } 984913d7b4cSMark Brown 985e075fc17SKuninori Morimoto static int wm8960_set_bias_level_capless(struct snd_soc_component *component, 986913d7b4cSMark Brown enum snd_soc_bias_level level) 987913d7b4cSMark Brown { 988e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 989e075fc17SKuninori Morimoto u16 pm2 = snd_soc_component_read32(component, WM8960_POWER2); 99075aa8868SZidan Wang int reg, ret; 991913d7b4cSMark Brown 992913d7b4cSMark Brown switch (level) { 993913d7b4cSMark Brown case SND_SOC_BIAS_ON: 994913d7b4cSMark Brown break; 995913d7b4cSMark Brown 996913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 997e075fc17SKuninori Morimoto switch (snd_soc_component_get_bias_level(component)) { 998913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 999913d7b4cSMark Brown /* Enable anti pop mode */ 1000e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_APOP1, 1001913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1002913d7b4cSMark Brown WM8960_BUFDCOPEN, 1003913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1004913d7b4cSMark Brown WM8960_BUFDCOPEN); 1005913d7b4cSMark Brown 1006913d7b4cSMark Brown /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */ 1007913d7b4cSMark Brown reg = 0; 1008913d7b4cSMark Brown if (wm8960->lout1 && wm8960->lout1->power) 1009913d7b4cSMark Brown reg |= WM8960_PWR2_LOUT1; 1010913d7b4cSMark Brown if (wm8960->rout1 && wm8960->rout1->power) 1011913d7b4cSMark Brown reg |= WM8960_PWR2_ROUT1; 1012913d7b4cSMark Brown if (wm8960->out3 && wm8960->out3->power) 1013913d7b4cSMark Brown reg |= WM8960_PWR2_OUT3; 1014e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER2, 1015913d7b4cSMark Brown WM8960_PWR2_LOUT1 | 1016913d7b4cSMark Brown WM8960_PWR2_ROUT1 | 1017913d7b4cSMark Brown WM8960_PWR2_OUT3, reg); 1018913d7b4cSMark Brown 1019913d7b4cSMark Brown /* Enable VMID at 2*50k */ 1020e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 1021913d7b4cSMark Brown WM8960_VMID_MASK, 0x80); 1022913d7b4cSMark Brown 1023913d7b4cSMark Brown /* Ramp */ 1024913d7b4cSMark Brown msleep(100); 1025913d7b4cSMark Brown 1026913d7b4cSMark Brown /* Enable VREF */ 1027e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 1028913d7b4cSMark Brown WM8960_VREF, WM8960_VREF); 1029913d7b4cSMark Brown 1030913d7b4cSMark Brown msleep(100); 103175aa8868SZidan Wang 103275aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 103375aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 103475aa8868SZidan Wang if (ret) { 1035e075fc17SKuninori Morimoto dev_err(component->dev, 103675aa8868SZidan Wang "Failed to enable MCLK: %d\n", 103775aa8868SZidan Wang ret); 103875aa8868SZidan Wang return ret; 103975aa8868SZidan Wang } 104075aa8868SZidan Wang } 10413176bf2dSZidan Wang 1042e075fc17SKuninori Morimoto ret = wm8960_configure_clocking(component); 10433176bf2dSZidan Wang if (ret) 10443176bf2dSZidan Wang return ret; 10453176bf2dSZidan Wang 1046913d7b4cSMark Brown break; 1047913d7b4cSMark Brown 1048913d7b4cSMark Brown case SND_SOC_BIAS_ON: 10493176bf2dSZidan Wang /* 10503176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 10513176bf2dSZidan Wang * disable the pll 10523176bf2dSZidan Wang */ 10533176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 1054e075fc17SKuninori Morimoto wm8960_set_pll(component, 0, 0); 10553176bf2dSZidan Wang 105675aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 105775aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 105875aa8868SZidan Wang 1059913d7b4cSMark Brown /* Enable anti-pop mode */ 1060e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_APOP1, 1061913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1062913d7b4cSMark Brown WM8960_BUFDCOPEN, 1063913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1064913d7b4cSMark Brown WM8960_BUFDCOPEN); 1065913d7b4cSMark Brown 1066913d7b4cSMark Brown /* Disable VMID and VREF */ 1067e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER1, 1068913d7b4cSMark Brown WM8960_VREF | WM8960_VMID_MASK, 0); 1069913d7b4cSMark Brown break; 1070913d7b4cSMark Brown 1071bc45df2dSAxel Lin case SND_SOC_BIAS_OFF: 10720ebe36c6SMark Brown regcache_sync(wm8960->regmap); 1073bc45df2dSAxel Lin break; 1074913d7b4cSMark Brown default: 1075913d7b4cSMark Brown break; 1076913d7b4cSMark Brown } 1077913d7b4cSMark Brown break; 1078913d7b4cSMark Brown 1079913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 1080e075fc17SKuninori Morimoto switch (snd_soc_component_get_bias_level(component)) { 1081913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 1082913d7b4cSMark Brown /* Disable HP discharge */ 1083e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_APOP2, 1084913d7b4cSMark Brown WM8960_DISOP | WM8960_DRES_MASK, 1085913d7b4cSMark Brown 0); 1086913d7b4cSMark Brown 1087913d7b4cSMark Brown /* Disable anti-pop features */ 1088e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_APOP1, 1089913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1090913d7b4cSMark Brown WM8960_BUFDCOPEN, 1091913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 1092913d7b4cSMark Brown WM8960_BUFDCOPEN); 1093913d7b4cSMark Brown break; 1094913d7b4cSMark Brown 1095913d7b4cSMark Brown default: 1096913d7b4cSMark Brown break; 1097913d7b4cSMark Brown } 1098913d7b4cSMark Brown break; 1099913d7b4cSMark Brown 1100913d7b4cSMark Brown case SND_SOC_BIAS_OFF: 1101f2644a2cSMark Brown break; 1102f2644a2cSMark Brown } 1103f2644a2cSMark Brown 1104f2644a2cSMark Brown return 0; 1105f2644a2cSMark Brown } 1106f2644a2cSMark Brown 1107f2644a2cSMark Brown /* PLL divisors */ 1108f2644a2cSMark Brown struct _pll_div { 1109f2644a2cSMark Brown u32 pre_div:1; 1110f2644a2cSMark Brown u32 n:4; 1111f2644a2cSMark Brown u32 k:24; 1112f2644a2cSMark Brown }; 1113f2644a2cSMark Brown 11143176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target) 11153176bf2dSZidan Wang { 11163176bf2dSZidan Wang unsigned int Ndiv; 11173176bf2dSZidan Wang 11183176bf2dSZidan Wang if (source == 0 || target == 0) 11193176bf2dSZidan Wang return false; 11203176bf2dSZidan Wang 11213176bf2dSZidan Wang /* Scale up target to PLL operating frequency */ 11223176bf2dSZidan Wang target *= 4; 11233176bf2dSZidan Wang Ndiv = target / source; 11243176bf2dSZidan Wang 11253176bf2dSZidan Wang if (Ndiv < 6) { 11263176bf2dSZidan Wang source >>= 1; 11273176bf2dSZidan Wang Ndiv = target / source; 11283176bf2dSZidan Wang } 11293176bf2dSZidan Wang 11303176bf2dSZidan Wang if ((Ndiv < 6) || (Ndiv > 12)) 11313176bf2dSZidan Wang return false; 11323176bf2dSZidan Wang 11333176bf2dSZidan Wang return true; 11343176bf2dSZidan Wang } 11353176bf2dSZidan Wang 1136f2644a2cSMark Brown /* The size in bits of the pll divide multiplied by 10 1137f2644a2cSMark Brown * to allow rounding later */ 1138f2644a2cSMark Brown #define FIXED_PLL_SIZE ((1 << 24) * 10) 1139f2644a2cSMark Brown 1140f2644a2cSMark Brown static int pll_factors(unsigned int source, unsigned int target, 1141f2644a2cSMark Brown struct _pll_div *pll_div) 1142f2644a2cSMark Brown { 1143f2644a2cSMark Brown unsigned long long Kpart; 1144f2644a2cSMark Brown unsigned int K, Ndiv, Nmod; 1145f2644a2cSMark Brown 1146f2644a2cSMark Brown pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source, target); 1147f2644a2cSMark Brown 1148f2644a2cSMark Brown /* Scale up target to PLL operating frequency */ 1149f2644a2cSMark Brown target *= 4; 1150f2644a2cSMark Brown 1151f2644a2cSMark Brown Ndiv = target / source; 1152f2644a2cSMark Brown if (Ndiv < 6) { 1153f2644a2cSMark Brown source >>= 1; 1154f2644a2cSMark Brown pll_div->pre_div = 1; 1155f2644a2cSMark Brown Ndiv = target / source; 1156f2644a2cSMark Brown } else 1157f2644a2cSMark Brown pll_div->pre_div = 0; 1158f2644a2cSMark Brown 1159f2644a2cSMark Brown if ((Ndiv < 6) || (Ndiv > 12)) { 1160f2644a2cSMark Brown pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv); 1161f2644a2cSMark Brown return -EINVAL; 1162f2644a2cSMark Brown } 1163f2644a2cSMark Brown 1164f2644a2cSMark Brown pll_div->n = Ndiv; 1165f2644a2cSMark Brown Nmod = target % source; 1166f2644a2cSMark Brown Kpart = FIXED_PLL_SIZE * (long long)Nmod; 1167f2644a2cSMark Brown 1168f2644a2cSMark Brown do_div(Kpart, source); 1169f2644a2cSMark Brown 1170f2644a2cSMark Brown K = Kpart & 0xFFFFFFFF; 1171f2644a2cSMark Brown 1172f2644a2cSMark Brown /* Check if we need to round */ 1173f2644a2cSMark Brown if ((K % 10) >= 5) 1174f2644a2cSMark Brown K += 5; 1175f2644a2cSMark Brown 1176f2644a2cSMark Brown /* Move down to proper range now rounding is done */ 1177f2644a2cSMark Brown K /= 10; 1178f2644a2cSMark Brown 1179f2644a2cSMark Brown pll_div->k = K; 1180f2644a2cSMark Brown 1181f2644a2cSMark Brown pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n", 1182f2644a2cSMark Brown pll_div->n, pll_div->k, pll_div->pre_div); 1183f2644a2cSMark Brown 1184f2644a2cSMark Brown return 0; 1185f2644a2cSMark Brown } 1186f2644a2cSMark Brown 1187e075fc17SKuninori Morimoto static int wm8960_set_pll(struct snd_soc_component *component, 11883176bf2dSZidan Wang unsigned int freq_in, unsigned int freq_out) 1189f2644a2cSMark Brown { 1190f2644a2cSMark Brown u16 reg; 1191f2644a2cSMark Brown static struct _pll_div pll_div; 1192f2644a2cSMark Brown int ret; 1193f2644a2cSMark Brown 1194f2644a2cSMark Brown if (freq_in && freq_out) { 1195f2644a2cSMark Brown ret = pll_factors(freq_in, freq_out, &pll_div); 1196f2644a2cSMark Brown if (ret != 0) 1197f2644a2cSMark Brown return ret; 1198f2644a2cSMark Brown } 1199f2644a2cSMark Brown 1200f2644a2cSMark Brown /* Disable the PLL: even if we are changing the frequency the 1201f2644a2cSMark Brown * PLL needs to be disabled while we do so. */ 1202e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 0x1, 0); 1203e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER2, 0x1, 0); 1204f2644a2cSMark Brown 1205f2644a2cSMark Brown if (!freq_in || !freq_out) 1206f2644a2cSMark Brown return 0; 1207f2644a2cSMark Brown 1208e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_PLL1) & ~0x3f; 1209f2644a2cSMark Brown reg |= pll_div.pre_div << 4; 1210f2644a2cSMark Brown reg |= pll_div.n; 1211f2644a2cSMark Brown 1212f2644a2cSMark Brown if (pll_div.k) { 1213f2644a2cSMark Brown reg |= 0x20; 1214f2644a2cSMark Brown 1215e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_PLL2, (pll_div.k >> 16) & 0xff); 1216e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_PLL3, (pll_div.k >> 8) & 0xff); 1217e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_PLL4, pll_div.k & 0xff); 1218f2644a2cSMark Brown } 1219e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_PLL1, reg); 1220f2644a2cSMark Brown 1221f2644a2cSMark Brown /* Turn it on */ 1222e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_POWER2, 0x1, 0x1); 1223f2644a2cSMark Brown msleep(250); 1224e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 0x1, 0x1); 1225f2644a2cSMark Brown 1226f2644a2cSMark Brown return 0; 1227f2644a2cSMark Brown } 1228f2644a2cSMark Brown 12293176bf2dSZidan Wang static int wm8960_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id, 12303176bf2dSZidan Wang int source, unsigned int freq_in, unsigned int freq_out) 12313176bf2dSZidan Wang { 1232e075fc17SKuninori Morimoto struct snd_soc_component *component = codec_dai->component; 1233e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 12343176bf2dSZidan Wang 12353176bf2dSZidan Wang wm8960->freq_in = freq_in; 12363176bf2dSZidan Wang 12373176bf2dSZidan Wang if (pll_id == WM8960_SYSCLK_AUTO) 12383176bf2dSZidan Wang return 0; 12393176bf2dSZidan Wang 1240e075fc17SKuninori Morimoto return wm8960_set_pll(component, freq_in, freq_out); 12413176bf2dSZidan Wang } 12423176bf2dSZidan Wang 1243f2644a2cSMark Brown static int wm8960_set_dai_clkdiv(struct snd_soc_dai *codec_dai, 1244f2644a2cSMark Brown int div_id, int div) 1245f2644a2cSMark Brown { 1246e075fc17SKuninori Morimoto struct snd_soc_component *component = codec_dai->component; 1247f2644a2cSMark Brown u16 reg; 1248f2644a2cSMark Brown 1249f2644a2cSMark Brown switch (div_id) { 1250f2644a2cSMark Brown case WM8960_SYSCLKDIV: 1251e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_CLOCK1) & 0x1f9; 1252e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_CLOCK1, reg | div); 1253f2644a2cSMark Brown break; 1254f2644a2cSMark Brown case WM8960_DACDIV: 1255e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_CLOCK1) & 0x1c7; 1256e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_CLOCK1, reg | div); 1257f2644a2cSMark Brown break; 1258f2644a2cSMark Brown case WM8960_OPCLKDIV: 1259e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_PLL1) & 0x03f; 1260e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_PLL1, reg | div); 1261f2644a2cSMark Brown break; 1262f2644a2cSMark Brown case WM8960_DCLKDIV: 1263e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_CLOCK2) & 0x03f; 1264e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_CLOCK2, reg | div); 1265f2644a2cSMark Brown break; 1266f2644a2cSMark Brown case WM8960_TOCLKSEL: 1267e075fc17SKuninori Morimoto reg = snd_soc_component_read32(component, WM8960_ADDCTL1) & 0x1fd; 1268e075fc17SKuninori Morimoto snd_soc_component_write(component, WM8960_ADDCTL1, reg | div); 1269f2644a2cSMark Brown break; 1270f2644a2cSMark Brown default: 1271f2644a2cSMark Brown return -EINVAL; 1272f2644a2cSMark Brown } 1273f2644a2cSMark Brown 1274f2644a2cSMark Brown return 0; 1275f2644a2cSMark Brown } 1276f2644a2cSMark Brown 1277e075fc17SKuninori Morimoto static int wm8960_set_bias_level(struct snd_soc_component *component, 1278f0fba2adSLiam Girdwood enum snd_soc_bias_level level) 1279f0fba2adSLiam Girdwood { 1280e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 1281f0fba2adSLiam Girdwood 1282e075fc17SKuninori Morimoto return wm8960->set_bias_level(component, level); 1283f0fba2adSLiam Girdwood } 1284f0fba2adSLiam Girdwood 12850e50b51aSZidan Wang static int wm8960_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id, 12860e50b51aSZidan Wang unsigned int freq, int dir) 12870e50b51aSZidan Wang { 1288e075fc17SKuninori Morimoto struct snd_soc_component *component = dai->component; 1289e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 12900e50b51aSZidan Wang 12910e50b51aSZidan Wang switch (clk_id) { 12920e50b51aSZidan Wang case WM8960_SYSCLK_MCLK: 1293e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 12940e50b51aSZidan Wang 0x1, WM8960_SYSCLK_MCLK); 12950e50b51aSZidan Wang break; 12960e50b51aSZidan Wang case WM8960_SYSCLK_PLL: 1297e075fc17SKuninori Morimoto snd_soc_component_update_bits(component, WM8960_CLOCK1, 12980e50b51aSZidan Wang 0x1, WM8960_SYSCLK_PLL); 12990e50b51aSZidan Wang break; 13003176bf2dSZidan Wang case WM8960_SYSCLK_AUTO: 13013176bf2dSZidan Wang break; 13020e50b51aSZidan Wang default: 13030e50b51aSZidan Wang return -EINVAL; 13040e50b51aSZidan Wang } 13050e50b51aSZidan Wang 13060e50b51aSZidan Wang wm8960->sysclk = freq; 13073176bf2dSZidan Wang wm8960->clk_id = clk_id; 13080e50b51aSZidan Wang 13090e50b51aSZidan Wang return 0; 13100e50b51aSZidan Wang } 13110e50b51aSZidan Wang 1312f2644a2cSMark Brown #define WM8960_RATES SNDRV_PCM_RATE_8000_48000 1313f2644a2cSMark Brown 1314f2644a2cSMark Brown #define WM8960_FORMATS \ 1315f2644a2cSMark Brown (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \ 13167a8c7867SZidan Wang SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 1317f2644a2cSMark Brown 131885e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops wm8960_dai_ops = { 1319f2644a2cSMark Brown .hw_params = wm8960_hw_params, 13203176bf2dSZidan Wang .hw_free = wm8960_hw_free, 1321f2644a2cSMark Brown .digital_mute = wm8960_mute, 1322f2644a2cSMark Brown .set_fmt = wm8960_set_dai_fmt, 1323f2644a2cSMark Brown .set_clkdiv = wm8960_set_dai_clkdiv, 1324f2644a2cSMark Brown .set_pll = wm8960_set_dai_pll, 13250e50b51aSZidan Wang .set_sysclk = wm8960_set_dai_sysclk, 1326f2644a2cSMark Brown }; 1327f2644a2cSMark Brown 1328f0fba2adSLiam Girdwood static struct snd_soc_dai_driver wm8960_dai = { 1329f0fba2adSLiam Girdwood .name = "wm8960-hifi", 1330f2644a2cSMark Brown .playback = { 1331f2644a2cSMark Brown .stream_name = "Playback", 1332f2644a2cSMark Brown .channels_min = 1, 1333f2644a2cSMark Brown .channels_max = 2, 1334f2644a2cSMark Brown .rates = WM8960_RATES, 1335f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1336f2644a2cSMark Brown .capture = { 1337f2644a2cSMark Brown .stream_name = "Capture", 1338f2644a2cSMark Brown .channels_min = 1, 1339f2644a2cSMark Brown .channels_max = 2, 1340f2644a2cSMark Brown .rates = WM8960_RATES, 1341f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1342f2644a2cSMark Brown .ops = &wm8960_dai_ops, 1343f2644a2cSMark Brown .symmetric_rates = 1, 1344f2644a2cSMark Brown }; 1345f2644a2cSMark Brown 1346e075fc17SKuninori Morimoto static int wm8960_probe(struct snd_soc_component *component) 1347f2644a2cSMark Brown { 1348e075fc17SKuninori Morimoto struct wm8960_priv *wm8960 = snd_soc_component_get_drvdata(component); 1349e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 1350f2644a2cSMark Brown 1351913d7b4cSMark Brown if (pdata->capless) 1352f0fba2adSLiam Girdwood wm8960->set_bias_level = wm8960_set_bias_level_capless; 1353e2280c90SZidan Wang else 1354e2280c90SZidan Wang wm8960->set_bias_level = wm8960_set_bias_level_out3; 1355f2644a2cSMark Brown 1356e075fc17SKuninori Morimoto snd_soc_add_component_controls(component, wm8960_snd_controls, 1357f0fba2adSLiam Girdwood ARRAY_SIZE(wm8960_snd_controls)); 1358e075fc17SKuninori Morimoto wm8960_add_widgets(component); 1359f2644a2cSMark Brown 1360f2644a2cSMark Brown return 0; 1361f2644a2cSMark Brown } 1362f2644a2cSMark Brown 1363e075fc17SKuninori Morimoto static const struct snd_soc_component_driver soc_component_dev_wm8960 = { 1364f0fba2adSLiam Girdwood .probe = wm8960_probe, 1365f0fba2adSLiam Girdwood .set_bias_level = wm8960_set_bias_level, 1366e075fc17SKuninori Morimoto .suspend_bias_off = 1, 1367e075fc17SKuninori Morimoto .idle_bias_on = 1, 1368e075fc17SKuninori Morimoto .use_pmdown_time = 1, 1369e075fc17SKuninori Morimoto .endianness = 1, 1370e075fc17SKuninori Morimoto .non_legacy_dai_naming = 1, 13710ebe36c6SMark Brown }; 13720ebe36c6SMark Brown 13730ebe36c6SMark Brown static const struct regmap_config wm8960_regmap = { 13740ebe36c6SMark Brown .reg_bits = 7, 13750ebe36c6SMark Brown .val_bits = 9, 13760ebe36c6SMark Brown .max_register = WM8960_PLL4, 13770ebe36c6SMark Brown 13780ebe36c6SMark Brown .reg_defaults = wm8960_reg_defaults, 13790ebe36c6SMark Brown .num_reg_defaults = ARRAY_SIZE(wm8960_reg_defaults), 13800ebe36c6SMark Brown .cache_type = REGCACHE_RBTREE, 13810ebe36c6SMark Brown 13820ebe36c6SMark Brown .volatile_reg = wm8960_volatile, 1383f0fba2adSLiam Girdwood }; 1384f0fba2adSLiam Girdwood 1385e2280c90SZidan Wang static void wm8960_set_pdata_from_of(struct i2c_client *i2c, 1386e2280c90SZidan Wang struct wm8960_data *pdata) 1387e2280c90SZidan Wang { 1388e2280c90SZidan Wang const struct device_node *np = i2c->dev.of_node; 1389e2280c90SZidan Wang 1390e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,capless")) 1391e2280c90SZidan Wang pdata->capless = true; 1392e2280c90SZidan Wang 1393e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,shared-lrclk")) 1394e2280c90SZidan Wang pdata->shared_lrclk = true; 1395e2280c90SZidan Wang } 1396e2280c90SZidan Wang 13977a79e94eSBill Pemberton static int wm8960_i2c_probe(struct i2c_client *i2c, 1398f2644a2cSMark Brown const struct i2c_device_id *id) 1399f2644a2cSMark Brown { 140037061631SMark Brown struct wm8960_data *pdata = dev_get_platdata(&i2c->dev); 1401f2644a2cSMark Brown struct wm8960_priv *wm8960; 1402f0fba2adSLiam Girdwood int ret; 1403f2644a2cSMark Brown 1404b9791c01SMark Brown wm8960 = devm_kzalloc(&i2c->dev, sizeof(struct wm8960_priv), 1405b9791c01SMark Brown GFP_KERNEL); 1406f2644a2cSMark Brown if (wm8960 == NULL) 1407f2644a2cSMark Brown return -ENOMEM; 1408f2644a2cSMark Brown 140975aa8868SZidan Wang wm8960->mclk = devm_clk_get(&i2c->dev, "mclk"); 141075aa8868SZidan Wang if (IS_ERR(wm8960->mclk)) { 141175aa8868SZidan Wang if (PTR_ERR(wm8960->mclk) == -EPROBE_DEFER) 141275aa8868SZidan Wang return -EPROBE_DEFER; 141375aa8868SZidan Wang } 141475aa8868SZidan Wang 1415c5e6f5faSSachin Kamat wm8960->regmap = devm_regmap_init_i2c(i2c, &wm8960_regmap); 14160ebe36c6SMark Brown if (IS_ERR(wm8960->regmap)) 14170ebe36c6SMark Brown return PTR_ERR(wm8960->regmap); 14180ebe36c6SMark Brown 1419e2280c90SZidan Wang if (pdata) 1420e2280c90SZidan Wang memcpy(&wm8960->pdata, pdata, sizeof(struct wm8960_data)); 1421e2280c90SZidan Wang else if (i2c->dev.of_node) 1422e2280c90SZidan Wang wm8960_set_pdata_from_of(i2c, &wm8960->pdata); 1423e2280c90SZidan Wang 14243ad5e861SZidan Wang ret = wm8960_reset(wm8960->regmap); 14253ad5e861SZidan Wang if (ret != 0) { 14263ad5e861SZidan Wang dev_err(&i2c->dev, "Failed to issue reset\n"); 14273ad5e861SZidan Wang return ret; 14283ad5e861SZidan Wang } 14293ad5e861SZidan Wang 14303ad5e861SZidan Wang if (wm8960->pdata.shared_lrclk) { 143137061631SMark Brown ret = regmap_update_bits(wm8960->regmap, WM8960_ADDCTL2, 143237061631SMark Brown 0x4, 0x4); 143337061631SMark Brown if (ret != 0) { 143437061631SMark Brown dev_err(&i2c->dev, "Failed to enable LRCM: %d\n", 143537061631SMark Brown ret); 143637061631SMark Brown return ret; 143737061631SMark Brown } 143837061631SMark Brown } 143937061631SMark Brown 14403ad5e861SZidan Wang /* Latch the update bits */ 14413ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LINVOL, 0x100, 0x100); 14423ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RINVOL, 0x100, 0x100); 14433ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LADC, 0x100, 0x100); 14443ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RADC, 0x100, 0x100); 14453ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LDAC, 0x100, 0x100); 14463ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RDAC, 0x100, 0x100); 14473ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT1, 0x100, 0x100); 14483ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT1, 0x100, 0x100); 14493ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT2, 0x100, 0x100); 14503ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT2, 0x100, 0x100); 14513ad5e861SZidan Wang 1452f2644a2cSMark Brown i2c_set_clientdata(i2c, wm8960); 1453f2644a2cSMark Brown 1454e075fc17SKuninori Morimoto ret = devm_snd_soc_register_component(&i2c->dev, 1455e075fc17SKuninori Morimoto &soc_component_dev_wm8960, &wm8960_dai, 1); 1456b9791c01SMark Brown 1457f0fba2adSLiam Girdwood return ret; 1458f2644a2cSMark Brown } 1459f2644a2cSMark Brown 14607a79e94eSBill Pemberton static int wm8960_i2c_remove(struct i2c_client *client) 1461f2644a2cSMark Brown { 1462f2644a2cSMark Brown return 0; 1463f2644a2cSMark Brown } 1464f2644a2cSMark Brown 1465f2644a2cSMark Brown static const struct i2c_device_id wm8960_i2c_id[] = { 1466f2644a2cSMark Brown { "wm8960", 0 }, 1467f2644a2cSMark Brown { } 1468f2644a2cSMark Brown }; 1469f2644a2cSMark Brown MODULE_DEVICE_TABLE(i2c, wm8960_i2c_id); 1470f2644a2cSMark Brown 1471e2280c90SZidan Wang static const struct of_device_id wm8960_of_match[] = { 1472e2280c90SZidan Wang { .compatible = "wlf,wm8960", }, 1473e2280c90SZidan Wang { } 1474e2280c90SZidan Wang }; 1475e2280c90SZidan Wang MODULE_DEVICE_TABLE(of, wm8960_of_match); 1476e2280c90SZidan Wang 1477f2644a2cSMark Brown static struct i2c_driver wm8960_i2c_driver = { 1478f2644a2cSMark Brown .driver = { 1479091edccfSMark Brown .name = "wm8960", 1480e2280c90SZidan Wang .of_match_table = wm8960_of_match, 1481f2644a2cSMark Brown }, 1482f2644a2cSMark Brown .probe = wm8960_i2c_probe, 14837a79e94eSBill Pemberton .remove = wm8960_i2c_remove, 1484f2644a2cSMark Brown .id_table = wm8960_i2c_id, 1485f2644a2cSMark Brown }; 1486f2644a2cSMark Brown 14873c010e60SSachin Kamat module_i2c_driver(wm8960_i2c_driver); 1488f2644a2cSMark Brown 1489f2644a2cSMark Brown MODULE_DESCRIPTION("ASoC WM8960 driver"); 1490f2644a2cSMark Brown MODULE_AUTHOR("Liam Girdwood"); 1491f2644a2cSMark Brown MODULE_LICENSE("GPL"); 1492