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"}; 150f2644a2cSMark Brown 151f2644a2cSMark Brown static const struct soc_enum wm8960_enum[] = { 152f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_DACCTL1, 5, 4, wm8960_polarity), 153f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_DACCTL2, 5, 4, wm8960_polarity), 154f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_3D, 6, 2, wm8960_3d_upper_cutoff), 155f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_3D, 5, 2, wm8960_3d_lower_cutoff), 156f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_ALC1, 7, 4, wm8960_alcfunc), 157f2644a2cSMark Brown SOC_ENUM_SINGLE(WM8960_ALC3, 8, 2, wm8960_alcmode), 158f2644a2cSMark Brown }; 159f2644a2cSMark Brown 160afd6d36aSMark Brown static const int deemph_settings[] = { 0, 32000, 44100, 48000 }; 161afd6d36aSMark Brown 162afd6d36aSMark Brown static int wm8960_set_deemph(struct snd_soc_codec *codec) 163afd6d36aSMark Brown { 164afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 165afd6d36aSMark Brown int val, i, best; 166afd6d36aSMark Brown 167afd6d36aSMark Brown /* If we're using deemphasis select the nearest available sample 168afd6d36aSMark Brown * rate. 169afd6d36aSMark Brown */ 170afd6d36aSMark Brown if (wm8960->deemph) { 171afd6d36aSMark Brown best = 1; 172afd6d36aSMark Brown for (i = 2; i < ARRAY_SIZE(deemph_settings); i++) { 1733176bf2dSZidan Wang if (abs(deemph_settings[i] - wm8960->lrclk) < 1743176bf2dSZidan Wang abs(deemph_settings[best] - wm8960->lrclk)) 175afd6d36aSMark Brown best = i; 176afd6d36aSMark Brown } 177afd6d36aSMark Brown 178afd6d36aSMark Brown val = best << 1; 179afd6d36aSMark Brown } else { 180afd6d36aSMark Brown val = 0; 181afd6d36aSMark Brown } 182afd6d36aSMark Brown 183afd6d36aSMark Brown dev_dbg(codec->dev, "Set deemphasis %d\n", val); 184afd6d36aSMark Brown 185afd6d36aSMark Brown return snd_soc_update_bits(codec, WM8960_DACCTL1, 186afd6d36aSMark Brown 0x6, val); 187afd6d36aSMark Brown } 188afd6d36aSMark Brown 189afd6d36aSMark Brown static int wm8960_get_deemph(struct snd_kcontrol *kcontrol, 190afd6d36aSMark Brown struct snd_ctl_elem_value *ucontrol) 191afd6d36aSMark Brown { 192ea53bf77SLars-Peter Clausen struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); 193afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 194afd6d36aSMark Brown 195b4a18c8bSTakashi Iwai ucontrol->value.integer.value[0] = wm8960->deemph; 1963f343f85SDmitry Artamonow return 0; 197afd6d36aSMark Brown } 198afd6d36aSMark Brown 199afd6d36aSMark Brown static int wm8960_put_deemph(struct snd_kcontrol *kcontrol, 200afd6d36aSMark Brown struct snd_ctl_elem_value *ucontrol) 201afd6d36aSMark Brown { 202ea53bf77SLars-Peter Clausen struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); 203afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 204c1fe81f2SDan Carpenter unsigned int deemph = ucontrol->value.integer.value[0]; 205afd6d36aSMark Brown 206afd6d36aSMark Brown if (deemph > 1) 207afd6d36aSMark Brown return -EINVAL; 208afd6d36aSMark Brown 209afd6d36aSMark Brown wm8960->deemph = deemph; 210afd6d36aSMark Brown 211afd6d36aSMark Brown return wm8960_set_deemph(codec); 212afd6d36aSMark Brown } 213afd6d36aSMark Brown 2143758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1); 2157e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(inpga_tlv, -1725, 75, 0); 2163758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1); 217f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(bypass_tlv, -2100, 300, 0); 218f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1); 2197e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(lineinboost_tlv, -1500, 300, 1); 2207e90f9b2SZidan Wang static const unsigned int micboost_tlv[] = { 2217e90f9b2SZidan Wang TLV_DB_RANGE_HEAD(2), 2227e90f9b2SZidan Wang 0, 1, TLV_DB_SCALE_ITEM(0, 1300, 0), 2237e90f9b2SZidan Wang 2, 3, TLV_DB_SCALE_ITEM(2000, 900, 0), 2247e90f9b2SZidan Wang }; 225f2644a2cSMark Brown 226f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_snd_controls[] = { 227f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL, WM8960_RINVOL, 2287e90f9b2SZidan Wang 0, 63, 0, inpga_tlv), 229f2644a2cSMark Brown SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL, WM8960_RINVOL, 230f2644a2cSMark Brown 6, 1, 0), 231f2644a2cSMark Brown SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL, WM8960_RINVOL, 23241a59caeSJongHo Kim 7, 1, 1), 233f2644a2cSMark Brown 23421eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT3 Volume", 23595826a37SStuart Henderson WM8960_INBMIX1, 4, 7, 0, lineinboost_tlv), 23621eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT2 Volume", 23795826a37SStuart Henderson WM8960_INBMIX1, 1, 7, 0, lineinboost_tlv), 23895826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT3 Volume", 23995826a37SStuart Henderson WM8960_INBMIX2, 4, 7, 0, lineinboost_tlv), 24095826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT2 Volume", 2417e90f9b2SZidan Wang WM8960_INBMIX2, 1, 7, 0, lineinboost_tlv), 2427e90f9b2SZidan Wang SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT1 Volume", 2438524bb0cSZidan Wang WM8960_RINPATH, 4, 3, 0, micboost_tlv), 2447e90f9b2SZidan Wang SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT1 Volume", 2458524bb0cSZidan Wang WM8960_LINPATH, 4, 3, 0, micboost_tlv), 24621eb2693SMark Brown 247f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC, WM8960_RDAC, 248f2644a2cSMark Brown 0, 255, 0, dac_tlv), 249f2644a2cSMark Brown 250f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1, WM8960_ROUT1, 251f2644a2cSMark Brown 0, 127, 0, out_tlv), 252f2644a2cSMark Brown SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1, WM8960_ROUT1, 253f2644a2cSMark Brown 7, 1, 0), 254f2644a2cSMark Brown 255f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2, WM8960_ROUT2, 256f2644a2cSMark Brown 0, 127, 0, out_tlv), 257f2644a2cSMark Brown SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2, WM8960_ROUT2, 258f2644a2cSMark Brown 7, 1, 0), 259f2644a2cSMark Brown SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3, 3, 5, 0), 260f2644a2cSMark Brown SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3, 0, 5, 0), 261f2644a2cSMark Brown 262f2644a2cSMark Brown SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1, 7, 1, 0), 2634faaa8d9SMark Brown SOC_ENUM("ADC Polarity", wm8960_enum[0]), 264f2644a2cSMark Brown SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1, 0, 1, 0), 265f2644a2cSMark Brown 266a077e81eSZidan Wang SOC_ENUM("DAC Polarity", wm8960_enum[1]), 267afd6d36aSMark Brown SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, 268afd6d36aSMark Brown wm8960_get_deemph, wm8960_put_deemph), 269f2644a2cSMark Brown 2704faaa8d9SMark Brown SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum[2]), 2714faaa8d9SMark Brown SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum[3]), 272f2644a2cSMark Brown SOC_SINGLE("3D Volume", WM8960_3D, 1, 15, 0), 273f2644a2cSMark Brown SOC_SINGLE("3D Switch", WM8960_3D, 0, 1, 0), 274f2644a2cSMark Brown 2754faaa8d9SMark Brown SOC_ENUM("ALC Function", wm8960_enum[4]), 276f2644a2cSMark Brown SOC_SINGLE("ALC Max Gain", WM8960_ALC1, 4, 7, 0), 277f2644a2cSMark Brown SOC_SINGLE("ALC Target", WM8960_ALC1, 0, 15, 1), 278f2644a2cSMark Brown SOC_SINGLE("ALC Min Gain", WM8960_ALC2, 4, 7, 0), 279f2644a2cSMark Brown SOC_SINGLE("ALC Hold Time", WM8960_ALC2, 0, 15, 0), 2804faaa8d9SMark Brown SOC_ENUM("ALC Mode", wm8960_enum[5]), 281f2644a2cSMark Brown SOC_SINGLE("ALC Decay", WM8960_ALC3, 4, 15, 0), 282f2644a2cSMark Brown SOC_SINGLE("ALC Attack", WM8960_ALC3, 0, 15, 0), 283f2644a2cSMark Brown 284f2644a2cSMark Brown SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG, 3, 31, 0), 285f2644a2cSMark Brown SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG, 0, 1, 0), 286f2644a2cSMark Brown 287c324aac0SMa Haijun SOC_DOUBLE_R_TLV("ADC PCM Capture Volume", WM8960_LADC, WM8960_RADC, 288c324aac0SMa Haijun 0, 255, 0, adc_tlv), 289f2644a2cSMark Brown 290f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume", 291f2644a2cSMark Brown WM8960_BYPASS1, 4, 7, 1, bypass_tlv), 292f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume", 293f2644a2cSMark Brown WM8960_LOUTMIX, 4, 7, 1, bypass_tlv), 294f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume", 295f2644a2cSMark Brown WM8960_BYPASS2, 4, 7, 1, bypass_tlv), 296f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume", 297f2644a2cSMark Brown WM8960_ROUTMIX, 4, 7, 1, bypass_tlv), 298f2644a2cSMark Brown }; 299f2644a2cSMark Brown 300f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin_boost[] = { 301f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH, 6, 1, 0), 302f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH, 7, 1, 0), 303f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH, 8, 1, 0), 304f2644a2cSMark Brown }; 305f2644a2cSMark Brown 306f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin[] = { 307f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH, 3, 1, 0), 308f2644a2cSMark Brown }; 309f2644a2cSMark Brown 310f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin_boost[] = { 311f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH, 6, 1, 0), 312f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH, 7, 1, 0), 313f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH, 8, 1, 0), 314f2644a2cSMark Brown }; 315f2644a2cSMark Brown 316f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin[] = { 317f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH, 3, 1, 0), 318f2644a2cSMark Brown }; 319f2644a2cSMark Brown 320f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_loutput_mixer[] = { 321f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX, 8, 1, 0), 322f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX, 7, 1, 0), 323f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1, 7, 1, 0), 324f2644a2cSMark Brown }; 325f2644a2cSMark Brown 326f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_routput_mixer[] = { 327f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX, 8, 1, 0), 328f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX, 7, 1, 0), 329f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2, 7, 1, 0), 330f2644a2cSMark Brown }; 331f2644a2cSMark Brown 332f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_mono_out[] = { 333f2644a2cSMark Brown SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1, 7, 1, 0), 334f2644a2cSMark Brown SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2, 7, 1, 0), 335f2644a2cSMark Brown }; 336f2644a2cSMark Brown 337f2644a2cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets[] = { 338f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT1"), 339f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT1"), 340f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT2"), 341f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT2"), 342f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT3"), 343f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT3"), 344f2644a2cSMark Brown 345187774cbSMark Brown SND_SOC_DAPM_SUPPLY("MICB", WM8960_POWER1, 1, 0, NULL, 0), 346f2644a2cSMark Brown 347f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1, 5, 0, 348f2644a2cSMark Brown wm8960_lin_boost, ARRAY_SIZE(wm8960_lin_boost)), 349f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1, 4, 0, 350f2644a2cSMark Brown wm8960_rin_boost, ARRAY_SIZE(wm8960_rin_boost)), 351f2644a2cSMark Brown 352f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3, 5, 0, 353f2644a2cSMark Brown wm8960_lin, ARRAY_SIZE(wm8960_lin)), 354f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3, 4, 0, 355f2644a2cSMark Brown wm8960_rin, ARRAY_SIZE(wm8960_rin)), 356f2644a2cSMark Brown 35744426de4SMark Brown SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER1, 3, 0), 35844426de4SMark Brown SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER1, 2, 0), 359f2644a2cSMark Brown 360f2644a2cSMark Brown SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2, 8, 0), 361f2644a2cSMark Brown SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2, 7, 0), 362f2644a2cSMark Brown 363f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3, 3, 0, 364f2644a2cSMark Brown &wm8960_loutput_mixer[0], 365f2644a2cSMark Brown ARRAY_SIZE(wm8960_loutput_mixer)), 366f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3, 2, 0, 367f2644a2cSMark Brown &wm8960_routput_mixer[0], 368f2644a2cSMark Brown ARRAY_SIZE(wm8960_routput_mixer)), 369f2644a2cSMark Brown 370f2644a2cSMark Brown SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2, 6, 0, NULL, 0), 371f2644a2cSMark Brown SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2, 5, 0, NULL, 0), 372f2644a2cSMark Brown 373f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2, 4, 0, NULL, 0), 374f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2, 3, 0, NULL, 0), 375f2644a2cSMark Brown 376f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1, 7, 0, NULL, 0), 377f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1, 6, 0, NULL, 0), 378f2644a2cSMark Brown 379f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LP"), 380f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LN"), 381f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_L"), 382f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_R"), 383f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RP"), 384f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RN"), 385f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("OUT3"), 386f2644a2cSMark Brown }; 387f2644a2cSMark Brown 388913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3[] = { 389913d7b4cSMark Brown SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2, 1, 0, 390913d7b4cSMark Brown &wm8960_mono_out[0], 391913d7b4cSMark Brown ARRAY_SIZE(wm8960_mono_out)), 392913d7b4cSMark Brown }; 393913d7b4cSMark Brown 394913d7b4cSMark Brown /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */ 395913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless[] = { 396913d7b4cSMark Brown SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2, 1, 0, NULL, 0), 397913d7b4cSMark Brown }; 398913d7b4cSMark Brown 399f2644a2cSMark Brown static const struct snd_soc_dapm_route audio_paths[] = { 400f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" }, 401f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" }, 402f2644a2cSMark Brown { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" }, 403f2644a2cSMark Brown 404f2644a2cSMark Brown { "Left Input Mixer", "Boost Switch", "Left Boost Mixer", }, 405f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT1", }, /* Really Boost Switch */ 406f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT2" }, 407f2644a2cSMark Brown { "Left Input Mixer", NULL, "LINPUT3" }, 408f2644a2cSMark Brown 409f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" }, 410f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" }, 411f2644a2cSMark Brown { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" }, 412f2644a2cSMark Brown 413f2644a2cSMark Brown { "Right Input Mixer", "Boost Switch", "Right Boost Mixer", }, 414f2644a2cSMark Brown { "Right Input Mixer", NULL, "RINPUT1", }, /* Really Boost Switch */ 415f2644a2cSMark Brown { "Right Input Mixer", NULL, "RINPUT2" }, 41685e36a1fSZidan Wang { "Right Input Mixer", NULL, "RINPUT3" }, 417f2644a2cSMark Brown 418f2644a2cSMark Brown { "Left ADC", NULL, "Left Input Mixer" }, 419f2644a2cSMark Brown { "Right ADC", NULL, "Right Input Mixer" }, 420f2644a2cSMark Brown 421f2644a2cSMark Brown { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" }, 422f2644a2cSMark Brown { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer"} , 423f2644a2cSMark Brown { "Left Output Mixer", "PCM Playback Switch", "Left DAC" }, 424f2644a2cSMark Brown 425f2644a2cSMark Brown { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" }, 426f2644a2cSMark Brown { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" } , 427f2644a2cSMark Brown { "Right Output Mixer", "PCM Playback Switch", "Right DAC" }, 428f2644a2cSMark Brown 429f2644a2cSMark Brown { "LOUT1 PGA", NULL, "Left Output Mixer" }, 430f2644a2cSMark Brown { "ROUT1 PGA", NULL, "Right Output Mixer" }, 431f2644a2cSMark Brown 432f2644a2cSMark Brown { "HP_L", NULL, "LOUT1 PGA" }, 433f2644a2cSMark Brown { "HP_R", NULL, "ROUT1 PGA" }, 434f2644a2cSMark Brown 435f2644a2cSMark Brown { "Left Speaker PGA", NULL, "Left Output Mixer" }, 436f2644a2cSMark Brown { "Right Speaker PGA", NULL, "Right Output Mixer" }, 437f2644a2cSMark Brown 438f2644a2cSMark Brown { "Left Speaker Output", NULL, "Left Speaker PGA" }, 439f2644a2cSMark Brown { "Right Speaker Output", NULL, "Right Speaker PGA" }, 440f2644a2cSMark Brown 441f2644a2cSMark Brown { "SPK_LN", NULL, "Left Speaker Output" }, 442f2644a2cSMark Brown { "SPK_LP", NULL, "Left Speaker Output" }, 443f2644a2cSMark Brown { "SPK_RN", NULL, "Right Speaker Output" }, 444f2644a2cSMark Brown { "SPK_RP", NULL, "Right Speaker Output" }, 445913d7b4cSMark Brown }; 446913d7b4cSMark Brown 447913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_out3[] = { 448913d7b4cSMark Brown { "Mono Output Mixer", "Left Switch", "Left Output Mixer" }, 449913d7b4cSMark Brown { "Mono Output Mixer", "Right Switch", "Right Output Mixer" }, 450f2644a2cSMark Brown 451f2644a2cSMark Brown { "OUT3", NULL, "Mono Output Mixer", } 452f2644a2cSMark Brown }; 453f2644a2cSMark Brown 454913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_capless[] = { 455913d7b4cSMark Brown { "HP_L", NULL, "OUT3 VMID" }, 456913d7b4cSMark Brown { "HP_R", NULL, "OUT3 VMID" }, 457913d7b4cSMark Brown 458913d7b4cSMark Brown { "OUT3 VMID", NULL, "Left Output Mixer" }, 459913d7b4cSMark Brown { "OUT3 VMID", NULL, "Right Output Mixer" }, 460913d7b4cSMark Brown }; 461913d7b4cSMark Brown 462f2644a2cSMark Brown static int wm8960_add_widgets(struct snd_soc_codec *codec) 463f2644a2cSMark Brown { 464b2c812e2SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 465e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 46693f32f53SLars-Peter Clausen struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec); 467913d7b4cSMark Brown struct snd_soc_dapm_widget *w; 468913d7b4cSMark Brown 469ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets, 470f2644a2cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets)); 471f2644a2cSMark Brown 472ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths, ARRAY_SIZE(audio_paths)); 473f2644a2cSMark Brown 474913d7b4cSMark Brown /* In capless mode OUT3 is used to provide VMID for the 475913d7b4cSMark Brown * headphone outputs, otherwise it is used as a mono mixer. 476913d7b4cSMark Brown */ 477913d7b4cSMark Brown if (pdata && pdata->capless) { 478ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_capless, 479913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_capless)); 480913d7b4cSMark Brown 481ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_capless, 482913d7b4cSMark Brown ARRAY_SIZE(audio_paths_capless)); 483913d7b4cSMark Brown } else { 484ce6120ccSLiam Girdwood snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_out3, 485913d7b4cSMark Brown ARRAY_SIZE(wm8960_dapm_widgets_out3)); 486913d7b4cSMark Brown 487ce6120ccSLiam Girdwood snd_soc_dapm_add_routes(dapm, audio_paths_out3, 488913d7b4cSMark Brown ARRAY_SIZE(audio_paths_out3)); 489913d7b4cSMark Brown } 490913d7b4cSMark Brown 491913d7b4cSMark Brown /* We need to power up the headphone output stage out of 492913d7b4cSMark Brown * sequence for capless mode. To save scanning the widget 493913d7b4cSMark Brown * list each time to find the desired power state do so now 494913d7b4cSMark Brown * and save the result. 495913d7b4cSMark Brown */ 49600200107SLars-Peter Clausen list_for_each_entry(w, &codec->component.card->widgets, list) { 49793f32f53SLars-Peter Clausen if (w->dapm != dapm) 49897c866deSJarkko Nikula continue; 499913d7b4cSMark Brown if (strcmp(w->name, "LOUT1 PGA") == 0) 500913d7b4cSMark Brown wm8960->lout1 = w; 501913d7b4cSMark Brown if (strcmp(w->name, "ROUT1 PGA") == 0) 502913d7b4cSMark Brown wm8960->rout1 = w; 503913d7b4cSMark Brown if (strcmp(w->name, "OUT3 VMID") == 0) 504913d7b4cSMark Brown wm8960->out3 = w; 505913d7b4cSMark Brown } 506913d7b4cSMark Brown 507f2644a2cSMark Brown return 0; 508f2644a2cSMark Brown } 509f2644a2cSMark Brown 510f2644a2cSMark Brown static int wm8960_set_dai_fmt(struct snd_soc_dai *codec_dai, 511f2644a2cSMark Brown unsigned int fmt) 512f2644a2cSMark Brown { 513f2644a2cSMark Brown struct snd_soc_codec *codec = codec_dai->codec; 514f2644a2cSMark Brown u16 iface = 0; 515f2644a2cSMark Brown 516f2644a2cSMark Brown /* set master/slave audio interface */ 517f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 518f2644a2cSMark Brown case SND_SOC_DAIFMT_CBM_CFM: 519f2644a2cSMark Brown iface |= 0x0040; 520f2644a2cSMark Brown break; 521f2644a2cSMark Brown case SND_SOC_DAIFMT_CBS_CFS: 522f2644a2cSMark Brown break; 523f2644a2cSMark Brown default: 524f2644a2cSMark Brown return -EINVAL; 525f2644a2cSMark Brown } 526f2644a2cSMark Brown 527f2644a2cSMark Brown /* interface format */ 528f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 529f2644a2cSMark Brown case SND_SOC_DAIFMT_I2S: 530f2644a2cSMark Brown iface |= 0x0002; 531f2644a2cSMark Brown break; 532f2644a2cSMark Brown case SND_SOC_DAIFMT_RIGHT_J: 533f2644a2cSMark Brown break; 534f2644a2cSMark Brown case SND_SOC_DAIFMT_LEFT_J: 535f2644a2cSMark Brown iface |= 0x0001; 536f2644a2cSMark Brown break; 537f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_A: 538f2644a2cSMark Brown iface |= 0x0003; 539f2644a2cSMark Brown break; 540f2644a2cSMark Brown case SND_SOC_DAIFMT_DSP_B: 541f2644a2cSMark Brown iface |= 0x0013; 542f2644a2cSMark Brown break; 543f2644a2cSMark Brown default: 544f2644a2cSMark Brown return -EINVAL; 545f2644a2cSMark Brown } 546f2644a2cSMark Brown 547f2644a2cSMark Brown /* clock inversion */ 548f2644a2cSMark Brown switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 549f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_NF: 550f2644a2cSMark Brown break; 551f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_IF: 552f2644a2cSMark Brown iface |= 0x0090; 553f2644a2cSMark Brown break; 554f2644a2cSMark Brown case SND_SOC_DAIFMT_IB_NF: 555f2644a2cSMark Brown iface |= 0x0080; 556f2644a2cSMark Brown break; 557f2644a2cSMark Brown case SND_SOC_DAIFMT_NB_IF: 558f2644a2cSMark Brown iface |= 0x0010; 559f2644a2cSMark Brown break; 560f2644a2cSMark Brown default: 561f2644a2cSMark Brown return -EINVAL; 562f2644a2cSMark Brown } 563f2644a2cSMark Brown 564f2644a2cSMark Brown /* set iface */ 56517a52fd6SMark Brown snd_soc_write(codec, WM8960_IFACE1, iface); 566f2644a2cSMark Brown return 0; 567f2644a2cSMark Brown } 568f2644a2cSMark Brown 569db059c0fSMark Brown static struct { 570db059c0fSMark Brown int rate; 571db059c0fSMark Brown unsigned int val; 572db059c0fSMark Brown } alc_rates[] = { 573db059c0fSMark Brown { 48000, 0 }, 574db059c0fSMark Brown { 44100, 0 }, 575db059c0fSMark Brown { 32000, 1 }, 576db059c0fSMark Brown { 22050, 2 }, 577db059c0fSMark Brown { 24000, 2 }, 578db059c0fSMark Brown { 16000, 3 }, 57922ee76daSZidan Wang { 11025, 4 }, 580db059c0fSMark Brown { 12000, 4 }, 581db059c0fSMark Brown { 8000, 5 }, 582db059c0fSMark Brown }; 583db059c0fSMark Brown 5843176bf2dSZidan Wang /* -1 for reserved value */ 5853176bf2dSZidan Wang static const int sysclk_divs[] = { 1, -1, 2, -1 }; 5863176bf2dSZidan Wang 5870e50b51aSZidan Wang /* Multiply 256 for internal 256 div */ 5880e50b51aSZidan Wang static const int dac_divs[] = { 256, 384, 512, 768, 1024, 1408, 1536 }; 5890e50b51aSZidan Wang 5900e50b51aSZidan Wang /* Multiply 10 to eliminate decimials */ 5910e50b51aSZidan Wang static const int bclk_divs[] = { 5920e50b51aSZidan Wang 10, 15, 20, 30, 40, 55, 60, 80, 110, 5930e50b51aSZidan Wang 120, 160, 220, 240, 320, 320, 320 5940e50b51aSZidan Wang }; 5950e50b51aSZidan Wang 5963176bf2dSZidan Wang static int wm8960_configure_clocking(struct snd_soc_codec *codec) 5970e50b51aSZidan Wang { 5980e50b51aSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 5993176bf2dSZidan Wang int sysclk, bclk, lrclk, freq_out, freq_in; 6000e50b51aSZidan Wang u16 iface1 = snd_soc_read(codec, WM8960_IFACE1); 6013176bf2dSZidan Wang int i, j, k; 6020e50b51aSZidan Wang 6030e50b51aSZidan Wang if (!(iface1 & (1<<6))) { 6040e50b51aSZidan Wang dev_dbg(codec->dev, 6050e50b51aSZidan Wang "Codec is slave mode, no need to configure clock\n"); 6063176bf2dSZidan Wang return 0; 6070e50b51aSZidan Wang } 6080e50b51aSZidan Wang 6093176bf2dSZidan Wang if (wm8960->clk_id != WM8960_SYSCLK_MCLK && !wm8960->freq_in) { 6103176bf2dSZidan Wang dev_err(codec->dev, "No MCLK configured\n"); 6113176bf2dSZidan Wang return -EINVAL; 6120e50b51aSZidan Wang } 6130e50b51aSZidan Wang 6143176bf2dSZidan Wang freq_in = wm8960->freq_in; 6153176bf2dSZidan Wang bclk = wm8960->bclk; 6163176bf2dSZidan Wang lrclk = wm8960->lrclk; 6170e50b51aSZidan Wang /* 6183176bf2dSZidan Wang * If it's sysclk auto mode, check if the MCLK can provide sysclk or 6193176bf2dSZidan Wang * not. If MCLK can provide sysclk, using MCLK to provide sysclk 6203176bf2dSZidan Wang * directly. Otherwise, auto select a available pll out frequency 6213176bf2dSZidan Wang * and set PLL. 6220e50b51aSZidan Wang */ 6233176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO) { 6243176bf2dSZidan Wang /* disable the PLL and using MCLK to provide sysclk */ 6253176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 6263176bf2dSZidan Wang freq_out = freq_in; 6273176bf2dSZidan Wang } else if (wm8960->sysclk) { 6283176bf2dSZidan Wang freq_out = wm8960->sysclk; 6293176bf2dSZidan Wang } else { 6303176bf2dSZidan Wang dev_err(codec->dev, "No SYSCLK configured\n"); 6313176bf2dSZidan Wang return -EINVAL; 6323176bf2dSZidan Wang } 6333176bf2dSZidan Wang 6346bb74514SStuart Henderson if (wm8960->clk_id != WM8960_SYSCLK_PLL) { 6353176bf2dSZidan Wang /* check if the sysclk frequency is available. */ 6363176bf2dSZidan Wang for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 6373176bf2dSZidan Wang if (sysclk_divs[i] == -1) 6383176bf2dSZidan Wang continue; 6393176bf2dSZidan Wang sysclk = freq_out / sysclk_divs[i]; 6403176bf2dSZidan Wang for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 6416bb74514SStuart Henderson if (sysclk != dac_divs[j] * lrclk) 6426bb74514SStuart Henderson continue; 6433176bf2dSZidan Wang for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) 6443176bf2dSZidan Wang if (sysclk == bclk * bclk_divs[k] / 10) 6453176bf2dSZidan Wang break; 6463176bf2dSZidan Wang if (k != ARRAY_SIZE(bclk_divs)) 6473176bf2dSZidan Wang break; 6483176bf2dSZidan Wang } 6493176bf2dSZidan Wang if (j != ARRAY_SIZE(dac_divs)) 6503176bf2dSZidan Wang break; 6513176bf2dSZidan Wang } 6523176bf2dSZidan Wang 6533176bf2dSZidan Wang if (i != ARRAY_SIZE(sysclk_divs)) { 6543176bf2dSZidan Wang goto configure_clock; 6553176bf2dSZidan Wang } else if (wm8960->clk_id != WM8960_SYSCLK_AUTO) { 6563176bf2dSZidan Wang dev_err(codec->dev, "failed to configure clock\n"); 6573176bf2dSZidan Wang return -EINVAL; 6583176bf2dSZidan Wang } 6596bb74514SStuart Henderson } 6603176bf2dSZidan Wang /* get a available pll out frequency and set pll */ 6613176bf2dSZidan Wang for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) { 6623176bf2dSZidan Wang if (sysclk_divs[i] == -1) 6633176bf2dSZidan Wang continue; 6643176bf2dSZidan Wang for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) { 6653176bf2dSZidan Wang sysclk = lrclk * dac_divs[j]; 6663176bf2dSZidan Wang freq_out = sysclk * sysclk_divs[i]; 6673176bf2dSZidan Wang 6683176bf2dSZidan Wang for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) { 6693176bf2dSZidan Wang if (sysclk == bclk * bclk_divs[k] / 10 && 6703176bf2dSZidan Wang is_pll_freq_available(freq_in, freq_out)) { 6713176bf2dSZidan Wang wm8960_set_pll(codec, 6723176bf2dSZidan Wang freq_in, freq_out); 6733176bf2dSZidan Wang break; 6743176bf2dSZidan Wang } else { 6753176bf2dSZidan Wang continue; 6763176bf2dSZidan Wang } 6773176bf2dSZidan Wang } 6783176bf2dSZidan Wang if (k != ARRAY_SIZE(bclk_divs)) 6793176bf2dSZidan Wang break; 6803176bf2dSZidan Wang } 6813176bf2dSZidan Wang if (j != ARRAY_SIZE(dac_divs)) 6823176bf2dSZidan Wang break; 6833176bf2dSZidan Wang } 6843176bf2dSZidan Wang 6853176bf2dSZidan Wang if (i == ARRAY_SIZE(sysclk_divs)) { 6863176bf2dSZidan Wang dev_err(codec->dev, "failed to configure clock\n"); 6873176bf2dSZidan Wang return -EINVAL; 6883176bf2dSZidan Wang } 6893176bf2dSZidan Wang 6903176bf2dSZidan Wang configure_clock: 6913176bf2dSZidan Wang /* configure sysclk clock */ 6923176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 3 << 1, i << 1); 6933176bf2dSZidan Wang 6943176bf2dSZidan Wang /* configure frame clock */ 6953176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 3, j << 3); 6963176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 6, j << 6); 6970e50b51aSZidan Wang 6980e50b51aSZidan Wang /* configure bit clock */ 6993176bf2dSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK2, 0xf, k); 7003176bf2dSZidan Wang 7013176bf2dSZidan Wang return 0; 7020e50b51aSZidan Wang } 7030e50b51aSZidan Wang 704f2644a2cSMark Brown static int wm8960_hw_params(struct snd_pcm_substream *substream, 705f2644a2cSMark Brown struct snd_pcm_hw_params *params, 706f2644a2cSMark Brown struct snd_soc_dai *dai) 707f2644a2cSMark Brown { 708e6968a17SMark Brown struct snd_soc_codec *codec = dai->codec; 709afd6d36aSMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 71017a52fd6SMark Brown u16 iface = snd_soc_read(codec, WM8960_IFACE1) & 0xfff3; 7110e50b51aSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 712db059c0fSMark Brown int i; 713f2644a2cSMark Brown 7140e50b51aSZidan Wang wm8960->bclk = snd_soc_params_to_bclk(params); 7150e50b51aSZidan Wang if (params_channels(params) == 1) 7160e50b51aSZidan Wang wm8960->bclk *= 2; 7170e50b51aSZidan Wang 718f2644a2cSMark Brown /* bit size */ 71939e9cc46SMark Brown switch (params_width(params)) { 72039e9cc46SMark Brown case 16: 721f2644a2cSMark Brown break; 72239e9cc46SMark Brown case 20: 723f2644a2cSMark Brown iface |= 0x0004; 724f2644a2cSMark Brown break; 72539e9cc46SMark Brown case 24: 726f2644a2cSMark Brown iface |= 0x0008; 727f2644a2cSMark Brown break; 7287a8c7867SZidan Wang case 32: 7297a8c7867SZidan Wang /* right justify mode does not support 32 word length */ 7307a8c7867SZidan Wang if ((iface & 0x3) != 0) { 7317a8c7867SZidan Wang iface |= 0x000c; 7327a8c7867SZidan Wang break; 7337a8c7867SZidan Wang } 7344c2474c0STimur Tabi default: 73539e9cc46SMark Brown dev_err(codec->dev, "unsupported width %d\n", 73639e9cc46SMark Brown params_width(params)); 7374c2474c0STimur Tabi return -EINVAL; 738f2644a2cSMark Brown } 739f2644a2cSMark Brown 7403176bf2dSZidan Wang wm8960->lrclk = params_rate(params); 741afd6d36aSMark Brown /* Update filters for the new rate */ 7423176bf2dSZidan Wang if (tx) { 743afd6d36aSMark Brown wm8960_set_deemph(codec); 744db059c0fSMark Brown } else { 745db059c0fSMark Brown for (i = 0; i < ARRAY_SIZE(alc_rates); i++) 746db059c0fSMark Brown if (alc_rates[i].rate == params_rate(params)) 747db059c0fSMark Brown snd_soc_update_bits(codec, 748db059c0fSMark Brown WM8960_ADDCTL3, 0x7, 749db059c0fSMark Brown alc_rates[i].val); 750afd6d36aSMark Brown } 751afd6d36aSMark Brown 752f2644a2cSMark Brown /* set iface */ 75317a52fd6SMark Brown snd_soc_write(codec, WM8960_IFACE1, iface); 7540e50b51aSZidan Wang 7553176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = true; 7563176bf2dSZidan Wang 7573176bf2dSZidan Wang if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_ON && 7583176bf2dSZidan Wang !wm8960->is_stream_in_use[!tx]) 7593176bf2dSZidan Wang return wm8960_configure_clocking(codec); 7603176bf2dSZidan Wang 7613176bf2dSZidan Wang return 0; 7623176bf2dSZidan Wang } 7633176bf2dSZidan Wang 7643176bf2dSZidan Wang static int wm8960_hw_free(struct snd_pcm_substream *substream, 7653176bf2dSZidan Wang struct snd_soc_dai *dai) 7663176bf2dSZidan Wang { 7673176bf2dSZidan Wang struct snd_soc_codec *codec = dai->codec; 7683176bf2dSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 7693176bf2dSZidan Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 7703176bf2dSZidan Wang 7713176bf2dSZidan Wang wm8960->is_stream_in_use[tx] = false; 7720e50b51aSZidan Wang 773f2644a2cSMark Brown return 0; 774f2644a2cSMark Brown } 775f2644a2cSMark Brown 776f2644a2cSMark Brown static int wm8960_mute(struct snd_soc_dai *dai, int mute) 777f2644a2cSMark Brown { 778f2644a2cSMark Brown struct snd_soc_codec *codec = dai->codec; 779f2644a2cSMark Brown 780f2644a2cSMark Brown if (mute) 78116b24881SAxel Lin snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0x8); 782f2644a2cSMark Brown else 78316b24881SAxel Lin snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0); 784f2644a2cSMark Brown return 0; 785f2644a2cSMark Brown } 786f2644a2cSMark Brown 787913d7b4cSMark Brown static int wm8960_set_bias_level_out3(struct snd_soc_codec *codec, 788f2644a2cSMark Brown enum snd_soc_bias_level level) 789f2644a2cSMark Brown { 7900ebe36c6SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 7913176bf2dSZidan Wang u16 pm2 = snd_soc_read(codec, WM8960_POWER2); 79275aa8868SZidan Wang int ret; 7930ebe36c6SMark Brown 794f2644a2cSMark Brown switch (level) { 795f2644a2cSMark Brown case SND_SOC_BIAS_ON: 796f2644a2cSMark Brown break; 797f2644a2cSMark Brown 798f2644a2cSMark Brown case SND_SOC_BIAS_PREPARE: 79993f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 80075aa8868SZidan Wang case SND_SOC_BIAS_STANDBY: 80175aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 80275aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 80375aa8868SZidan Wang if (ret) { 80475aa8868SZidan Wang dev_err(codec->dev, 80575aa8868SZidan Wang "Failed to enable MCLK: %d\n", 80675aa8868SZidan Wang ret); 80775aa8868SZidan Wang return ret; 80875aa8868SZidan Wang } 80975aa8868SZidan Wang } 81075aa8868SZidan Wang 8113176bf2dSZidan Wang ret = wm8960_configure_clocking(codec); 8123176bf2dSZidan Wang if (ret) 8133176bf2dSZidan Wang return ret; 8143176bf2dSZidan Wang 815f2644a2cSMark Brown /* Set VMID to 2x50k */ 81616b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x80); 817f2644a2cSMark Brown break; 818f2644a2cSMark Brown 81975aa8868SZidan Wang case SND_SOC_BIAS_ON: 8203176bf2dSZidan Wang /* 8213176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 8223176bf2dSZidan Wang * disable the pll 8233176bf2dSZidan Wang */ 8243176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 8253176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 8263176bf2dSZidan Wang 82775aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 82875aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 82975aa8868SZidan Wang break; 83075aa8868SZidan Wang 83175aa8868SZidan Wang default: 83275aa8868SZidan Wang break; 83375aa8868SZidan Wang } 83475aa8868SZidan Wang 83575aa8868SZidan Wang break; 83675aa8868SZidan Wang 837f2644a2cSMark Brown case SND_SOC_BIAS_STANDBY: 83893f32f53SLars-Peter Clausen if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) { 8390ebe36c6SMark Brown regcache_sync(wm8960->regmap); 840bc45df2dSAxel Lin 841f2644a2cSMark Brown /* Enable anti-pop features */ 84217a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, 843f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 844f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 845f2644a2cSMark Brown 846f2644a2cSMark Brown /* Enable & ramp VMID at 2x50k */ 84716b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x80, 0x80); 848f2644a2cSMark Brown msleep(100); 849f2644a2cSMark Brown 850f2644a2cSMark Brown /* Enable VREF */ 85116b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, WM8960_VREF, 85216b24881SAxel Lin WM8960_VREF); 853f2644a2cSMark Brown 854f2644a2cSMark Brown /* Disable anti-pop features */ 85517a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, WM8960_BUFIOEN); 856f2644a2cSMark Brown } 857f2644a2cSMark Brown 858f2644a2cSMark Brown /* Set VMID to 2x250k */ 85916b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x100); 860f2644a2cSMark Brown break; 861f2644a2cSMark Brown 862f2644a2cSMark Brown case SND_SOC_BIAS_OFF: 863f2644a2cSMark Brown /* Enable anti-pop features */ 86417a52fd6SMark Brown snd_soc_write(codec, WM8960_APOP1, 865f2644a2cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 866f2644a2cSMark Brown WM8960_BUFDCOPEN | WM8960_BUFIOEN); 867f2644a2cSMark Brown 868f2644a2cSMark Brown /* Disable VMID and VREF, let them discharge */ 86917a52fd6SMark Brown snd_soc_write(codec, WM8960_POWER1, 0); 870f2644a2cSMark Brown msleep(600); 871913d7b4cSMark Brown break; 872913d7b4cSMark Brown } 873f2644a2cSMark Brown 874913d7b4cSMark Brown return 0; 875913d7b4cSMark Brown } 876913d7b4cSMark Brown 877913d7b4cSMark Brown static int wm8960_set_bias_level_capless(struct snd_soc_codec *codec, 878913d7b4cSMark Brown enum snd_soc_bias_level level) 879913d7b4cSMark Brown { 880b2c812e2SMark Brown struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 8813176bf2dSZidan Wang u16 pm2 = snd_soc_read(codec, WM8960_POWER2); 88275aa8868SZidan Wang int reg, ret; 883913d7b4cSMark Brown 884913d7b4cSMark Brown switch (level) { 885913d7b4cSMark Brown case SND_SOC_BIAS_ON: 886913d7b4cSMark Brown break; 887913d7b4cSMark Brown 888913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 88993f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 890913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 891913d7b4cSMark Brown /* Enable anti pop mode */ 892913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 893913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 894913d7b4cSMark Brown WM8960_BUFDCOPEN, 895913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 896913d7b4cSMark Brown WM8960_BUFDCOPEN); 897913d7b4cSMark Brown 898913d7b4cSMark Brown /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */ 899913d7b4cSMark Brown reg = 0; 900913d7b4cSMark Brown if (wm8960->lout1 && wm8960->lout1->power) 901913d7b4cSMark Brown reg |= WM8960_PWR2_LOUT1; 902913d7b4cSMark Brown if (wm8960->rout1 && wm8960->rout1->power) 903913d7b4cSMark Brown reg |= WM8960_PWR2_ROUT1; 904913d7b4cSMark Brown if (wm8960->out3 && wm8960->out3->power) 905913d7b4cSMark Brown reg |= WM8960_PWR2_OUT3; 906913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER2, 907913d7b4cSMark Brown WM8960_PWR2_LOUT1 | 908913d7b4cSMark Brown WM8960_PWR2_ROUT1 | 909913d7b4cSMark Brown WM8960_PWR2_OUT3, reg); 910913d7b4cSMark Brown 911913d7b4cSMark Brown /* Enable VMID at 2*50k */ 912913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 913913d7b4cSMark Brown WM8960_VMID_MASK, 0x80); 914913d7b4cSMark Brown 915913d7b4cSMark Brown /* Ramp */ 916913d7b4cSMark Brown msleep(100); 917913d7b4cSMark Brown 918913d7b4cSMark Brown /* Enable VREF */ 919913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 920913d7b4cSMark Brown WM8960_VREF, WM8960_VREF); 921913d7b4cSMark Brown 922913d7b4cSMark Brown msleep(100); 92375aa8868SZidan Wang 92475aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) { 92575aa8868SZidan Wang ret = clk_prepare_enable(wm8960->mclk); 92675aa8868SZidan Wang if (ret) { 92775aa8868SZidan Wang dev_err(codec->dev, 92875aa8868SZidan Wang "Failed to enable MCLK: %d\n", 92975aa8868SZidan Wang ret); 93075aa8868SZidan Wang return ret; 93175aa8868SZidan Wang } 93275aa8868SZidan Wang } 9333176bf2dSZidan Wang 9343176bf2dSZidan Wang ret = wm8960_configure_clocking(codec); 9353176bf2dSZidan Wang if (ret) 9363176bf2dSZidan Wang return ret; 9373176bf2dSZidan Wang 938913d7b4cSMark Brown break; 939913d7b4cSMark Brown 940913d7b4cSMark Brown case SND_SOC_BIAS_ON: 9413176bf2dSZidan Wang /* 9423176bf2dSZidan Wang * If it's sysclk auto mode, and the pll is enabled, 9433176bf2dSZidan Wang * disable the pll 9443176bf2dSZidan Wang */ 9453176bf2dSZidan Wang if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1)) 9463176bf2dSZidan Wang wm8960_set_pll(codec, 0, 0); 9473176bf2dSZidan Wang 94875aa8868SZidan Wang if (!IS_ERR(wm8960->mclk)) 94975aa8868SZidan Wang clk_disable_unprepare(wm8960->mclk); 95075aa8868SZidan Wang 951913d7b4cSMark Brown /* Enable anti-pop mode */ 952913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 953913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 954913d7b4cSMark Brown WM8960_BUFDCOPEN, 955913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 956913d7b4cSMark Brown WM8960_BUFDCOPEN); 957913d7b4cSMark Brown 958913d7b4cSMark Brown /* Disable VMID and VREF */ 959913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_POWER1, 960913d7b4cSMark Brown WM8960_VREF | WM8960_VMID_MASK, 0); 961913d7b4cSMark Brown break; 962913d7b4cSMark Brown 963bc45df2dSAxel Lin case SND_SOC_BIAS_OFF: 9640ebe36c6SMark Brown regcache_sync(wm8960->regmap); 965bc45df2dSAxel Lin break; 966913d7b4cSMark Brown default: 967913d7b4cSMark Brown break; 968913d7b4cSMark Brown } 969913d7b4cSMark Brown break; 970913d7b4cSMark Brown 971913d7b4cSMark Brown case SND_SOC_BIAS_STANDBY: 97293f32f53SLars-Peter Clausen switch (snd_soc_codec_get_bias_level(codec)) { 973913d7b4cSMark Brown case SND_SOC_BIAS_PREPARE: 974913d7b4cSMark Brown /* Disable HP discharge */ 975913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP2, 976913d7b4cSMark Brown WM8960_DISOP | WM8960_DRES_MASK, 977913d7b4cSMark Brown 0); 978913d7b4cSMark Brown 979913d7b4cSMark Brown /* Disable anti-pop features */ 980913d7b4cSMark Brown snd_soc_update_bits(codec, WM8960_APOP1, 981913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 982913d7b4cSMark Brown WM8960_BUFDCOPEN, 983913d7b4cSMark Brown WM8960_POBCTRL | WM8960_SOFT_ST | 984913d7b4cSMark Brown WM8960_BUFDCOPEN); 985913d7b4cSMark Brown break; 986913d7b4cSMark Brown 987913d7b4cSMark Brown default: 988913d7b4cSMark Brown break; 989913d7b4cSMark Brown } 990913d7b4cSMark Brown break; 991913d7b4cSMark Brown 992913d7b4cSMark Brown case SND_SOC_BIAS_OFF: 993f2644a2cSMark Brown break; 994f2644a2cSMark Brown } 995f2644a2cSMark Brown 996f2644a2cSMark Brown return 0; 997f2644a2cSMark Brown } 998f2644a2cSMark Brown 999f2644a2cSMark Brown /* PLL divisors */ 1000f2644a2cSMark Brown struct _pll_div { 1001f2644a2cSMark Brown u32 pre_div:1; 1002f2644a2cSMark Brown u32 n:4; 1003f2644a2cSMark Brown u32 k:24; 1004f2644a2cSMark Brown }; 1005f2644a2cSMark Brown 10063176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target) 10073176bf2dSZidan Wang { 10083176bf2dSZidan Wang unsigned int Ndiv; 10093176bf2dSZidan Wang 10103176bf2dSZidan Wang if (source == 0 || target == 0) 10113176bf2dSZidan Wang return false; 10123176bf2dSZidan Wang 10133176bf2dSZidan Wang /* Scale up target to PLL operating frequency */ 10143176bf2dSZidan Wang target *= 4; 10153176bf2dSZidan Wang Ndiv = target / source; 10163176bf2dSZidan Wang 10173176bf2dSZidan Wang if (Ndiv < 6) { 10183176bf2dSZidan Wang source >>= 1; 10193176bf2dSZidan Wang Ndiv = target / source; 10203176bf2dSZidan Wang } 10213176bf2dSZidan Wang 10223176bf2dSZidan Wang if ((Ndiv < 6) || (Ndiv > 12)) 10233176bf2dSZidan Wang return false; 10243176bf2dSZidan Wang 10253176bf2dSZidan Wang return true; 10263176bf2dSZidan Wang } 10273176bf2dSZidan Wang 1028f2644a2cSMark Brown /* The size in bits of the pll divide multiplied by 10 1029f2644a2cSMark Brown * to allow rounding later */ 1030f2644a2cSMark Brown #define FIXED_PLL_SIZE ((1 << 24) * 10) 1031f2644a2cSMark Brown 1032f2644a2cSMark Brown static int pll_factors(unsigned int source, unsigned int target, 1033f2644a2cSMark Brown struct _pll_div *pll_div) 1034f2644a2cSMark Brown { 1035f2644a2cSMark Brown unsigned long long Kpart; 1036f2644a2cSMark Brown unsigned int K, Ndiv, Nmod; 1037f2644a2cSMark Brown 1038f2644a2cSMark Brown pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source, target); 1039f2644a2cSMark Brown 1040f2644a2cSMark Brown /* Scale up target to PLL operating frequency */ 1041f2644a2cSMark Brown target *= 4; 1042f2644a2cSMark Brown 1043f2644a2cSMark Brown Ndiv = target / source; 1044f2644a2cSMark Brown if (Ndiv < 6) { 1045f2644a2cSMark Brown source >>= 1; 1046f2644a2cSMark Brown pll_div->pre_div = 1; 1047f2644a2cSMark Brown Ndiv = target / source; 1048f2644a2cSMark Brown } else 1049f2644a2cSMark Brown pll_div->pre_div = 0; 1050f2644a2cSMark Brown 1051f2644a2cSMark Brown if ((Ndiv < 6) || (Ndiv > 12)) { 1052f2644a2cSMark Brown pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv); 1053f2644a2cSMark Brown return -EINVAL; 1054f2644a2cSMark Brown } 1055f2644a2cSMark Brown 1056f2644a2cSMark Brown pll_div->n = Ndiv; 1057f2644a2cSMark Brown Nmod = target % source; 1058f2644a2cSMark Brown Kpart = FIXED_PLL_SIZE * (long long)Nmod; 1059f2644a2cSMark Brown 1060f2644a2cSMark Brown do_div(Kpart, source); 1061f2644a2cSMark Brown 1062f2644a2cSMark Brown K = Kpart & 0xFFFFFFFF; 1063f2644a2cSMark Brown 1064f2644a2cSMark Brown /* Check if we need to round */ 1065f2644a2cSMark Brown if ((K % 10) >= 5) 1066f2644a2cSMark Brown K += 5; 1067f2644a2cSMark Brown 1068f2644a2cSMark Brown /* Move down to proper range now rounding is done */ 1069f2644a2cSMark Brown K /= 10; 1070f2644a2cSMark Brown 1071f2644a2cSMark Brown pll_div->k = K; 1072f2644a2cSMark Brown 1073f2644a2cSMark Brown pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n", 1074f2644a2cSMark Brown pll_div->n, pll_div->k, pll_div->pre_div); 1075f2644a2cSMark Brown 1076f2644a2cSMark Brown return 0; 1077f2644a2cSMark Brown } 1078f2644a2cSMark Brown 10793176bf2dSZidan Wang static int wm8960_set_pll(struct snd_soc_codec *codec, 10803176bf2dSZidan Wang unsigned int freq_in, unsigned int freq_out) 1081f2644a2cSMark Brown { 1082f2644a2cSMark Brown u16 reg; 1083f2644a2cSMark Brown static struct _pll_div pll_div; 1084f2644a2cSMark Brown int ret; 1085f2644a2cSMark Brown 1086f2644a2cSMark Brown if (freq_in && freq_out) { 1087f2644a2cSMark Brown ret = pll_factors(freq_in, freq_out, &pll_div); 1088f2644a2cSMark Brown if (ret != 0) 1089f2644a2cSMark Brown return ret; 1090f2644a2cSMark Brown } 1091f2644a2cSMark Brown 1092f2644a2cSMark Brown /* Disable the PLL: even if we are changing the frequency the 1093f2644a2cSMark Brown * PLL needs to be disabled while we do so. */ 109416b24881SAxel Lin snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0); 109516b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0); 1096f2644a2cSMark Brown 1097f2644a2cSMark Brown if (!freq_in || !freq_out) 1098f2644a2cSMark Brown return 0; 1099f2644a2cSMark Brown 110017a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_PLL1) & ~0x3f; 1101f2644a2cSMark Brown reg |= pll_div.pre_div << 4; 1102f2644a2cSMark Brown reg |= pll_div.n; 1103f2644a2cSMark Brown 1104f2644a2cSMark Brown if (pll_div.k) { 1105f2644a2cSMark Brown reg |= 0x20; 1106f2644a2cSMark Brown 110785fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL2, (pll_div.k >> 16) & 0xff); 110885fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL3, (pll_div.k >> 8) & 0xff); 110985fa532bSMike Dyer snd_soc_write(codec, WM8960_PLL4, pll_div.k & 0xff); 1110f2644a2cSMark Brown } 111117a52fd6SMark Brown snd_soc_write(codec, WM8960_PLL1, reg); 1112f2644a2cSMark Brown 1113f2644a2cSMark Brown /* Turn it on */ 111416b24881SAxel Lin snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0x1); 1115f2644a2cSMark Brown msleep(250); 111616b24881SAxel Lin snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0x1); 1117f2644a2cSMark Brown 1118f2644a2cSMark Brown return 0; 1119f2644a2cSMark Brown } 1120f2644a2cSMark Brown 11213176bf2dSZidan Wang static int wm8960_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id, 11223176bf2dSZidan Wang int source, unsigned int freq_in, unsigned int freq_out) 11233176bf2dSZidan Wang { 11243176bf2dSZidan Wang struct snd_soc_codec *codec = codec_dai->codec; 11253176bf2dSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 11263176bf2dSZidan Wang 11273176bf2dSZidan Wang wm8960->freq_in = freq_in; 11283176bf2dSZidan Wang 11293176bf2dSZidan Wang if (pll_id == WM8960_SYSCLK_AUTO) 11303176bf2dSZidan Wang return 0; 11313176bf2dSZidan Wang 11323176bf2dSZidan Wang return wm8960_set_pll(codec, freq_in, freq_out); 11333176bf2dSZidan Wang } 11343176bf2dSZidan Wang 1135f2644a2cSMark Brown static int wm8960_set_dai_clkdiv(struct snd_soc_dai *codec_dai, 1136f2644a2cSMark Brown int div_id, int div) 1137f2644a2cSMark Brown { 1138f2644a2cSMark Brown struct snd_soc_codec *codec = codec_dai->codec; 1139f2644a2cSMark Brown u16 reg; 1140f2644a2cSMark Brown 1141f2644a2cSMark Brown switch (div_id) { 1142f2644a2cSMark Brown case WM8960_SYSCLKDIV: 114317a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1f9; 114417a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK1, reg | div); 1145f2644a2cSMark Brown break; 1146f2644a2cSMark Brown case WM8960_DACDIV: 114717a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1c7; 114817a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK1, reg | div); 1149f2644a2cSMark Brown break; 1150f2644a2cSMark Brown case WM8960_OPCLKDIV: 115117a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_PLL1) & 0x03f; 115217a52fd6SMark Brown snd_soc_write(codec, WM8960_PLL1, reg | div); 1153f2644a2cSMark Brown break; 1154f2644a2cSMark Brown case WM8960_DCLKDIV: 115517a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_CLOCK2) & 0x03f; 115617a52fd6SMark Brown snd_soc_write(codec, WM8960_CLOCK2, reg | div); 1157f2644a2cSMark Brown break; 1158f2644a2cSMark Brown case WM8960_TOCLKSEL: 115917a52fd6SMark Brown reg = snd_soc_read(codec, WM8960_ADDCTL1) & 0x1fd; 116017a52fd6SMark Brown snd_soc_write(codec, WM8960_ADDCTL1, reg | div); 1161f2644a2cSMark Brown break; 1162f2644a2cSMark Brown default: 1163f2644a2cSMark Brown return -EINVAL; 1164f2644a2cSMark Brown } 1165f2644a2cSMark Brown 1166f2644a2cSMark Brown return 0; 1167f2644a2cSMark Brown } 1168f2644a2cSMark Brown 1169f0fba2adSLiam Girdwood static int wm8960_set_bias_level(struct snd_soc_codec *codec, 1170f0fba2adSLiam Girdwood enum snd_soc_bias_level level) 1171f0fba2adSLiam Girdwood { 1172f0fba2adSLiam Girdwood struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 1173f0fba2adSLiam Girdwood 1174f0fba2adSLiam Girdwood return wm8960->set_bias_level(codec, level); 1175f0fba2adSLiam Girdwood } 1176f0fba2adSLiam Girdwood 11770e50b51aSZidan Wang static int wm8960_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id, 11780e50b51aSZidan Wang unsigned int freq, int dir) 11790e50b51aSZidan Wang { 11800e50b51aSZidan Wang struct snd_soc_codec *codec = dai->codec; 11810e50b51aSZidan Wang struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 11820e50b51aSZidan Wang 11830e50b51aSZidan Wang switch (clk_id) { 11840e50b51aSZidan Wang case WM8960_SYSCLK_MCLK: 11850e50b51aSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 11860e50b51aSZidan Wang 0x1, WM8960_SYSCLK_MCLK); 11870e50b51aSZidan Wang break; 11880e50b51aSZidan Wang case WM8960_SYSCLK_PLL: 11890e50b51aSZidan Wang snd_soc_update_bits(codec, WM8960_CLOCK1, 11900e50b51aSZidan Wang 0x1, WM8960_SYSCLK_PLL); 11910e50b51aSZidan Wang break; 11923176bf2dSZidan Wang case WM8960_SYSCLK_AUTO: 11933176bf2dSZidan Wang break; 11940e50b51aSZidan Wang default: 11950e50b51aSZidan Wang return -EINVAL; 11960e50b51aSZidan Wang } 11970e50b51aSZidan Wang 11980e50b51aSZidan Wang wm8960->sysclk = freq; 11993176bf2dSZidan Wang wm8960->clk_id = clk_id; 12000e50b51aSZidan Wang 12010e50b51aSZidan Wang return 0; 12020e50b51aSZidan Wang } 12030e50b51aSZidan Wang 1204f2644a2cSMark Brown #define WM8960_RATES SNDRV_PCM_RATE_8000_48000 1205f2644a2cSMark Brown 1206f2644a2cSMark Brown #define WM8960_FORMATS \ 1207f2644a2cSMark Brown (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \ 12087a8c7867SZidan Wang SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 1209f2644a2cSMark Brown 121085e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops wm8960_dai_ops = { 1211f2644a2cSMark Brown .hw_params = wm8960_hw_params, 12123176bf2dSZidan Wang .hw_free = wm8960_hw_free, 1213f2644a2cSMark Brown .digital_mute = wm8960_mute, 1214f2644a2cSMark Brown .set_fmt = wm8960_set_dai_fmt, 1215f2644a2cSMark Brown .set_clkdiv = wm8960_set_dai_clkdiv, 1216f2644a2cSMark Brown .set_pll = wm8960_set_dai_pll, 12170e50b51aSZidan Wang .set_sysclk = wm8960_set_dai_sysclk, 1218f2644a2cSMark Brown }; 1219f2644a2cSMark Brown 1220f0fba2adSLiam Girdwood static struct snd_soc_dai_driver wm8960_dai = { 1221f0fba2adSLiam Girdwood .name = "wm8960-hifi", 1222f2644a2cSMark Brown .playback = { 1223f2644a2cSMark Brown .stream_name = "Playback", 1224f2644a2cSMark Brown .channels_min = 1, 1225f2644a2cSMark Brown .channels_max = 2, 1226f2644a2cSMark Brown .rates = WM8960_RATES, 1227f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1228f2644a2cSMark Brown .capture = { 1229f2644a2cSMark Brown .stream_name = "Capture", 1230f2644a2cSMark Brown .channels_min = 1, 1231f2644a2cSMark Brown .channels_max = 2, 1232f2644a2cSMark Brown .rates = WM8960_RATES, 1233f2644a2cSMark Brown .formats = WM8960_FORMATS,}, 1234f2644a2cSMark Brown .ops = &wm8960_dai_ops, 1235f2644a2cSMark Brown .symmetric_rates = 1, 1236f2644a2cSMark Brown }; 1237f2644a2cSMark Brown 1238f0fba2adSLiam Girdwood static int wm8960_probe(struct snd_soc_codec *codec) 1239f2644a2cSMark Brown { 1240f0fba2adSLiam Girdwood struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec); 1241e2280c90SZidan Wang struct wm8960_data *pdata = &wm8960->pdata; 1242f2644a2cSMark Brown 1243913d7b4cSMark Brown if (pdata->capless) 1244f0fba2adSLiam Girdwood wm8960->set_bias_level = wm8960_set_bias_level_capless; 1245e2280c90SZidan Wang else 1246e2280c90SZidan Wang wm8960->set_bias_level = wm8960_set_bias_level_out3; 1247f2644a2cSMark Brown 1248022658beSLiam Girdwood snd_soc_add_codec_controls(codec, wm8960_snd_controls, 1249f0fba2adSLiam Girdwood ARRAY_SIZE(wm8960_snd_controls)); 1250f0fba2adSLiam Girdwood wm8960_add_widgets(codec); 1251f2644a2cSMark Brown 1252f2644a2cSMark Brown return 0; 1253f2644a2cSMark Brown } 1254f2644a2cSMark Brown 1255f0fba2adSLiam Girdwood static struct snd_soc_codec_driver soc_codec_dev_wm8960 = { 1256f0fba2adSLiam Girdwood .probe = wm8960_probe, 1257f0fba2adSLiam Girdwood .set_bias_level = wm8960_set_bias_level, 12580a87a6e1SLars-Peter Clausen .suspend_bias_off = true, 12590ebe36c6SMark Brown }; 12600ebe36c6SMark Brown 12610ebe36c6SMark Brown static const struct regmap_config wm8960_regmap = { 12620ebe36c6SMark Brown .reg_bits = 7, 12630ebe36c6SMark Brown .val_bits = 9, 12640ebe36c6SMark Brown .max_register = WM8960_PLL4, 12650ebe36c6SMark Brown 12660ebe36c6SMark Brown .reg_defaults = wm8960_reg_defaults, 12670ebe36c6SMark Brown .num_reg_defaults = ARRAY_SIZE(wm8960_reg_defaults), 12680ebe36c6SMark Brown .cache_type = REGCACHE_RBTREE, 12690ebe36c6SMark Brown 12700ebe36c6SMark Brown .volatile_reg = wm8960_volatile, 1271f0fba2adSLiam Girdwood }; 1272f0fba2adSLiam Girdwood 1273e2280c90SZidan Wang static void wm8960_set_pdata_from_of(struct i2c_client *i2c, 1274e2280c90SZidan Wang struct wm8960_data *pdata) 1275e2280c90SZidan Wang { 1276e2280c90SZidan Wang const struct device_node *np = i2c->dev.of_node; 1277e2280c90SZidan Wang 1278e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,capless")) 1279e2280c90SZidan Wang pdata->capless = true; 1280e2280c90SZidan Wang 1281e2280c90SZidan Wang if (of_property_read_bool(np, "wlf,shared-lrclk")) 1282e2280c90SZidan Wang pdata->shared_lrclk = true; 1283e2280c90SZidan Wang } 1284e2280c90SZidan Wang 12857a79e94eSBill Pemberton static int wm8960_i2c_probe(struct i2c_client *i2c, 1286f2644a2cSMark Brown const struct i2c_device_id *id) 1287f2644a2cSMark Brown { 128837061631SMark Brown struct wm8960_data *pdata = dev_get_platdata(&i2c->dev); 1289f2644a2cSMark Brown struct wm8960_priv *wm8960; 1290f0fba2adSLiam Girdwood int ret; 1291f2644a2cSMark Brown 1292b9791c01SMark Brown wm8960 = devm_kzalloc(&i2c->dev, sizeof(struct wm8960_priv), 1293b9791c01SMark Brown GFP_KERNEL); 1294f2644a2cSMark Brown if (wm8960 == NULL) 1295f2644a2cSMark Brown return -ENOMEM; 1296f2644a2cSMark Brown 129775aa8868SZidan Wang wm8960->mclk = devm_clk_get(&i2c->dev, "mclk"); 129875aa8868SZidan Wang if (IS_ERR(wm8960->mclk)) { 129975aa8868SZidan Wang if (PTR_ERR(wm8960->mclk) == -EPROBE_DEFER) 130075aa8868SZidan Wang return -EPROBE_DEFER; 130175aa8868SZidan Wang } 130275aa8868SZidan Wang 1303c5e6f5faSSachin Kamat wm8960->regmap = devm_regmap_init_i2c(i2c, &wm8960_regmap); 13040ebe36c6SMark Brown if (IS_ERR(wm8960->regmap)) 13050ebe36c6SMark Brown return PTR_ERR(wm8960->regmap); 13060ebe36c6SMark Brown 1307e2280c90SZidan Wang if (pdata) 1308e2280c90SZidan Wang memcpy(&wm8960->pdata, pdata, sizeof(struct wm8960_data)); 1309e2280c90SZidan Wang else if (i2c->dev.of_node) 1310e2280c90SZidan Wang wm8960_set_pdata_from_of(i2c, &wm8960->pdata); 1311e2280c90SZidan Wang 13123ad5e861SZidan Wang ret = wm8960_reset(wm8960->regmap); 13133ad5e861SZidan Wang if (ret != 0) { 13143ad5e861SZidan Wang dev_err(&i2c->dev, "Failed to issue reset\n"); 13153ad5e861SZidan Wang return ret; 13163ad5e861SZidan Wang } 13173ad5e861SZidan Wang 13183ad5e861SZidan Wang if (wm8960->pdata.shared_lrclk) { 131937061631SMark Brown ret = regmap_update_bits(wm8960->regmap, WM8960_ADDCTL2, 132037061631SMark Brown 0x4, 0x4); 132137061631SMark Brown if (ret != 0) { 132237061631SMark Brown dev_err(&i2c->dev, "Failed to enable LRCM: %d\n", 132337061631SMark Brown ret); 132437061631SMark Brown return ret; 132537061631SMark Brown } 132637061631SMark Brown } 132737061631SMark Brown 13283ad5e861SZidan Wang /* Latch the update bits */ 13293ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LINVOL, 0x100, 0x100); 13303ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RINVOL, 0x100, 0x100); 13313ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LADC, 0x100, 0x100); 13323ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RADC, 0x100, 0x100); 13333ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LDAC, 0x100, 0x100); 13343ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_RDAC, 0x100, 0x100); 13353ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT1, 0x100, 0x100); 13363ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT1, 0x100, 0x100); 13373ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_LOUT2, 0x100, 0x100); 13383ad5e861SZidan Wang regmap_update_bits(wm8960->regmap, WM8960_ROUT2, 0x100, 0x100); 13393ad5e861SZidan Wang 1340f2644a2cSMark Brown i2c_set_clientdata(i2c, wm8960); 1341f2644a2cSMark Brown 1342f0fba2adSLiam Girdwood ret = snd_soc_register_codec(&i2c->dev, 1343f0fba2adSLiam Girdwood &soc_codec_dev_wm8960, &wm8960_dai, 1); 1344b9791c01SMark Brown 1345f0fba2adSLiam Girdwood return ret; 1346f2644a2cSMark Brown } 1347f2644a2cSMark Brown 13487a79e94eSBill Pemberton static int wm8960_i2c_remove(struct i2c_client *client) 1349f2644a2cSMark Brown { 1350f0fba2adSLiam Girdwood snd_soc_unregister_codec(&client->dev); 1351f2644a2cSMark Brown return 0; 1352f2644a2cSMark Brown } 1353f2644a2cSMark Brown 1354f2644a2cSMark Brown static const struct i2c_device_id wm8960_i2c_id[] = { 1355f2644a2cSMark Brown { "wm8960", 0 }, 1356f2644a2cSMark Brown { } 1357f2644a2cSMark Brown }; 1358f2644a2cSMark Brown MODULE_DEVICE_TABLE(i2c, wm8960_i2c_id); 1359f2644a2cSMark Brown 1360e2280c90SZidan Wang static const struct of_device_id wm8960_of_match[] = { 1361e2280c90SZidan Wang { .compatible = "wlf,wm8960", }, 1362e2280c90SZidan Wang { } 1363e2280c90SZidan Wang }; 1364e2280c90SZidan Wang MODULE_DEVICE_TABLE(of, wm8960_of_match); 1365e2280c90SZidan Wang 1366f2644a2cSMark Brown static struct i2c_driver wm8960_i2c_driver = { 1367f2644a2cSMark Brown .driver = { 1368091edccfSMark Brown .name = "wm8960", 1369e2280c90SZidan Wang .of_match_table = wm8960_of_match, 1370f2644a2cSMark Brown }, 1371f2644a2cSMark Brown .probe = wm8960_i2c_probe, 13727a79e94eSBill Pemberton .remove = wm8960_i2c_remove, 1373f2644a2cSMark Brown .id_table = wm8960_i2c_id, 1374f2644a2cSMark Brown }; 1375f2644a2cSMark Brown 13763c010e60SSachin Kamat module_i2c_driver(wm8960_i2c_driver); 1377f2644a2cSMark Brown 1378f2644a2cSMark Brown MODULE_DESCRIPTION("ASoC WM8960 driver"); 1379f2644a2cSMark Brown MODULE_AUTHOR("Liam Girdwood"); 1380f2644a2cSMark Brown MODULE_LICENSE("GPL"); 1381