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); 523176bf2dSZidan Wang static int wm8960_set_pll(struct snd_soc_codec *codec, 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; 126f0fba2adSLiam Girdwood int (*set_bias_level)(struct snd_soc_codec *, 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 171afd6d36aSMark Brown static int wm8960_set_deemph(struct snd_soc_codec *codec) 172afd6d36aSMark Brown { 173afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 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 192afd6d36aSMark Brown dev_dbg(codec->dev, "Set deemphasis %d\n", val); 193afd6d36aSMark Brown 194afd6d36aSMark Brown return snd_soc_update_bits(codec, 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 { 201ea53bf77SLars-Peter Clausen struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); 202afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 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 { 211ea53bf77SLars-Peter Clausen struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); 212afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 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 220afd6d36aSMark Brown return wm8960_set_deemph(codec); 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); 2297e90f9b2SZidan Wang static const unsigned int micboost_tlv[] = { 2307e90f9b2SZidan Wang TLV_DB_RANGE_HEAD(2), 2317e90f9b2SZidan Wang 0, 1, TLV_DB_SCALE_ITEM(0, 1300, 0), 2327e90f9b2SZidan Wang 2, 3, TLV_DB_SCALE_ITEM(2000, 900, 0), 2337e90f9b2SZidan Wang }; 234f2644a2cSMark Brown 235f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_snd_controls[] = { 236f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL, WM8960_RINVOL, 2377e90f9b2SZidan Wang 0, 63, 0, inpga_tlv), 238f2644a2cSMark Brown SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL, WM8960_RINVOL, 239f2644a2cSMark Brown 6, 1, 0), 240f2644a2cSMark Brown SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL, WM8960_RINVOL, 24141a59caeSJongHo Kim 7, 1, 1), 242f2644a2cSMark Brown 24321eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT3 Volume", 24495826a37SStuart Henderson WM8960_INBMIX1, 4, 7, 0, lineinboost_tlv), 24521eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT2 Volume", 24695826a37SStuart Henderson WM8960_INBMIX1, 1, 7, 0, lineinboost_tlv), 24795826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT3 Volume", 24895826a37SStuart Henderson WM8960_INBMIX2, 4, 7, 0, lineinboost_tlv), 24995826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT2 Volume", 2507e90f9b2SZidan Wang WM8960_INBMIX2, 1, 7, 0, lineinboost_tlv), 2517e90f9b2SZidan Wang SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT1 Volume", 2528524bb0cSZidan Wang WM8960_RINPATH, 4, 3, 0, micboost_tlv), 2537e90f9b2SZidan Wang SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT1 Volume", 2548524bb0cSZidan Wang WM8960_LINPATH, 4, 3, 0, micboost_tlv), 25521eb2693SMark Brown 256f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC, WM8960_RDAC, 257f2644a2cSMark Brown 0, 255, 0, dac_tlv), 258f2644a2cSMark Brown 259f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1, WM8960_ROUT1, 260f2644a2cSMark Brown 0, 127, 0, out_tlv), 261f2644a2cSMark Brown SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1, WM8960_ROUT1, 262f2644a2cSMark Brown 7, 1, 0), 263f2644a2cSMark Brown 264f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2, WM8960_ROUT2, 265f2644a2cSMark Brown 0, 127, 0, out_tlv), 266f2644a2cSMark Brown SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2, WM8960_ROUT2, 267f2644a2cSMark Brown 7, 1, 0), 268f2644a2cSMark Brown SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3, 3, 5, 0), 269f2644a2cSMark Brown SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3, 0, 5, 0), 270f2644a2cSMark Brown 271f2644a2cSMark Brown SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1, 7, 1, 0), 2724faaa8d9SMark Brown SOC_ENUM("ADC Polarity", wm8960_enum[0]), 273f2644a2cSMark Brown SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1, 0, 1, 0), 274f2644a2cSMark Brown 275a077e81eSZidan Wang SOC_ENUM("DAC Polarity", wm8960_enum[1]), 276afd6d36aSMark Brown SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, 277afd6d36aSMark Brown wm8960_get_deemph, wm8960_put_deemph), 278f2644a2cSMark Brown 2794faaa8d9SMark Brown SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum[2]), 2804faaa8d9SMark Brown SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum[3]), 281f2644a2cSMark Brown SOC_SINGLE("3D Volume", WM8960_3D, 1, 15, 0), 282f2644a2cSMark Brown SOC_SINGLE("3D Switch", WM8960_3D, 0, 1, 0), 283f2644a2cSMark Brown 2844faaa8d9SMark Brown SOC_ENUM("ALC Function", wm8960_enum[4]), 285f2644a2cSMark Brown SOC_SINGLE("ALC Max Gain", WM8960_ALC1, 4, 7, 0), 286f2644a2cSMark Brown SOC_SINGLE("ALC Target", WM8960_ALC1, 0, 15, 1), 287f2644a2cSMark Brown SOC_SINGLE("ALC Min Gain", WM8960_ALC2, 4, 7, 0), 288f2644a2cSMark Brown SOC_SINGLE("ALC Hold Time", WM8960_ALC2, 0, 15, 0), 2894faaa8d9SMark Brown SOC_ENUM("ALC Mode", wm8960_enum[5]), 290f2644a2cSMark Brown SOC_SINGLE("ALC Decay", WM8960_ALC3, 4, 15, 0), 291f2644a2cSMark Brown SOC_SINGLE("ALC Attack", WM8960_ALC3, 0, 15, 0), 292f2644a2cSMark Brown 293f2644a2cSMark Brown SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG, 3, 31, 0), 294f2644a2cSMark Brown SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG, 0, 1, 0), 295f2644a2cSMark Brown 296c324aac0SMa Haijun SOC_DOUBLE_R_TLV("ADC PCM Capture Volume", WM8960_LADC, WM8960_RADC, 297c324aac0SMa Haijun 0, 255, 0, adc_tlv), 298f2644a2cSMark Brown 299f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume", 300f2644a2cSMark Brown WM8960_BYPASS1, 4, 7, 1, bypass_tlv), 301f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume", 302f2644a2cSMark Brown WM8960_LOUTMIX, 4, 7, 1, bypass_tlv), 303f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume", 304f2644a2cSMark Brown WM8960_BYPASS2, 4, 7, 1, bypass_tlv), 305f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume", 306f2644a2cSMark Brown WM8960_ROUTMIX, 4, 7, 1, bypass_tlv), 3074a5893cfSZidan Wang 3084a5893cfSZidan Wang SOC_ENUM("ADC Data Output Select", wm8960_enum[6]), 309defbf708SZidan Wang SOC_ENUM("DAC Mono Mix", wm8960_enum[7]), 310f2644a2cSMark Brown }; 311f2644a2cSMark Brown 312f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin_boost[] = { 313f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH, 6, 1, 0), 314f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH, 7, 1, 0), 315f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH, 8, 1, 0), 316f2644a2cSMark Brown }; 317f2644a2cSMark Brown 318f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin[] = { 319f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH, 3, 1, 0), 320f2644a2cSMark Brown }; 321f2644a2cSMark Brown 322f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin_boost[] = { 323f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH, 6, 1, 0), 324f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH, 7, 1, 0), 325f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH, 8, 1, 0), 326f2644a2cSMark Brown }; 327f2644a2cSMark Brown 328f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin[] = { 329f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH, 3, 1, 0), 330f2644a2cSMark Brown }; 331f2644a2cSMark Brown 332f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_loutput_mixer[] = { 333f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX, 8, 1, 0), 334f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX, 7, 1, 0), 335f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1, 7, 1, 0), 336f2644a2cSMark Brown }; 337f2644a2cSMark Brown 338f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_routput_mixer[] = { 339f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX, 8, 1, 0), 340f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX, 7, 1, 0), 341f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2, 7, 1, 0), 342f2644a2cSMark Brown }; 343f2644a2cSMark Brown 344f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_mono_out[] = { 345f2644a2cSMark Brown SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1, 7, 1, 0), 346f2644a2cSMark Brown SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2, 7, 1, 0), 347f2644a2cSMark Brown }; 348f2644a2cSMark Brown 349f2644a2cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets[] = { 350f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT1"), 351f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT1"), 352f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT2"), 353f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT2"), 354f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT3"), 355f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT3"), 356f2644a2cSMark Brown 357187774cbSMark Brown SND_SOC_DAPM_SUPPLY("MICB", WM8960_POWER1, 1, 0, NULL, 0), 358f2644a2cSMark Brown 359f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1, 5, 0, 360f2644a2cSMark Brown wm8960_lin_boost, ARRAY_SIZE(wm8960_lin_boost)), 361f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1, 4, 0, 362f2644a2cSMark Brown wm8960_rin_boost, ARRAY_SIZE(wm8960_rin_boost)), 363f2644a2cSMark Brown 364f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3, 5, 0, 365f2644a2cSMark Brown wm8960_lin, ARRAY_SIZE(wm8960_lin)), 366f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3, 4, 0, 367f2644a2cSMark Brown wm8960_rin, ARRAY_SIZE(wm8960_rin)), 368f2644a2cSMark Brown 36944426de4SMark Brown SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER1, 3, 0), 37044426de4SMark Brown SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER1, 2, 0), 371f2644a2cSMark Brown 372f2644a2cSMark Brown SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2, 8, 0), 373f2644a2cSMark Brown SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2, 7, 0), 374f2644a2cSMark Brown 375f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3, 3, 0, 376f2644a2cSMark Brown &wm8960_loutput_mixer[0], 377f2644a2cSMark Brown ARRAY_SIZE(wm8960_loutput_mixer)), 378f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3, 2, 0, 379f2644a2cSMark Brown &wm8960_routput_mixer[0], 380f2644a2cSMark Brown ARRAY_SIZE(wm8960_routput_mixer)), 381f2644a2cSMark Brown 382f2644a2cSMark Brown SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2, 6, 0, NULL, 0), 383f2644a2cSMark Brown SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2, 5, 0, NULL, 0), 384f2644a2cSMark Brown 385f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2, 4, 0, NULL, 0), 386f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2, 3, 0, NULL, 0), 387f2644a2cSMark Brown 388f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1, 7, 0, NULL, 0), 389f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1, 6, 0, NULL, 0), 390f2644a2cSMark Brown 391f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LP"), 392f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LN"), 393f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_L"), 394f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_R"), 395f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RP"), 396f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RN"), 397f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("OUT3"), 398f2644a2cSMark Brown }; 399f2644a2cSMark Brown 400913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3[] = { 401913d7b4cSMark Brown SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2, 1, 0, 402913d7b4cSMark Brown &wm8960_mono_out[0], 403913d7b4cSMark Brown ARRAY_SIZE(wm8960_mono_out)), 404913d7b4cSMark Brown }; 405913d7b4cSMark Brown 406913d7b4cSMark Brown /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */ 407913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless[] = { 408913d7b4cSMark Brown SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2, 1, 0, NULL, 0), 409913d7b4cSMark Brown }; 410913d7b4cSMark Brown 411f2644a2cSMark Brown static const struct snd_soc_dapm_route audio_paths[] = { 412f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" }, 413f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" }, 414f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" }, 415f2644a2cSMark Brown 4162d4a3260SZidan Wang { "Left Input Mixer", "Boost Switch", "Left Boost Mixer" }, 4172d4a3260SZidan Wang { "Left Input Mixer", "Boost Switch", "LINPUT1" }, /* Really Boost Switch */ 418f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT2" }, 419f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT3" }, 420f2644a2cSMark Brown 421f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" }, 422f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" }, 423f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" }, 424f2644a2cSMark Brown 4252d4a3260SZidan Wang { "Right Input Mixer", "Boost Switch", "Right Boost Mixer" }, 4262d4a3260SZidan Wang { "Right Input Mixer", "Boost Switch", "RINPUT1" }, /* Really Boost Switch */ 427f2644a2cSMark Brown { "Right Input Mixer", NULL, "RINPUT2" }, 42885e36a1fSZidan Wang { "Right Input Mixer", NULL, "RINPUT3" }, 429f2644a2cSMark Brown 430f2644a2cSMark Brown { "Left ADC", NULL, "Left Input Mixer" }, 431f2644a2cSMark Brown { "Right ADC", NULL, "Right Input Mixer" }, 432f2644a2cSMark Brown 433f2644a2cSMark Brown { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" }, 434f2644a2cSMark Brown { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer" }, 435f2644a2cSMark Brown { "Left Output Mixer", "PCM Playback Switch", "Left DAC" }, 436f2644a2cSMark Brown 437f2644a2cSMark Brown { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" }, 438f2644a2cSMark Brown { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" }, 439f2644a2cSMark Brown { "Right Output Mixer", "PCM Playback Switch", "Right DAC" }, 440f2644a2cSMark Brown 441f2644a2cSMark Brown { "LOUT1 PGA", NULL, "Left Output Mixer" }, 442f2644a2cSMark Brown { "ROUT1 PGA", NULL, "Right Output Mixer" }, 443f2644a2cSMark Brown 444f2644a2cSMark Brown { "HP_L", NULL, "LOUT1 PGA" }, 445f2644a2cSMark Brown { "HP_R", NULL, "ROUT1 PGA" }, 446f2644a2cSMark Brown 447f2644a2cSMark Brown { "Left Speaker PGA", NULL, "Left Output Mixer" }, 448f2644a2cSMark Brown { "Right Speaker PGA", NULL, "Right Output Mixer" }, 449f2644a2cSMark Brown 450f2644a2cSMark Brown { "Left Speaker Output", NULL, "Left Speaker PGA" }, 451f2644a2cSMark Brown { "Right Speaker Output", NULL, "Right Speaker PGA" }, 452f2644a2cSMark Brown 453f2644a2cSMark Brown { "SPK_LN", NULL, "Left Speaker Output" }, 454f2644a2cSMark Brown { "SPK_LP", NULL, "Left Speaker Output" }, 455f2644a2cSMark Brown { "SPK_RN", NULL, "Right Speaker Output" }, 456f2644a2cSMark Brown { "SPK_RP", NULL, "Right Speaker Output" }, 457913d7b4cSMark Brown }; 458913d7b4cSMark Brown 459913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_out3[] = { 460913d7b4cSMark Brown { "Mono Output Mixer", "Left Switch", "Left Output Mixer" }, 461913d7b4cSMark Brown { "Mono Output Mixer", "Right Switch", "Right Output Mixer" }, 462f2644a2cSMark Brown 463f2644a2cSMark Brown { "OUT3", NULL, "Mono Output Mixer", } 464f2644a2cSMark Brown }; 465f2644a2cSMark Brown 466913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_capless[] = { 467913d7b4cSMark Brown { "HP_L", NULL, "OUT3 VMID" }, 468913d7b4cSMark Brown { "HP_R", NULL, "OUT3 VMID" }, 469913d7b4cSMark Brown 470913d7b4cSMark Brown { "OUT3 VMID", NULL, "Left Output Mixer" }, 471913d7b4cSMark Brown { "OUT3 VMID", NULL, "Right Output Mixer" }, 472913d7b4cSMark Brown }; 473913d7b4cSMark Brown 474f2644a2cSMark Brown static int wm8960_add_widgets(struct snd_soc_codec *codec) 475f2644a2cSMark Brown { 476b2c812e2SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 477e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 47893f32f53SLars-Peter Clausen struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec); 479913d7b4cSMark Brown struct snd_soc_dapm_widget *w; 480913d7b4cSMark Brown 481ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets, 482f2644a2cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets)); 483f2644a2cSMark Brown 484ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths, ARRAY_SIZE(audio_paths)); 485f2644a2cSMark Brown 486913d7b4cSMark Brown /* In capless mode OUT3 is used to provide VMID for the 487913d7b4cSMark Brown * headphone outputs, otherwise it is used as a mono mixer. 488913d7b4cSMark Brown */ 489913d7b4cSMark Brown if (pdata && pdata->capless) { 490ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_capless, 491913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_capless)); 492913d7b4cSMark Brown 493ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_capless, 494913d7b4cSMark Brown ARRAY_SIZE(audio_paths_capless)); 495913d7b4cSMark Brown } else { 496ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_out3, 497913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_out3)); 498913d7b4cSMark Brown 499ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_out3, 500913d7b4cSMark Brown ARRAY_SIZE(audio_paths_out3)); 501913d7b4cSMark Brown } 502913d7b4cSMark Brown 503913d7b4cSMark Brown /* We need to power up the headphone output stage out of 504913d7b4cSMark Brown * sequence for capless mode. To save scanning the widget 505913d7b4cSMark Brown * list each time to find the desired power state do so now 506913d7b4cSMark Brown * and save the result. 507913d7b4cSMark Brown */ 50800200107SLars-Peter Clausen list_for_each_entry(w, &codec->component.card->widgets, list) { 50993f32f53SLars-Peter Clausen if (w->dapm != dapm) 51097c866deSJarkko Nikula continue; 511913d7b4cSMark Brown if (strcmp(w->name, "LOUT1 PGA") == 0) 512913d7b4cSMark Brown wm8960->lout1 = w; 513913d7b4cSMark Brown if (strcmp(w->name, "ROUT1 PGA") == 0) 514913d7b4cSMark Brown wm8960->rout1 = w; 515913d7b4cSMark Brown if (strcmp(w->name, "OUT3 VMID") == 0) 516913d7b4cSMark Brown wm8960->out3 = w; 517913d7b4cSMark Brown } 518913d7b4cSMark Brown 519f2644a2cSMark Brown return 0; 520f2644a2cSMark Brown } 521f2644a2cSMark Brown 522f2644a2cSMark Brown static int wm8960_set_dai_fmt(struct snd_soc_dai *codec_dai, 523f2644a2cSMark Brown unsigned int fmt) 524f2644a2cSMark Brown { 525f2644a2cSMark Brown struct snd_soc_codec *codec = codec_dai->codec; 526f2644a2cSMark Brown u16 iface = 0; 527f2644a2cSMark Brown 528f2644a2cSMark Brown /* set master/slave audio interface */ 529f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 530f2644a2cSMark Brown case SND_SOC_DAIFMT_CBM_CFM: 531f2644a2cSMark Brown iface |= 0x0040; 532f2644a2cSMark Brown break; 533f2644a2cSMark Brown case SND_SOC_DAIFMT_CBS_CFS: 534f2644a2cSMark Brown break; 535f2644a2cSMark Brown default: 536f2644a2cSMark Brown return -EINVAL; 537f2644a2cSMark Brown } 538f2644a2cSMark Brown 539f2644a2cSMark Brown /* interface format */ 540f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 541f2644a2cSMark Brown case SND_SOC_DAIFMT_I2S: 542f2644a2cSMark Brown iface |= 0x0002; 543f2644a2cSMark Brown break; 544f2644a2cSMark Brown case SND_SOC_DAIFMT_RIGHT_J: 545f2644a2cSMark Brown break; 546f2644a2cSMark Brown case SND_SOC_DAIFMT_LEFT_J: 547f2644a2cSMark Brown iface |= 0x0001; 548f2644a2cSMark Brown break; 549f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_A: 550f2644a2cSMark Brown iface |= 0x0003; 551f2644a2cSMark Brown break; 552f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_B: 553f2644a2cSMark Brown iface |= 0x0013; 554f2644a2cSMark Brown break; 555f2644a2cSMark Brown default: 556f2644a2cSMark Brown return -EINVAL; 557f2644a2cSMark Brown } 558f2644a2cSMark Brown 559f2644a2cSMark Brown /* clock inversion */ 560f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 561f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_NF: 562f2644a2cSMark Brown break; 563f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_IF: 564f2644a2cSMark Brown iface |= 0x0090; 565f2644a2cSMark Brown break; 566f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_NF: 567f2644a2cSMark Brown iface |= 0x0080; 568f2644a2cSMark Brown break; 569f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_IF: 570f2644a2cSMark Brown iface |= 0x0010; 571f2644a2cSMark Brown break; 572f2644a2cSMark Brown default: 573f2644a2cSMark Brown return -EINVAL; 574f2644a2cSMark Brown } 575f2644a2cSMark Brown 576f2644a2cSMark Brown /* set iface */ 57717a52fd6SMark Brown snd_soc_write(codec, WM8960_IFACE1, iface); 578f2644a2cSMark Brown return 0; 579f2644a2cSMark Brown } 580f2644a2cSMark Brown 581db059c0fSMark Brown static struct { 582db059c0fSMark Brown int rate; 583db059c0fSMark Brown unsigned int val; 584db059c0fSMark Brown } alc_rates[] = { 585db059c0fSMark Brown { 48000, 0 }, 586db059c0fSMark Brown { 44100, 0 }, 587db059c0fSMark Brown { 32000, 1 }, 588db059c0fSMark Brown { 22050, 2 }, 589db059c0fSMark Brown { 24000, 2 }, 590db059c0fSMark Brown { 16000, 3 }, 59122ee76daSZidan Wang { 11025, 4 }, 592db059c0fSMark Brown { 12000, 4 }, 593db059c0fSMark Brown { 8000, 5 }, 594db059c0fSMark Brown }; 595db059c0fSMark Brown 5963176bf2dSZidan Wang /* -1 for reserved value */ 5973176bf2dSZidan Wang static const int sysclk_divs[] = { 1, -1, 2, -1 }; 5983176bf2dSZidan Wang 5990e50b51aSZidan Wang /* Multiply 256 for internal 256 div */ 6000e50b51aSZidan Wang static const int dac_divs[] = { 256, 384, 512, 768, 1024, 1408, 1536 }; 6010e50b51aSZidan Wang 6020e50b51aSZidan Wang /* Multiply 10 to eliminate decimials */ 6030e50b51aSZidan Wang static const int bclk_divs[] = { 6040e50b51aSZidan Wang 10, 15, 20, 30, 40, 55, 60, 80, 110, 6050e50b51aSZidan Wang 120, 160, 220, 240, 320, 320, 320 6060e50b51aSZidan Wang }; 6070e50b51aSZidan Wang 6083176bf2dSZidan Wang static int wm8960_configure_clocking(struct snd_soc_codec *codec) 6090e50b51aSZidan Wang { 6100e50b51aSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 6113176bf2dSZidan Wang int sysclk, bclk, lrclk, freq_out, freq_in; 6120e50b51aSZidan Wang u16 iface1 = snd_soc_read(codec, WM8960_IFACE1); 6133176bf2dSZidan Wang int i, j, k; 6140e50b51aSZidan Wang 6150e50b51aSZidan Wang if (!(iface1 & (1<<6))) { 6160e50b51aSZidan Wang dev_dbg(codec->dev, 6170e50b51aSZidan Wang "Codec is slave mode, no need to configure clock\n"); 6183176bf2dSZidan Wang return 0; 6190e50b51aSZidan Wang } 6200e50b51aSZidan Wang 6213176bf2dSZidan Wang if (wm8960->clk_id != WM8960_SYSCLK_MCLK && !wm8960->freq_in) { 6223176bf2dSZidan Wang dev_err(codec->dev, "No MCLK configured\n"); 6233176bf2dSZidan Wang return -EINVAL; 6240e50b51aSZidan Wang } 6250e50b51aSZidan Wang 6263176bf2dSZidan Wang freq_in = wm8960->freq_in; 6273176bf2dSZidan Wang bclk = wm8960->bclk; 6283176bf2dSZidan Wang lrclk = wm8960->lrclk; 6290e50b51aSZidan Wang /* 6303176bf2dSZidan Wang * If it's sysclk auto mode, check if the MCLK can provide sysclk or 6313176bf2dSZidan Wang * not. If MCLK can provide sysclk, using MCLK to provide sysclk 6323176bf2dSZidan Wang * directly. Otherwise, auto select a available pll out frequency 6333176bf2dSZidan Wang * and set PLL. 6340e50b51aSZidan Wang */ 6353176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO) { 6363176bf2dSZidan Wang /* disable the PLL and using MCLK to provide sysclk */ 6373176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 6383176bf2dSZidan Wang freq_out = freq_in; 6393176bf2dSZidan Wang } else if (wm8960->sysclk) { 6403176bf2dSZidan Wang freq_out = wm8960->sysclk; 6413176bf2dSZidan Wang } else { 6423176bf2dSZidan Wang dev_err(codec->dev, "No SYSCLK configured\n"); 6433176bf2dSZidan Wang return -EINVAL; 6443176bf2dSZidan Wang } 6453176bf2dSZidan Wang 6466bb74514SStuart Henderson if (wm8960->clk_id != WM8960_SYSCLK_PLL) { 6473176bf2dSZidan Wang /* check if the sysclk frequency is available. */ 6483176bf2dSZidan Wang for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 6493176bf2dSZidan Wang if (sysclk_divs[i] == -1) 6503176bf2dSZidan Wang continue; 6513176bf2dSZidan Wang sysclk = freq_out / sysclk_divs[i]; 6523176bf2dSZidan Wang for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 6536bb74514SStuart Henderson if (sysclk != dac_divs[j] * lrclk) 6546bb74514SStuart Henderson continue; 6553176bf2dSZidan Wang for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) 6563176bf2dSZidan Wang if (sysclk == bclk * bclk_divs[k] / 10) 6573176bf2dSZidan Wang break; 6583176bf2dSZidan Wang if (k != ARRAY_SIZE(bclk_divs)) 6593176bf2dSZidan Wang break; 6603176bf2dSZidan Wang } 6613176bf2dSZidan Wang if (j != ARRAY_SIZE(dac_divs)) 6623176bf2dSZidan Wang break; 6633176bf2dSZidan Wang } 6643176bf2dSZidan Wang 6653176bf2dSZidan Wang if (i != ARRAY_SIZE(sysclk_divs)) { 6663176bf2dSZidan Wang goto configure_clock; 6673176bf2dSZidan Wang } else if (wm8960->clk_id != WM8960_SYSCLK_AUTO) { 6683176bf2dSZidan Wang dev_err(codec->dev, "failed to configure clock\n"); 6693176bf2dSZidan Wang return -EINVAL; 6703176bf2dSZidan Wang } 6716bb74514SStuart Henderson } 6723176bf2dSZidan Wang /* get a available pll out frequency and set pll */ 6733176bf2dSZidan Wang for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 6743176bf2dSZidan Wang if (sysclk_divs[i] == -1) 6753176bf2dSZidan Wang continue; 6763176bf2dSZidan Wang for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 6773176bf2dSZidan Wang sysclk = lrclk * dac_divs[j]; 6783176bf2dSZidan Wang freq_out = sysclk * sysclk_divs[i]; 6793176bf2dSZidan Wang 6803176bf2dSZidan Wang for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) { 6813176bf2dSZidan Wang if (sysclk == bclk * bclk_divs[k] / 10 && 6823176bf2dSZidan Wang is_pll_freq_available(freq_in, freq_out)) { 6833176bf2dSZidan Wang wm8960_set_pll(codec, 6843176bf2dSZidan Wang freq_in, freq_out); 6853176bf2dSZidan Wang break; 6863176bf2dSZidan Wang } else { 6873176bf2dSZidan Wang continue; 6883176bf2dSZidan Wang } 6893176bf2dSZidan Wang } 6903176bf2dSZidan Wang if (k != ARRAY_SIZE(bclk_divs)) 6913176bf2dSZidan Wang break; 6923176bf2dSZidan Wang } 6933176bf2dSZidan Wang if (j != ARRAY_SIZE(dac_divs)) 6943176bf2dSZidan Wang break; 6953176bf2dSZidan Wang } 6963176bf2dSZidan Wang 6973176bf2dSZidan Wang if (i == ARRAY_SIZE(sysclk_divs)) { 6983176bf2dSZidan Wang dev_err(codec->dev, "failed to configure clock\n"); 6993176bf2dSZidan Wang return -EINVAL; 7003176bf2dSZidan Wang } 7013176bf2dSZidan Wang 7023176bf2dSZidan Wang configure_clock: 7033176bf2dSZidan Wang /* configure sysclk clock */ 7043176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 3 << 1, i << 1); 7053176bf2dSZidan Wang 7063176bf2dSZidan Wang /* configure frame clock */ 7073176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 3, j << 3); 7083176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 6, j << 6); 7090e50b51aSZidan Wang 7100e50b51aSZidan Wang /* configure bit clock */ 7113176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK2, 0xf, k); 7123176bf2dSZidan Wang 7133176bf2dSZidan Wang return 0; 7140e50b51aSZidan Wang } 7150e50b51aSZidan Wang 716f2644a2cSMark Brown static int wm8960_hw_params(struct snd_pcm_substream *substream, 717f2644a2cSMark Brown struct snd_pcm_hw_params *params, 718f2644a2cSMark Brown struct snd_soc_dai *dai) 719f2644a2cSMark Brown { 720e6968a17SMark Brown struct snd_soc_codec *codec = dai->codec; 721afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 72217a52fd6SMark Brown u16 iface = snd_soc_read(codec, WM8960_IFACE1) & 0xfff3; 7230e50b51aSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 724db059c0fSMark Brown int i; 725f2644a2cSMark Brown 7260e50b51aSZidan Wang wm8960->bclk = snd_soc_params_to_bclk(params); 7270e50b51aSZidan Wang if (params_channels(params) == 1) 7280e50b51aSZidan Wang wm8960->bclk *= 2; 7290e50b51aSZidan Wang 730f2644a2cSMark Brown /* bit size */ 73139e9cc46SMark Brown switch (params_width(params)) { 73239e9cc46SMark Brown case 16: 733f2644a2cSMark Brown break; 73439e9cc46SMark Brown case 20: 735f2644a2cSMark Brown iface |= 0x0004; 736f2644a2cSMark Brown break; 73739e9cc46SMark Brown case 24: 738f2644a2cSMark Brown iface |= 0x0008; 739f2644a2cSMark Brown break; 7407a8c7867SZidan Wang case 32: 7417a8c7867SZidan Wang /* right justify mode does not support 32 word length */ 7427a8c7867SZidan Wang if ((iface & 0x3) != 0) { 7437a8c7867SZidan Wang iface |= 0x000c; 7447a8c7867SZidan Wang break; 7457a8c7867SZidan Wang } 7464c2474c0STimur Tabi default: 74739e9cc46SMark Brown dev_err(codec->dev, "unsupported width %d\n", 74839e9cc46SMark Brown params_width(params)); 7494c2474c0STimur Tabi return -EINVAL; 750f2644a2cSMark Brown } 751f2644a2cSMark Brown 7523176bf2dSZidan Wang wm8960->lrclk = params_rate(params); 753afd6d36aSMark Brown /* Update filters for the new rate */ 7543176bf2dSZidan Wang if (tx) { 755afd6d36aSMark Brown wm8960_set_deemph(codec); 756db059c0fSMark Brown } else { 757db059c0fSMark Brown for (i = 0; i < ARRAY_SIZE(alc_rates); i++) 758db059c0fSMark Brown if (alc_rates[i].rate == params_rate(params)) 759db059c0fSMark Brown snd_soc_update_bits(codec, 760db059c0fSMark Brown WM8960_ADDCTL3, 0x7, 761db059c0fSMark Brown alc_rates[i].val); 762afd6d36aSMark Brown } 763afd6d36aSMark Brown 764f2644a2cSMark Brown /* set iface */ 76517a52fd6SMark Brown snd_soc_write(codec, WM8960_IFACE1, iface); 7660e50b51aSZidan Wang 7673176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = true; 7683176bf2dSZidan Wang 7693176bf2dSZidan Wang if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_ON && 7703176bf2dSZidan Wang !wm8960->is_stream_in_use[!tx]) 7713176bf2dSZidan Wang return wm8960_configure_clocking(codec); 7723176bf2dSZidan Wang 7733176bf2dSZidan Wang return 0; 7743176bf2dSZidan Wang } 7753176bf2dSZidan Wang 7763176bf2dSZidan Wang static int wm8960_hw_free(struct snd_pcm_substream *substream, 7773176bf2dSZidan Wang struct snd_soc_dai *dai) 7783176bf2dSZidan Wang { 7793176bf2dSZidan Wang struct snd_soc_codec *codec = dai->codec; 7803176bf2dSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 7813176bf2dSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 7823176bf2dSZidan Wang 7833176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = false; 7840e50b51aSZidan Wang 785f2644a2cSMark Brown return 0; 786f2644a2cSMark Brown } 787f2644a2cSMark Brown 788f2644a2cSMark Brown static int wm8960_mute(struct snd_soc_dai *dai, int mute) 789f2644a2cSMark Brown { 790f2644a2cSMark Brown struct snd_soc_codec *codec = dai->codec; 791f2644a2cSMark Brown 792f2644a2cSMark Brown if (mute) 79316b24881SAxel Lin snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0x8); 794f2644a2cSMark Brown else 79516b24881SAxel Lin snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0); 796f2644a2cSMark Brown return 0; 797f2644a2cSMark Brown } 798f2644a2cSMark Brown 799913d7b4cSMark Brown static int wm8960_set_bias_level_out3(struct snd_soc_codec *codec, 800f2644a2cSMark Brown enum snd_soc_bias_level level) 801f2644a2cSMark Brown { 8020ebe36c6SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 8033176bf2dSZidan Wang u16 pm2 = snd_soc_read(codec, WM8960_POWER2); 80475aa8868SZidan Wang int ret; 8050ebe36c6SMark Brown 806f2644a2cSMark Brown switch (level) { 807f2644a2cSMark Brown case SND_SOC_BIAS_ON: 808f2644a2cSMark Brown break; 809f2644a2cSMark Brown 810f2644a2cSMark Brown case SND_SOC_BIAS_PREPARE: 81193f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 81275aa8868SZidan Wang case SND_SOC_BIAS_STANDBY: 81375aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 81475aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 81575aa8868SZidan Wang if (ret) { 81675aa8868SZidan Wang dev_err(codec->dev, 81775aa8868SZidan Wang "Failed to enable MCLK: %d\n", 81875aa8868SZidan Wang ret); 81975aa8868SZidan Wang return ret; 82075aa8868SZidan Wang } 82175aa8868SZidan Wang } 82275aa8868SZidan Wang 8233176bf2dSZidan Wang ret = wm8960_configure_clocking(codec); 8243176bf2dSZidan Wang if (ret) 8253176bf2dSZidan Wang return ret; 8263176bf2dSZidan Wang 827f2644a2cSMark Brown /* Set VMID to 2x50k */ 82816b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x80); 829f2644a2cSMark Brown break; 830f2644a2cSMark Brown 83175aa8868SZidan Wang case SND_SOC_BIAS_ON: 8323176bf2dSZidan Wang /* 8333176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 8343176bf2dSZidan Wang * disable the pll 8353176bf2dSZidan Wang */ 8363176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 8373176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 8383176bf2dSZidan Wang 83975aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 84075aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 84175aa8868SZidan Wang break; 84275aa8868SZidan Wang 84375aa8868SZidan Wang default: 84475aa8868SZidan Wang break; 84575aa8868SZidan Wang } 84675aa8868SZidan Wang 84775aa8868SZidan Wang break; 84875aa8868SZidan Wang 849f2644a2cSMark Brown case SND_SOC_BIAS_STANDBY: 85093f32f53SLars-Peter Clausen if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) { 8510ebe36c6SMark Brown regcache_sync(wm8960->regmap); 852bc45df2dSAxel Lin 853f2644a2cSMark Brown /* Enable anti-pop features */ 85417a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, 855f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 856f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 857f2644a2cSMark Brown 858f2644a2cSMark Brown /* Enable & ramp VMID at 2x50k */ 85916b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x80, 0x80); 860f2644a2cSMark Brown msleep(100); 861f2644a2cSMark Brown 862f2644a2cSMark Brown /* Enable VREF */ 86316b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, WM8960_VREF, 86416b24881SAxel Lin WM8960_VREF); 865f2644a2cSMark Brown 866f2644a2cSMark Brown /* Disable anti-pop features */ 86717a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, WM8960_BUFIOEN); 868f2644a2cSMark Brown } 869f2644a2cSMark Brown 870f2644a2cSMark Brown /* Set VMID to 2x250k */ 87116b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x100); 872f2644a2cSMark Brown break; 873f2644a2cSMark Brown 874f2644a2cSMark Brown case SND_SOC_BIAS_OFF: 875f2644a2cSMark Brown /* Enable anti-pop features */ 87617a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, 877f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 878f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 879f2644a2cSMark Brown 880f2644a2cSMark Brown /* Disable VMID and VREF, let them discharge */ 88117a52fd6SMark Brown snd_soc_write(codec, WM8960_POWER1, 0); 882f2644a2cSMark Brown msleep(600); 883913d7b4cSMark Brown break; 884913d7b4cSMark Brown } 885f2644a2cSMark Brown 886913d7b4cSMark Brown return 0; 887913d7b4cSMark Brown } 888913d7b4cSMark Brown 889913d7b4cSMark Brown static int wm8960_set_bias_level_capless(struct snd_soc_codec *codec, 890913d7b4cSMark Brown enum snd_soc_bias_level level) 891913d7b4cSMark Brown { 892b2c812e2SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 8933176bf2dSZidan Wang u16 pm2 = snd_soc_read(codec, WM8960_POWER2); 89475aa8868SZidan Wang int reg, ret; 895913d7b4cSMark Brown 896913d7b4cSMark Brown switch (level) { 897913d7b4cSMark Brown case SND_SOC_BIAS_ON: 898913d7b4cSMark Brown break; 899913d7b4cSMark Brown 900913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 90193f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 902913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 903913d7b4cSMark Brown /* Enable anti pop mode */ 904913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 905913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 906913d7b4cSMark Brown WM8960_BUFDCOPEN, 907913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 908913d7b4cSMark Brown WM8960_BUFDCOPEN); 909913d7b4cSMark Brown 910913d7b4cSMark Brown /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */ 911913d7b4cSMark Brown reg = 0; 912913d7b4cSMark Brown if (wm8960->lout1 && wm8960->lout1->power) 913913d7b4cSMark Brown reg |= WM8960_PWR2_LOUT1; 914913d7b4cSMark Brown if (wm8960->rout1 && wm8960->rout1->power) 915913d7b4cSMark Brown reg |= WM8960_PWR2_ROUT1; 916913d7b4cSMark Brown if (wm8960->out3 && wm8960->out3->power) 917913d7b4cSMark Brown reg |= WM8960_PWR2_OUT3; 918913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER2, 919913d7b4cSMark Brown WM8960_PWR2_LOUT1 | 920913d7b4cSMark Brown WM8960_PWR2_ROUT1 | 921913d7b4cSMark Brown WM8960_PWR2_OUT3, reg); 922913d7b4cSMark Brown 923913d7b4cSMark Brown /* Enable VMID at 2*50k */ 924913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 925913d7b4cSMark Brown WM8960_VMID_MASK, 0x80); 926913d7b4cSMark Brown 927913d7b4cSMark Brown /* Ramp */ 928913d7b4cSMark Brown msleep(100); 929913d7b4cSMark Brown 930913d7b4cSMark Brown /* Enable VREF */ 931913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 932913d7b4cSMark Brown WM8960_VREF, WM8960_VREF); 933913d7b4cSMark Brown 934913d7b4cSMark Brown msleep(100); 93575aa8868SZidan Wang 93675aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 93775aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 93875aa8868SZidan Wang if (ret) { 93975aa8868SZidan Wang dev_err(codec->dev, 94075aa8868SZidan Wang "Failed to enable MCLK: %d\n", 94175aa8868SZidan Wang ret); 94275aa8868SZidan Wang return ret; 94375aa8868SZidan Wang } 94475aa8868SZidan Wang } 9453176bf2dSZidan Wang 9463176bf2dSZidan Wang ret = wm8960_configure_clocking(codec); 9473176bf2dSZidan Wang if (ret) 9483176bf2dSZidan Wang return ret; 9493176bf2dSZidan Wang 950913d7b4cSMark Brown break; 951913d7b4cSMark Brown 952913d7b4cSMark Brown case SND_SOC_BIAS_ON: 9533176bf2dSZidan Wang /* 9543176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 9553176bf2dSZidan Wang * disable the pll 9563176bf2dSZidan Wang */ 9573176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 9583176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 9593176bf2dSZidan Wang 96075aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 96175aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 96275aa8868SZidan Wang 963913d7b4cSMark Brown /* Enable anti-pop mode */ 964913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 965913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 966913d7b4cSMark Brown WM8960_BUFDCOPEN, 967913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 968913d7b4cSMark Brown WM8960_BUFDCOPEN); 969913d7b4cSMark Brown 970913d7b4cSMark Brown /* Disable VMID and VREF */ 971913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 972913d7b4cSMark Brown WM8960_VREF | WM8960_VMID_MASK, 0); 973913d7b4cSMark Brown break; 974913d7b4cSMark Brown 975bc45df2dSAxel Lin case SND_SOC_BIAS_OFF: 9760ebe36c6SMark Brown regcache_sync(wm8960->regmap); 977bc45df2dSAxel Lin break; 978913d7b4cSMark Brown default: 979913d7b4cSMark Brown break; 980913d7b4cSMark Brown } 981913d7b4cSMark Brown break; 982913d7b4cSMark Brown 983913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 98493f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 985913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 986913d7b4cSMark Brown /* Disable HP discharge */ 987913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP2, 988913d7b4cSMark Brown WM8960_DISOP | WM8960_DRES_MASK, 989913d7b4cSMark Brown 0); 990913d7b4cSMark Brown 991913d7b4cSMark Brown /* Disable anti-pop features */ 992913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 993913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 994913d7b4cSMark Brown WM8960_BUFDCOPEN, 995913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 996913d7b4cSMark Brown WM8960_BUFDCOPEN); 997913d7b4cSMark Brown break; 998913d7b4cSMark Brown 999913d7b4cSMark Brown default: 1000913d7b4cSMark Brown break; 1001913d7b4cSMark Brown } 1002913d7b4cSMark Brown break; 1003913d7b4cSMark Brown 1004913d7b4cSMark Brown case SND_SOC_BIAS_OFF: 1005f2644a2cSMark Brown break; 1006f2644a2cSMark Brown } 1007f2644a2cSMark Brown 1008f2644a2cSMark Brown return 0; 1009f2644a2cSMark Brown } 1010f2644a2cSMark Brown 1011f2644a2cSMark Brown /* PLL divisors */ 1012f2644a2cSMark Brown struct _pll_div { 1013f2644a2cSMark Brown u32 pre_div:1; 1014f2644a2cSMark Brown u32 n:4; 1015f2644a2cSMark Brown u32 k:24; 1016f2644a2cSMark Brown }; 1017f2644a2cSMark Brown 10183176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target) 10193176bf2dSZidan Wang { 10203176bf2dSZidan Wang unsigned int Ndiv; 10213176bf2dSZidan Wang 10223176bf2dSZidan Wang if (source == 0 || target == 0) 10233176bf2dSZidan Wang return false; 10243176bf2dSZidan Wang 10253176bf2dSZidan Wang /* Scale up target to PLL operating frequency */ 10263176bf2dSZidan Wang target *= 4; 10273176bf2dSZidan Wang Ndiv = target / source; 10283176bf2dSZidan Wang 10293176bf2dSZidan Wang if (Ndiv < 6) { 10303176bf2dSZidan Wang source >>= 1; 10313176bf2dSZidan Wang Ndiv = target / source; 10323176bf2dSZidan Wang } 10333176bf2dSZidan Wang 10343176bf2dSZidan Wang if ((Ndiv < 6) || (Ndiv > 12)) 10353176bf2dSZidan Wang return false; 10363176bf2dSZidan Wang 10373176bf2dSZidan Wang return true; 10383176bf2dSZidan Wang } 10393176bf2dSZidan Wang 1040f2644a2cSMark Brown /* The size in bits of the pll divide multiplied by 10 1041f2644a2cSMark Brown * to allow rounding later */ 1042f2644a2cSMark Brown #define FIXED_PLL_SIZE ((1 << 24) * 10) 1043f2644a2cSMark Brown 1044f2644a2cSMark Brown static int pll_factors(unsigned int source, unsigned int target, 1045f2644a2cSMark Brown struct _pll_div *pll_div) 1046f2644a2cSMark Brown { 1047f2644a2cSMark Brown unsigned long long Kpart; 1048f2644a2cSMark Brown unsigned int K, Ndiv, Nmod; 1049f2644a2cSMark Brown 1050f2644a2cSMark Brown pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source, target); 1051f2644a2cSMark Brown 1052f2644a2cSMark Brown /* Scale up target to PLL operating frequency */ 1053f2644a2cSMark Brown target *= 4; 1054f2644a2cSMark Brown 1055f2644a2cSMark Brown Ndiv = target / source; 1056f2644a2cSMark Brown if (Ndiv < 6) { 1057f2644a2cSMark Brown source >>= 1; 1058f2644a2cSMark Brown pll_div->pre_div = 1; 1059f2644a2cSMark Brown Ndiv = target / source; 1060f2644a2cSMark Brown } else 1061f2644a2cSMark Brown pll_div->pre_div = 0; 1062f2644a2cSMark Brown 1063f2644a2cSMark Brown if ((Ndiv < 6) || (Ndiv > 12)) { 1064f2644a2cSMark Brown pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv); 1065f2644a2cSMark Brown return -EINVAL; 1066f2644a2cSMark Brown } 1067f2644a2cSMark Brown 1068f2644a2cSMark Brown pll_div->n = Ndiv; 1069f2644a2cSMark Brown Nmod = target % source; 1070f2644a2cSMark Brown Kpart = FIXED_PLL_SIZE * (long long)Nmod; 1071f2644a2cSMark Brown 1072f2644a2cSMark Brown do_div(Kpart, source); 1073f2644a2cSMark Brown 1074f2644a2cSMark Brown K = Kpart & 0xFFFFFFFF; 1075f2644a2cSMark Brown 1076f2644a2cSMark Brown /* Check if we need to round */ 1077f2644a2cSMark Brown if ((K % 10) >= 5) 1078f2644a2cSMark Brown K += 5; 1079f2644a2cSMark Brown 1080f2644a2cSMark Brown /* Move down to proper range now rounding is done */ 1081f2644a2cSMark Brown K /= 10; 1082f2644a2cSMark Brown 1083f2644a2cSMark Brown pll_div->k = K; 1084f2644a2cSMark Brown 1085f2644a2cSMark Brown pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n", 1086f2644a2cSMark Brown pll_div->n, pll_div->k, pll_div->pre_div); 1087f2644a2cSMark Brown 1088f2644a2cSMark Brown return 0; 1089f2644a2cSMark Brown } 1090f2644a2cSMark Brown 10913176bf2dSZidan Wang static int wm8960_set_pll(struct snd_soc_codec *codec, 10923176bf2dSZidan Wang unsigned int freq_in, unsigned int freq_out) 1093f2644a2cSMark Brown { 1094f2644a2cSMark Brown u16 reg; 1095f2644a2cSMark Brown static struct _pll_div pll_div; 1096f2644a2cSMark Brown int ret; 1097f2644a2cSMark Brown 1098f2644a2cSMark Brown if (freq_in && freq_out) { 1099f2644a2cSMark Brown ret = pll_factors(freq_in, freq_out, &pll_div); 1100f2644a2cSMark Brown if (ret != 0) 1101f2644a2cSMark Brown return ret; 1102f2644a2cSMark Brown } 1103f2644a2cSMark Brown 1104f2644a2cSMark Brown /* Disable the PLL: even if we are changing the frequency the 1105f2644a2cSMark Brown * PLL needs to be disabled while we do so. */ 110616b24881SAxel Lin snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0); 110716b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0); 1108f2644a2cSMark Brown 1109f2644a2cSMark Brown if (!freq_in || !freq_out) 1110f2644a2cSMark Brown return 0; 1111f2644a2cSMark Brown 111217a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_PLL1) & ~0x3f; 1113f2644a2cSMark Brown reg |= pll_div.pre_div << 4; 1114f2644a2cSMark Brown reg |= pll_div.n; 1115f2644a2cSMark Brown 1116f2644a2cSMark Brown if (pll_div.k) { 1117f2644a2cSMark Brown reg |= 0x20; 1118f2644a2cSMark Brown 111985fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL2, (pll_div.k >> 16) & 0xff); 112085fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL3, (pll_div.k >> 8) & 0xff); 112185fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL4, pll_div.k & 0xff); 1122f2644a2cSMark Brown } 112317a52fd6SMark Brown snd_soc_write(codec, WM8960_PLL1, reg); 1124f2644a2cSMark Brown 1125f2644a2cSMark Brown /* Turn it on */ 112616b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0x1); 1127f2644a2cSMark Brown msleep(250); 112816b24881SAxel Lin snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0x1); 1129f2644a2cSMark Brown 1130f2644a2cSMark Brown return 0; 1131f2644a2cSMark Brown } 1132f2644a2cSMark Brown 11333176bf2dSZidan Wang static int wm8960_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id, 11343176bf2dSZidan Wang int source, unsigned int freq_in, unsigned int freq_out) 11353176bf2dSZidan Wang { 11363176bf2dSZidan Wang struct snd_soc_codec *codec = codec_dai->codec; 11373176bf2dSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 11383176bf2dSZidan Wang 11393176bf2dSZidan Wang wm8960->freq_in = freq_in; 11403176bf2dSZidan Wang 11413176bf2dSZidan Wang if (pll_id == WM8960_SYSCLK_AUTO) 11423176bf2dSZidan Wang return 0; 11433176bf2dSZidan Wang 11443176bf2dSZidan Wang return wm8960_set_pll(codec, freq_in, freq_out); 11453176bf2dSZidan Wang } 11463176bf2dSZidan Wang 1147f2644a2cSMark Brown static int wm8960_set_dai_clkdiv(struct snd_soc_dai *codec_dai, 1148f2644a2cSMark Brown int div_id, int div) 1149f2644a2cSMark Brown { 1150f2644a2cSMark Brown struct snd_soc_codec *codec = codec_dai->codec; 1151f2644a2cSMark Brown u16 reg; 1152f2644a2cSMark Brown 1153f2644a2cSMark Brown switch (div_id) { 1154f2644a2cSMark Brown case WM8960_SYSCLKDIV: 115517a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1f9; 115617a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK1, reg | div); 1157f2644a2cSMark Brown break; 1158f2644a2cSMark Brown case WM8960_DACDIV: 115917a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1c7; 116017a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK1, reg | div); 1161f2644a2cSMark Brown break; 1162f2644a2cSMark Brown case WM8960_OPCLKDIV: 116317a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_PLL1) & 0x03f; 116417a52fd6SMark Brown snd_soc_write(codec, WM8960_PLL1, reg | div); 1165f2644a2cSMark Brown break; 1166f2644a2cSMark Brown case WM8960_DCLKDIV: 116717a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK2) & 0x03f; 116817a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK2, reg | div); 1169f2644a2cSMark Brown break; 1170f2644a2cSMark Brown case WM8960_TOCLKSEL: 117117a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_ADDCTL1) & 0x1fd; 117217a52fd6SMark Brown snd_soc_write(codec, WM8960_ADDCTL1, reg | div); 1173f2644a2cSMark Brown break; 1174f2644a2cSMark Brown default: 1175f2644a2cSMark Brown return -EINVAL; 1176f2644a2cSMark Brown } 1177f2644a2cSMark Brown 1178f2644a2cSMark Brown return 0; 1179f2644a2cSMark Brown } 1180f2644a2cSMark Brown 1181f0fba2adSLiam Girdwood static int wm8960_set_bias_level(struct snd_soc_codec *codec, 1182f0fba2adSLiam Girdwood enum snd_soc_bias_level level) 1183f0fba2adSLiam Girdwood { 1184f0fba2adSLiam Girdwood struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 1185f0fba2adSLiam Girdwood 1186f0fba2adSLiam Girdwood return wm8960->set_bias_level(codec, level); 1187f0fba2adSLiam Girdwood } 1188f0fba2adSLiam Girdwood 11890e50b51aSZidan Wang static int wm8960_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id, 11900e50b51aSZidan Wang unsigned int freq, int dir) 11910e50b51aSZidan Wang { 11920e50b51aSZidan Wang struct snd_soc_codec *codec = dai->codec; 11930e50b51aSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 11940e50b51aSZidan Wang 11950e50b51aSZidan Wang switch (clk_id) { 11960e50b51aSZidan Wang case WM8960_SYSCLK_MCLK: 11970e50b51aSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 11980e50b51aSZidan Wang 0x1, WM8960_SYSCLK_MCLK); 11990e50b51aSZidan Wang break; 12000e50b51aSZidan Wang case WM8960_SYSCLK_PLL: 12010e50b51aSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 12020e50b51aSZidan Wang 0x1, WM8960_SYSCLK_PLL); 12030e50b51aSZidan Wang break; 12043176bf2dSZidan Wang case WM8960_SYSCLK_AUTO: 12053176bf2dSZidan Wang break; 12060e50b51aSZidan Wang default: 12070e50b51aSZidan Wang return -EINVAL; 12080e50b51aSZidan Wang } 12090e50b51aSZidan Wang 12100e50b51aSZidan Wang wm8960->sysclk = freq; 12113176bf2dSZidan Wang wm8960->clk_id = clk_id; 12120e50b51aSZidan Wang 12130e50b51aSZidan Wang return 0; 12140e50b51aSZidan Wang } 12150e50b51aSZidan Wang 1216f2644a2cSMark Brown #define WM8960_RATES SNDRV_PCM_RATE_8000_48000 1217f2644a2cSMark Brown 1218f2644a2cSMark Brown #define WM8960_FORMATS \ 1219f2644a2cSMark Brown (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \ 12207a8c7867SZidan Wang SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 1221f2644a2cSMark Brown 122285e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops wm8960_dai_ops = { 1223f2644a2cSMark Brown .hw_params = wm8960_hw_params, 12243176bf2dSZidan Wang .hw_free = wm8960_hw_free, 1225f2644a2cSMark Brown .digital_mute = wm8960_mute, 1226f2644a2cSMark Brown .set_fmt = wm8960_set_dai_fmt, 1227f2644a2cSMark Brown .set_clkdiv = wm8960_set_dai_clkdiv, 1228f2644a2cSMark Brown .set_pll = wm8960_set_dai_pll, 12290e50b51aSZidan Wang .set_sysclk = wm8960_set_dai_sysclk, 1230f2644a2cSMark Brown }; 1231f2644a2cSMark Brown 1232f0fba2adSLiam Girdwood static struct snd_soc_dai_driver wm8960_dai = { 1233f0fba2adSLiam Girdwood .name = "wm8960-hifi", 1234f2644a2cSMark Brown .playback = { 1235f2644a2cSMark Brown .stream_name = "Playback", 1236f2644a2cSMark Brown .channels_min = 1, 1237f2644a2cSMark Brown .channels_max = 2, 1238f2644a2cSMark Brown .rates = WM8960_RATES, 1239f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1240f2644a2cSMark Brown .capture = { 1241f2644a2cSMark Brown .stream_name = "Capture", 1242f2644a2cSMark Brown .channels_min = 1, 1243f2644a2cSMark Brown .channels_max = 2, 1244f2644a2cSMark Brown .rates = WM8960_RATES, 1245f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1246f2644a2cSMark Brown .ops = &wm8960_dai_ops, 1247f2644a2cSMark Brown .symmetric_rates = 1, 1248f2644a2cSMark Brown }; 1249f2644a2cSMark Brown 1250f0fba2adSLiam Girdwood static int wm8960_probe(struct snd_soc_codec *codec) 1251f2644a2cSMark Brown { 1252f0fba2adSLiam Girdwood struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 1253e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 1254f2644a2cSMark Brown 1255913d7b4cSMark Brown if (pdata->capless) 1256f0fba2adSLiam Girdwood wm8960->set_bias_level = wm8960_set_bias_level_capless; 1257e2280c90SZidan Wang else 1258e2280c90SZidan Wang wm8960->set_bias_level = wm8960_set_bias_level_out3; 1259f2644a2cSMark Brown 1260022658beSLiam Girdwood snd_soc_add_codec_controls(codec, wm8960_snd_controls, 1261f0fba2adSLiam Girdwood ARRAY_SIZE(wm8960_snd_controls)); 1262f0fba2adSLiam Girdwood wm8960_add_widgets(codec); 1263f2644a2cSMark Brown 1264f2644a2cSMark Brown return 0; 1265f2644a2cSMark Brown } 1266f2644a2cSMark Brown 1267f802d6c0SJulia Lawall static const struct snd_soc_codec_driver soc_codec_dev_wm8960 = { 1268f0fba2adSLiam Girdwood .probe = wm8960_probe, 1269f0fba2adSLiam Girdwood .set_bias_level = wm8960_set_bias_level, 12700a87a6e1SLars-Peter Clausen .suspend_bias_off = true, 12710ebe36c6SMark Brown }; 12720ebe36c6SMark Brown 12730ebe36c6SMark Brown static const struct regmap_config wm8960_regmap = { 12740ebe36c6SMark Brown .reg_bits = 7, 12750ebe36c6SMark Brown .val_bits = 9, 12760ebe36c6SMark Brown .max_register = WM8960_PLL4, 12770ebe36c6SMark Brown 12780ebe36c6SMark Brown .reg_defaults = wm8960_reg_defaults, 12790ebe36c6SMark Brown .num_reg_defaults = ARRAY_SIZE(wm8960_reg_defaults), 12800ebe36c6SMark Brown .cache_type = REGCACHE_RBTREE, 12810ebe36c6SMark Brown 12820ebe36c6SMark Brown .volatile_reg = wm8960_volatile, 1283f0fba2adSLiam Girdwood }; 1284f0fba2adSLiam Girdwood 1285e2280c90SZidan Wang static void wm8960_set_pdata_from_of(struct i2c_client *i2c, 1286e2280c90SZidan Wang struct wm8960_data *pdata) 1287e2280c90SZidan Wang { 1288e2280c90SZidan Wang const struct device_node *np = i2c->dev.of_node; 1289e2280c90SZidan Wang 1290e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,capless")) 1291e2280c90SZidan Wang pdata->capless = true; 1292e2280c90SZidan Wang 1293e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,shared-lrclk")) 1294e2280c90SZidan Wang pdata->shared_lrclk = true; 1295e2280c90SZidan Wang } 1296e2280c90SZidan Wang 12977a79e94eSBill Pemberton static int wm8960_i2c_probe(struct i2c_client *i2c, 1298f2644a2cSMark Brown const struct i2c_device_id *id) 1299f2644a2cSMark Brown { 130037061631SMark Brown struct wm8960_data *pdata = dev_get_platdata(&i2c->dev); 1301f2644a2cSMark Brown struct wm8960_priv *wm8960; 1302f0fba2adSLiam Girdwood int ret; 1303f2644a2cSMark Brown 1304b9791c01SMark Brown wm8960 = devm_kzalloc(&i2c->dev, sizeof(struct wm8960_priv), 1305b9791c01SMark Brown GFP_KERNEL); 1306f2644a2cSMark Brown if (wm8960 == NULL) 1307f2644a2cSMark Brown return -ENOMEM; 1308f2644a2cSMark Brown 130975aa8868SZidan Wang wm8960->mclk = devm_clk_get(&i2c->dev, "mclk"); 131075aa8868SZidan Wang if (IS_ERR(wm8960->mclk)) { 131175aa8868SZidan Wang if (PTR_ERR(wm8960->mclk) == -EPROBE_DEFER) 131275aa8868SZidan Wang return -EPROBE_DEFER; 131375aa8868SZidan Wang } 131475aa8868SZidan Wang 1315c5e6f5faSSachin Kamat wm8960->regmap = devm_regmap_init_i2c(i2c, &wm8960_regmap); 13160ebe36c6SMark Brown if (IS_ERR(wm8960->regmap)) 13170ebe36c6SMark Brown return PTR_ERR(wm8960->regmap); 13180ebe36c6SMark Brown 1319e2280c90SZidan Wang if (pdata) 1320e2280c90SZidan Wang memcpy(&wm8960->pdata, pdata, sizeof(struct wm8960_data)); 1321e2280c90SZidan Wang else if (i2c->dev.of_node) 1322e2280c90SZidan Wang wm8960_set_pdata_from_of(i2c, &wm8960->pdata); 1323e2280c90SZidan Wang 13243ad5e861SZidan Wang ret = wm8960_reset(wm8960->regmap); 13253ad5e861SZidan Wang if (ret != 0) { 13263ad5e861SZidan Wang dev_err(&i2c->dev, "Failed to issue reset\n"); 13273ad5e861SZidan Wang return ret; 13283ad5e861SZidan Wang } 13293ad5e861SZidan Wang 13303ad5e861SZidan Wang if (wm8960->pdata.shared_lrclk) { 133137061631SMark Brown ret = regmap_update_bits(wm8960->regmap, WM8960_ADDCTL2, 133237061631SMark Brown 0x4, 0x4); 133337061631SMark Brown if (ret != 0) { 133437061631SMark Brown dev_err(&i2c->dev, "Failed to enable LRCM: %d\n", 133537061631SMark Brown ret); 133637061631SMark Brown return ret; 133737061631SMark Brown } 133837061631SMark Brown } 133937061631SMark Brown 13403ad5e861SZidan Wang /* Latch the update bits */ 13413ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LINVOL, 0x100, 0x100); 13423ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RINVOL, 0x100, 0x100); 13433ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LADC, 0x100, 0x100); 13443ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RADC, 0x100, 0x100); 13453ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LDAC, 0x100, 0x100); 13463ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RDAC, 0x100, 0x100); 13473ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT1, 0x100, 0x100); 13483ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT1, 0x100, 0x100); 13493ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT2, 0x100, 0x100); 13503ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT2, 0x100, 0x100); 13513ad5e861SZidan Wang 1352f2644a2cSMark Brown i2c_set_clientdata(i2c, wm8960); 1353f2644a2cSMark Brown 1354f0fba2adSLiam Girdwood ret = snd_soc_register_codec(&i2c->dev, 1355f0fba2adSLiam Girdwood &soc_codec_dev_wm8960, &wm8960_dai, 1); 1356b9791c01SMark Brown 1357f0fba2adSLiam Girdwood return ret; 1358f2644a2cSMark Brown } 1359f2644a2cSMark Brown 13607a79e94eSBill Pemberton static int wm8960_i2c_remove(struct i2c_client *client) 1361f2644a2cSMark Brown { 1362f0fba2adSLiam Girdwood snd_soc_unregister_codec(&client->dev); 1363f2644a2cSMark Brown return 0; 1364f2644a2cSMark Brown } 1365f2644a2cSMark Brown 1366f2644a2cSMark Brown static const struct i2c_device_id wm8960_i2c_id[] = { 1367f2644a2cSMark Brown { "wm8960", 0 }, 1368f2644a2cSMark Brown { } 1369f2644a2cSMark Brown }; 1370f2644a2cSMark Brown MODULE_DEVICE_TABLE(i2c, wm8960_i2c_id); 1371f2644a2cSMark Brown 1372e2280c90SZidan Wang static const struct of_device_id wm8960_of_match[] = { 1373e2280c90SZidan Wang { .compatible = "wlf,wm8960", }, 1374e2280c90SZidan Wang { } 1375e2280c90SZidan Wang }; 1376e2280c90SZidan Wang MODULE_DEVICE_TABLE(of, wm8960_of_match); 1377e2280c90SZidan Wang 1378f2644a2cSMark Brown static struct i2c_driver wm8960_i2c_driver = { 1379f2644a2cSMark Brown .driver = { 1380091edccfSMark Brown .name = "wm8960", 1381e2280c90SZidan Wang .of_match_table = wm8960_of_match, 1382f2644a2cSMark Brown }, 1383f2644a2cSMark Brown .probe = wm8960_i2c_probe, 13847a79e94eSBill Pemberton .remove = wm8960_i2c_remove, 1385f2644a2cSMark Brown .id_table = wm8960_i2c_id, 1386f2644a2cSMark Brown }; 1387f2644a2cSMark Brown 13883c010e60SSachin Kamat module_i2c_driver(wm8960_i2c_driver); 1389f2644a2cSMark Brown 1390f2644a2cSMark Brown MODULE_DESCRIPTION("ASoC WM8960 driver"); 1391f2644a2cSMark Brown MODULE_AUTHOR("Liam Girdwood"); 1392f2644a2cSMark Brown MODULE_LICENSE("GPL"); 1393