Linux Audio

Check our new training course

Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * max98095.c -- MAX98095 ALSA SoC Audio driver
   4 *
   5 * Copyright 2011 Maxim Integrated Products
 
 
 
 
   6 */
   7
   8#include <linux/module.h>
   9#include <linux/moduleparam.h>
  10#include <linux/kernel.h>
  11#include <linux/init.h>
  12#include <linux/delay.h>
  13#include <linux/pm.h>
  14#include <linux/i2c.h>
  15#include <linux/clk.h>
  16#include <linux/mutex.h>
  17#include <sound/core.h>
  18#include <sound/pcm.h>
  19#include <sound/pcm_params.h>
  20#include <sound/soc.h>
  21#include <sound/initval.h>
  22#include <sound/tlv.h>
  23#include <linux/slab.h>
  24#include <asm/div64.h>
  25#include <sound/max98095.h>
  26#include <sound/jack.h>
  27#include "max98095.h"
  28
  29enum max98095_type {
  30	MAX98095,
  31};
  32
  33struct max98095_cdata {
  34	unsigned int rate;
  35	unsigned int fmt;
  36	int eq_sel;
  37	int bq_sel;
  38};
  39
  40struct max98095_priv {
  41	struct regmap *regmap;
  42	enum max98095_type devtype;
 
  43	struct max98095_pdata *pdata;
  44	struct clk *mclk;
  45	unsigned int sysclk;
  46	struct max98095_cdata dai[3];
  47	const char **eq_texts;
  48	const char **bq_texts;
  49	struct soc_enum eq_enum;
  50	struct soc_enum bq_enum;
  51	int eq_textcnt;
  52	int bq_textcnt;
  53	u8 lin_state;
  54	unsigned int mic1pre;
  55	unsigned int mic2pre;
  56	struct snd_soc_jack *headphone_jack;
  57	struct snd_soc_jack *mic_jack;
  58	struct mutex lock;
  59};
  60
  61static const struct reg_default max98095_reg_def[] = {
  62	{  0xf, 0x00 }, /* 0F */
  63	{ 0x10, 0x00 }, /* 10 */
  64	{ 0x11, 0x00 }, /* 11 */
  65	{ 0x12, 0x00 }, /* 12 */
  66	{ 0x13, 0x00 }, /* 13 */
  67	{ 0x14, 0x00 }, /* 14 */
  68	{ 0x15, 0x00 }, /* 15 */
  69	{ 0x16, 0x00 }, /* 16 */
  70	{ 0x17, 0x00 }, /* 17 */
  71	{ 0x18, 0x00 }, /* 18 */
  72	{ 0x19, 0x00 }, /* 19 */
  73	{ 0x1a, 0x00 }, /* 1A */
  74	{ 0x1b, 0x00 }, /* 1B */
  75	{ 0x1c, 0x00 }, /* 1C */
  76	{ 0x1d, 0x00 }, /* 1D */
  77	{ 0x1e, 0x00 }, /* 1E */
  78	{ 0x1f, 0x00 }, /* 1F */
  79	{ 0x20, 0x00 }, /* 20 */
  80	{ 0x21, 0x00 }, /* 21 */
  81	{ 0x22, 0x00 }, /* 22 */
  82	{ 0x23, 0x00 }, /* 23 */
  83	{ 0x24, 0x00 }, /* 24 */
  84	{ 0x25, 0x00 }, /* 25 */
  85	{ 0x26, 0x00 }, /* 26 */
  86	{ 0x27, 0x00 }, /* 27 */
  87	{ 0x28, 0x00 }, /* 28 */
  88	{ 0x29, 0x00 }, /* 29 */
  89	{ 0x2a, 0x00 }, /* 2A */
  90	{ 0x2b, 0x00 }, /* 2B */
  91	{ 0x2c, 0x00 }, /* 2C */
  92	{ 0x2d, 0x00 }, /* 2D */
  93	{ 0x2e, 0x00 }, /* 2E */
  94	{ 0x2f, 0x00 }, /* 2F */
  95	{ 0x30, 0x00 }, /* 30 */
  96	{ 0x31, 0x00 }, /* 31 */
  97	{ 0x32, 0x00 }, /* 32 */
  98	{ 0x33, 0x00 }, /* 33 */
  99	{ 0x34, 0x00 }, /* 34 */
 100	{ 0x35, 0x00 }, /* 35 */
 101	{ 0x36, 0x00 }, /* 36 */
 102	{ 0x37, 0x00 }, /* 37 */
 103	{ 0x38, 0x00 }, /* 38 */
 104	{ 0x39, 0x00 }, /* 39 */
 105	{ 0x3a, 0x00 }, /* 3A */
 106	{ 0x3b, 0x00 }, /* 3B */
 107	{ 0x3c, 0x00 }, /* 3C */
 108	{ 0x3d, 0x00 }, /* 3D */
 109	{ 0x3e, 0x00 }, /* 3E */
 110	{ 0x3f, 0x00 }, /* 3F */
 111	{ 0x40, 0x00 }, /* 40 */
 112	{ 0x41, 0x00 }, /* 41 */
 113	{ 0x42, 0x00 }, /* 42 */
 114	{ 0x43, 0x00 }, /* 43 */
 115	{ 0x44, 0x00 }, /* 44 */
 116	{ 0x45, 0x00 }, /* 45 */
 117	{ 0x46, 0x00 }, /* 46 */
 118	{ 0x47, 0x00 }, /* 47 */
 119	{ 0x48, 0x00 }, /* 48 */
 120	{ 0x49, 0x00 }, /* 49 */
 121	{ 0x4a, 0x00 }, /* 4A */
 122	{ 0x4b, 0x00 }, /* 4B */
 123	{ 0x4c, 0x00 }, /* 4C */
 124	{ 0x4d, 0x00 }, /* 4D */
 125	{ 0x4e, 0x00 }, /* 4E */
 126	{ 0x4f, 0x00 }, /* 4F */
 127	{ 0x50, 0x00 }, /* 50 */
 128	{ 0x51, 0x00 }, /* 51 */
 129	{ 0x52, 0x00 }, /* 52 */
 130	{ 0x53, 0x00 }, /* 53 */
 131	{ 0x54, 0x00 }, /* 54 */
 132	{ 0x55, 0x00 }, /* 55 */
 133	{ 0x56, 0x00 }, /* 56 */
 134	{ 0x57, 0x00 }, /* 57 */
 135	{ 0x58, 0x00 }, /* 58 */
 136	{ 0x59, 0x00 }, /* 59 */
 137	{ 0x5a, 0x00 }, /* 5A */
 138	{ 0x5b, 0x00 }, /* 5B */
 139	{ 0x5c, 0x00 }, /* 5C */
 140	{ 0x5d, 0x00 }, /* 5D */
 141	{ 0x5e, 0x00 }, /* 5E */
 142	{ 0x5f, 0x00 }, /* 5F */
 143	{ 0x60, 0x00 }, /* 60 */
 144	{ 0x61, 0x00 }, /* 61 */
 145	{ 0x62, 0x00 }, /* 62 */
 146	{ 0x63, 0x00 }, /* 63 */
 147	{ 0x64, 0x00 }, /* 64 */
 148	{ 0x65, 0x00 }, /* 65 */
 149	{ 0x66, 0x00 }, /* 66 */
 150	{ 0x67, 0x00 }, /* 67 */
 151	{ 0x68, 0x00 }, /* 68 */
 152	{ 0x69, 0x00 }, /* 69 */
 153	{ 0x6a, 0x00 }, /* 6A */
 154	{ 0x6b, 0x00 }, /* 6B */
 155	{ 0x6c, 0x00 }, /* 6C */
 156	{ 0x6d, 0x00 }, /* 6D */
 157	{ 0x6e, 0x00 }, /* 6E */
 158	{ 0x6f, 0x00 }, /* 6F */
 159	{ 0x70, 0x00 }, /* 70 */
 160	{ 0x71, 0x00 }, /* 71 */
 161	{ 0x72, 0x00 }, /* 72 */
 162	{ 0x73, 0x00 }, /* 73 */
 163	{ 0x74, 0x00 }, /* 74 */
 164	{ 0x75, 0x00 }, /* 75 */
 165	{ 0x76, 0x00 }, /* 76 */
 166	{ 0x77, 0x00 }, /* 77 */
 167	{ 0x78, 0x00 }, /* 78 */
 168	{ 0x79, 0x00 }, /* 79 */
 169	{ 0x7a, 0x00 }, /* 7A */
 170	{ 0x7b, 0x00 }, /* 7B */
 171	{ 0x7c, 0x00 }, /* 7C */
 172	{ 0x7d, 0x00 }, /* 7D */
 173	{ 0x7e, 0x00 }, /* 7E */
 174	{ 0x7f, 0x00 }, /* 7F */
 175	{ 0x80, 0x00 }, /* 80 */
 176	{ 0x81, 0x00 }, /* 81 */
 177	{ 0x82, 0x00 }, /* 82 */
 178	{ 0x83, 0x00 }, /* 83 */
 179	{ 0x84, 0x00 }, /* 84 */
 180	{ 0x85, 0x00 }, /* 85 */
 181	{ 0x86, 0x00 }, /* 86 */
 182	{ 0x87, 0x00 }, /* 87 */
 183	{ 0x88, 0x00 }, /* 88 */
 184	{ 0x89, 0x00 }, /* 89 */
 185	{ 0x8a, 0x00 }, /* 8A */
 186	{ 0x8b, 0x00 }, /* 8B */
 187	{ 0x8c, 0x00 }, /* 8C */
 188	{ 0x8d, 0x00 }, /* 8D */
 189	{ 0x8e, 0x00 }, /* 8E */
 190	{ 0x8f, 0x00 }, /* 8F */
 191	{ 0x90, 0x00 }, /* 90 */
 192	{ 0x91, 0x00 }, /* 91 */
 193	{ 0x92, 0x30 }, /* 92 */
 194	{ 0x93, 0xF0 }, /* 93 */
 195	{ 0x94, 0x00 }, /* 94 */
 196	{ 0x95, 0x00 }, /* 95 */
 197	{ 0x96, 0x3F }, /* 96 */
 198	{ 0x97, 0x00 }, /* 97 */
 199	{ 0xff, 0x00 }, /* FF */
 200};
 201
 202static bool max98095_readable(struct device *dev, unsigned int reg)
 203{
 204	switch (reg) {
 205	case M98095_001_HOST_INT_STS ... M98095_097_PWR_SYS:
 206	case M98095_0FF_REV_ID:
 207		return true;
 208	default:
 209		return false;
 210	}
 211}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 212
 213static bool max98095_writeable(struct device *dev, unsigned int reg)
 214{
 215	switch (reg) {
 216	case M98095_00F_HOST_CFG ... M98095_097_PWR_SYS:
 217		return true;
 218	default:
 219		return false;
 220	}
 221}
 222
 223static bool max98095_volatile(struct device *dev, unsigned int reg)
 224{
 
 
 
 225	switch (reg) {
 226	case M98095_000_HOST_DATA ... M98095_00E_TEMP_SENSOR_STS:
 227	case M98095_REG_MAX_CACHED + 1 ... M98095_0FF_REV_ID:
 228		return true;
 229	default:
 230		return false;
 
 
 
 
 
 
 
 
 
 
 
 231	}
 232}
 233
 234static const struct regmap_config max98095_regmap = {
 235	.reg_bits = 8,
 236	.val_bits = 8,
 237
 238	.reg_defaults = max98095_reg_def,
 239	.num_reg_defaults = ARRAY_SIZE(max98095_reg_def),
 240	.max_register = M98095_0FF_REV_ID,
 241	.cache_type = REGCACHE_RBTREE,
 
 
 
 
 
 242
 243	.readable_reg = max98095_readable,
 244	.writeable_reg = max98095_writeable,
 245	.volatile_reg = max98095_volatile,
 246};
 
 
 
 247
 248/*
 249 * Load equalizer DSP coefficient configurations registers
 250 */
 251static void m98095_eq_band(struct snd_soc_component *component, unsigned int dai,
 252		    unsigned int band, u16 *coefs)
 253{
 254	unsigned int eq_reg;
 255	unsigned int i;
 256
 257	if (WARN_ON(band > 4) ||
 258	    WARN_ON(dai > 1))
 259		return;
 260
 261	/* Load the base register address */
 262	eq_reg = dai ? M98095_142_DAI2_EQ_BASE : M98095_110_DAI1_EQ_BASE;
 263
 264	/* Add the band address offset, note adjustment for word address */
 265	eq_reg += band * (M98095_COEFS_PER_BAND << 1);
 266
 267	/* Step through the registers and coefs */
 268	for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
 269		snd_soc_component_write(component, eq_reg++, M98095_BYTE1(coefs[i]));
 270		snd_soc_component_write(component, eq_reg++, M98095_BYTE0(coefs[i]));
 271	}
 272}
 273
 274/*
 275 * Load biquad filter coefficient configurations registers
 276 */
 277static void m98095_biquad_band(struct snd_soc_component *component, unsigned int dai,
 278		    unsigned int band, u16 *coefs)
 279{
 280	unsigned int bq_reg;
 281	unsigned int i;
 282
 283	if (WARN_ON(band > 1) ||
 284	    WARN_ON(dai > 1))
 285		return;
 286
 287	/* Load the base register address */
 288	bq_reg = dai ? M98095_17E_DAI2_BQ_BASE : M98095_174_DAI1_BQ_BASE;
 289
 290	/* Add the band address offset, note adjustment for word address */
 291	bq_reg += band * (M98095_COEFS_PER_BAND << 1);
 292
 293	/* Step through the registers and coefs */
 294	for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
 295		snd_soc_component_write(component, bq_reg++, M98095_BYTE1(coefs[i]));
 296		snd_soc_component_write(component, bq_reg++, M98095_BYTE0(coefs[i]));
 297	}
 298}
 299
 300static const char * const max98095_fltr_mode[] = { "Voice", "Music" };
 301static SOC_ENUM_SINGLE_DECL(max98095_dai1_filter_mode_enum,
 302			    M98095_02E_DAI1_FILTERS, 7,
 303			    max98095_fltr_mode);
 304static SOC_ENUM_SINGLE_DECL(max98095_dai2_filter_mode_enum,
 305			    M98095_038_DAI2_FILTERS, 7,
 306			    max98095_fltr_mode);
 307
 308static const char * const max98095_extmic_text[] = { "None", "MIC1", "MIC2" };
 309
 310static SOC_ENUM_SINGLE_DECL(max98095_extmic_enum,
 311			    M98095_087_CFG_MIC, 0,
 312			    max98095_extmic_text);
 313
 314static const struct snd_kcontrol_new max98095_extmic_mux =
 315	SOC_DAPM_ENUM("External MIC Mux", max98095_extmic_enum);
 316
 317static const char * const max98095_linein_text[] = { "INA", "INB" };
 318
 319static SOC_ENUM_SINGLE_DECL(max98095_linein_enum,
 320			    M98095_086_CFG_LINE, 6,
 321			    max98095_linein_text);
 322
 323static const struct snd_kcontrol_new max98095_linein_mux =
 324	SOC_DAPM_ENUM("Linein Input Mux", max98095_linein_enum);
 325
 326static const char * const max98095_line_mode_text[] = {
 327	"Stereo", "Differential"};
 328
 329static SOC_ENUM_SINGLE_DECL(max98095_linein_mode_enum,
 330			    M98095_086_CFG_LINE, 7,
 331			    max98095_line_mode_text);
 332
 333static SOC_ENUM_SINGLE_DECL(max98095_lineout_mode_enum,
 334			    M98095_086_CFG_LINE, 4,
 335			    max98095_line_mode_text);
 336
 337static const char * const max98095_dai_fltr[] = {
 338	"Off", "Elliptical-HPF-16k", "Butterworth-HPF-16k",
 339	"Elliptical-HPF-8k", "Butterworth-HPF-8k", "Butterworth-HPF-Fs/240"};
 340static SOC_ENUM_SINGLE_DECL(max98095_dai1_dac_filter_enum,
 341			    M98095_02E_DAI1_FILTERS, 0,
 342			    max98095_dai_fltr);
 343static SOC_ENUM_SINGLE_DECL(max98095_dai2_dac_filter_enum,
 344			    M98095_038_DAI2_FILTERS, 0,
 345			    max98095_dai_fltr);
 346static SOC_ENUM_SINGLE_DECL(max98095_dai3_dac_filter_enum,
 347			    M98095_042_DAI3_FILTERS, 0,
 348			    max98095_dai_fltr);
 349
 350static int max98095_mic1pre_set(struct snd_kcontrol *kcontrol,
 351				struct snd_ctl_elem_value *ucontrol)
 352{
 353	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 354	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 355	unsigned int sel = ucontrol->value.integer.value[0];
 356
 357	max98095->mic1pre = sel;
 358	snd_soc_component_update_bits(component, M98095_05F_LVL_MIC1, M98095_MICPRE_MASK,
 359		(1+sel)<<M98095_MICPRE_SHIFT);
 360
 361	return 0;
 362}
 363
 364static int max98095_mic1pre_get(struct snd_kcontrol *kcontrol,
 365				struct snd_ctl_elem_value *ucontrol)
 366{
 367	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 368	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 369
 370	ucontrol->value.integer.value[0] = max98095->mic1pre;
 371	return 0;
 372}
 373
 374static int max98095_mic2pre_set(struct snd_kcontrol *kcontrol,
 375				struct snd_ctl_elem_value *ucontrol)
 376{
 377	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 378	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 379	unsigned int sel = ucontrol->value.integer.value[0];
 380
 381	max98095->mic2pre = sel;
 382	snd_soc_component_update_bits(component, M98095_060_LVL_MIC2, M98095_MICPRE_MASK,
 383		(1+sel)<<M98095_MICPRE_SHIFT);
 384
 385	return 0;
 386}
 387
 388static int max98095_mic2pre_get(struct snd_kcontrol *kcontrol,
 389				struct snd_ctl_elem_value *ucontrol)
 390{
 391	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 392	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 393
 394	ucontrol->value.integer.value[0] = max98095->mic2pre;
 395	return 0;
 396}
 397
 398static const DECLARE_TLV_DB_RANGE(max98095_micboost_tlv,
 
 399	0, 1, TLV_DB_SCALE_ITEM(0, 2000, 0),
 400	2, 2, TLV_DB_SCALE_ITEM(3000, 0, 0)
 401);
 402
 403static const DECLARE_TLV_DB_SCALE(max98095_mic_tlv, 0, 100, 0);
 404static const DECLARE_TLV_DB_SCALE(max98095_adc_tlv, -1200, 100, 0);
 405static const DECLARE_TLV_DB_SCALE(max98095_adcboost_tlv, 0, 600, 0);
 406
 407static const DECLARE_TLV_DB_RANGE(max98095_hp_tlv,
 
 408	0, 6, TLV_DB_SCALE_ITEM(-6700, 400, 0),
 409	7, 14, TLV_DB_SCALE_ITEM(-4000, 300, 0),
 410	15, 21, TLV_DB_SCALE_ITEM(-1700, 200, 0),
 411	22, 27, TLV_DB_SCALE_ITEM(-400, 100, 0),
 412	28, 31, TLV_DB_SCALE_ITEM(150, 50, 0)
 413);
 414
 415static const DECLARE_TLV_DB_RANGE(max98095_spk_tlv,
 
 416	0, 10, TLV_DB_SCALE_ITEM(-5900, 400, 0),
 417	11, 18, TLV_DB_SCALE_ITEM(-1700, 200, 0),
 418	19, 27, TLV_DB_SCALE_ITEM(-200, 100, 0),
 419	28, 39, TLV_DB_SCALE_ITEM(650, 50, 0)
 420);
 421
 422static const DECLARE_TLV_DB_RANGE(max98095_rcv_lout_tlv,
 
 423	0, 6, TLV_DB_SCALE_ITEM(-6200, 400, 0),
 424	7, 14, TLV_DB_SCALE_ITEM(-3500, 300, 0),
 425	15, 21, TLV_DB_SCALE_ITEM(-1200, 200, 0),
 426	22, 27, TLV_DB_SCALE_ITEM(100, 100, 0),
 427	28, 31, TLV_DB_SCALE_ITEM(650, 50, 0)
 428);
 429
 430static const DECLARE_TLV_DB_RANGE(max98095_lin_tlv,
 
 431	0, 2, TLV_DB_SCALE_ITEM(-600, 300, 0),
 432	3, 3, TLV_DB_SCALE_ITEM(300, 1100, 0),
 433	4, 5, TLV_DB_SCALE_ITEM(1400, 600, 0)
 434);
 435
 436static const struct snd_kcontrol_new max98095_snd_controls[] = {
 437
 438	SOC_DOUBLE_R_TLV("Headphone Volume", M98095_064_LVL_HP_L,
 439		M98095_065_LVL_HP_R, 0, 31, 0, max98095_hp_tlv),
 440
 441	SOC_DOUBLE_R_TLV("Speaker Volume", M98095_067_LVL_SPK_L,
 442		M98095_068_LVL_SPK_R, 0, 39, 0, max98095_spk_tlv),
 443
 444	SOC_SINGLE_TLV("Receiver Volume", M98095_066_LVL_RCV,
 445		0, 31, 0, max98095_rcv_lout_tlv),
 446
 447	SOC_DOUBLE_R_TLV("Lineout Volume", M98095_062_LVL_LINEOUT1,
 448		M98095_063_LVL_LINEOUT2, 0, 31, 0, max98095_rcv_lout_tlv),
 449
 450	SOC_DOUBLE_R("Headphone Switch", M98095_064_LVL_HP_L,
 451		M98095_065_LVL_HP_R, 7, 1, 1),
 452
 453	SOC_DOUBLE_R("Speaker Switch", M98095_067_LVL_SPK_L,
 454		M98095_068_LVL_SPK_R, 7, 1, 1),
 455
 456	SOC_SINGLE("Receiver Switch", M98095_066_LVL_RCV, 7, 1, 1),
 457
 458	SOC_DOUBLE_R("Lineout Switch", M98095_062_LVL_LINEOUT1,
 459		M98095_063_LVL_LINEOUT2, 7, 1, 1),
 460
 461	SOC_SINGLE_TLV("MIC1 Volume", M98095_05F_LVL_MIC1, 0, 20, 1,
 462		max98095_mic_tlv),
 463
 464	SOC_SINGLE_TLV("MIC2 Volume", M98095_060_LVL_MIC2, 0, 20, 1,
 465		max98095_mic_tlv),
 466
 467	SOC_SINGLE_EXT_TLV("MIC1 Boost Volume",
 468			M98095_05F_LVL_MIC1, 5, 2, 0,
 469			max98095_mic1pre_get, max98095_mic1pre_set,
 470			max98095_micboost_tlv),
 471	SOC_SINGLE_EXT_TLV("MIC2 Boost Volume",
 472			M98095_060_LVL_MIC2, 5, 2, 0,
 473			max98095_mic2pre_get, max98095_mic2pre_set,
 474			max98095_micboost_tlv),
 475
 476	SOC_SINGLE_TLV("Linein Volume", M98095_061_LVL_LINEIN, 0, 5, 1,
 477		max98095_lin_tlv),
 478
 479	SOC_SINGLE_TLV("ADCL Volume", M98095_05D_LVL_ADC_L, 0, 15, 1,
 480		max98095_adc_tlv),
 481	SOC_SINGLE_TLV("ADCR Volume", M98095_05E_LVL_ADC_R, 0, 15, 1,
 482		max98095_adc_tlv),
 483
 484	SOC_SINGLE_TLV("ADCL Boost Volume", M98095_05D_LVL_ADC_L, 4, 3, 0,
 485		max98095_adcboost_tlv),
 486	SOC_SINGLE_TLV("ADCR Boost Volume", M98095_05E_LVL_ADC_R, 4, 3, 0,
 487		max98095_adcboost_tlv),
 488
 489	SOC_SINGLE("EQ1 Switch", M98095_088_CFG_LEVEL, 0, 1, 0),
 490	SOC_SINGLE("EQ2 Switch", M98095_088_CFG_LEVEL, 1, 1, 0),
 491
 492	SOC_SINGLE("Biquad1 Switch", M98095_088_CFG_LEVEL, 2, 1, 0),
 493	SOC_SINGLE("Biquad2 Switch", M98095_088_CFG_LEVEL, 3, 1, 0),
 494
 495	SOC_ENUM("DAI1 Filter Mode", max98095_dai1_filter_mode_enum),
 496	SOC_ENUM("DAI2 Filter Mode", max98095_dai2_filter_mode_enum),
 497	SOC_ENUM("DAI1 DAC Filter", max98095_dai1_dac_filter_enum),
 498	SOC_ENUM("DAI2 DAC Filter", max98095_dai2_dac_filter_enum),
 499	SOC_ENUM("DAI3 DAC Filter", max98095_dai3_dac_filter_enum),
 500
 501	SOC_ENUM("Linein Mode", max98095_linein_mode_enum),
 502	SOC_ENUM("Lineout Mode", max98095_lineout_mode_enum),
 503};
 504
 505/* Left speaker mixer switch */
 506static const struct snd_kcontrol_new max98095_left_speaker_mixer_controls[] = {
 507	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_050_MIX_SPK_LEFT, 0, 1, 0),
 508	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_050_MIX_SPK_LEFT, 6, 1, 0),
 509	SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
 510	SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
 511	SOC_DAPM_SINGLE("MIC1 Switch", M98095_050_MIX_SPK_LEFT, 4, 1, 0),
 512	SOC_DAPM_SINGLE("MIC2 Switch", M98095_050_MIX_SPK_LEFT, 5, 1, 0),
 513	SOC_DAPM_SINGLE("IN1 Switch", M98095_050_MIX_SPK_LEFT, 1, 1, 0),
 514	SOC_DAPM_SINGLE("IN2 Switch", M98095_050_MIX_SPK_LEFT, 2, 1, 0),
 515};
 516
 517/* Right speaker mixer switch */
 518static const struct snd_kcontrol_new max98095_right_speaker_mixer_controls[] = {
 519	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 6, 1, 0),
 520	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 0, 1, 0),
 521	SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
 522	SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
 523	SOC_DAPM_SINGLE("MIC1 Switch", M98095_051_MIX_SPK_RIGHT, 5, 1, 0),
 524	SOC_DAPM_SINGLE("MIC2 Switch", M98095_051_MIX_SPK_RIGHT, 4, 1, 0),
 525	SOC_DAPM_SINGLE("IN1 Switch", M98095_051_MIX_SPK_RIGHT, 1, 1, 0),
 526	SOC_DAPM_SINGLE("IN2 Switch", M98095_051_MIX_SPK_RIGHT, 2, 1, 0),
 527};
 528
 529/* Left headphone mixer switch */
 530static const struct snd_kcontrol_new max98095_left_hp_mixer_controls[] = {
 531	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04C_MIX_HP_LEFT, 0, 1, 0),
 532	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04C_MIX_HP_LEFT, 5, 1, 0),
 533	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04C_MIX_HP_LEFT, 3, 1, 0),
 534	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04C_MIX_HP_LEFT, 4, 1, 0),
 535	SOC_DAPM_SINGLE("IN1 Switch", M98095_04C_MIX_HP_LEFT, 1, 1, 0),
 536	SOC_DAPM_SINGLE("IN2 Switch", M98095_04C_MIX_HP_LEFT, 2, 1, 0),
 537};
 538
 539/* Right headphone mixer switch */
 540static const struct snd_kcontrol_new max98095_right_hp_mixer_controls[] = {
 541	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 5, 1, 0),
 542	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 0, 1, 0),
 543	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04D_MIX_HP_RIGHT, 3, 1, 0),
 544	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04D_MIX_HP_RIGHT, 4, 1, 0),
 545	SOC_DAPM_SINGLE("IN1 Switch", M98095_04D_MIX_HP_RIGHT, 1, 1, 0),
 546	SOC_DAPM_SINGLE("IN2 Switch", M98095_04D_MIX_HP_RIGHT, 2, 1, 0),
 547};
 548
 549/* Receiver earpiece mixer switch */
 550static const struct snd_kcontrol_new max98095_mono_rcv_mixer_controls[] = {
 551	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04F_MIX_RCV, 0, 1, 0),
 552	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04F_MIX_RCV, 5, 1, 0),
 553	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04F_MIX_RCV, 3, 1, 0),
 554	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04F_MIX_RCV, 4, 1, 0),
 555	SOC_DAPM_SINGLE("IN1 Switch", M98095_04F_MIX_RCV, 1, 1, 0),
 556	SOC_DAPM_SINGLE("IN2 Switch", M98095_04F_MIX_RCV, 2, 1, 0),
 557};
 558
 559/* Left lineout mixer switch */
 560static const struct snd_kcontrol_new max98095_left_lineout_mixer_controls[] = {
 561	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_053_MIX_LINEOUT1, 5, 1, 0),
 562	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_053_MIX_LINEOUT1, 0, 1, 0),
 563	SOC_DAPM_SINGLE("MIC1 Switch", M98095_053_MIX_LINEOUT1, 3, 1, 0),
 564	SOC_DAPM_SINGLE("MIC2 Switch", M98095_053_MIX_LINEOUT1, 4, 1, 0),
 565	SOC_DAPM_SINGLE("IN1 Switch", M98095_053_MIX_LINEOUT1, 1, 1, 0),
 566	SOC_DAPM_SINGLE("IN2 Switch", M98095_053_MIX_LINEOUT1, 2, 1, 0),
 567};
 568
 569/* Right lineout mixer switch */
 570static const struct snd_kcontrol_new max98095_right_lineout_mixer_controls[] = {
 571	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_054_MIX_LINEOUT2, 0, 1, 0),
 572	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_054_MIX_LINEOUT2, 5, 1, 0),
 573	SOC_DAPM_SINGLE("MIC1 Switch", M98095_054_MIX_LINEOUT2, 3, 1, 0),
 574	SOC_DAPM_SINGLE("MIC2 Switch", M98095_054_MIX_LINEOUT2, 4, 1, 0),
 575	SOC_DAPM_SINGLE("IN1 Switch", M98095_054_MIX_LINEOUT2, 1, 1, 0),
 576	SOC_DAPM_SINGLE("IN2 Switch", M98095_054_MIX_LINEOUT2, 2, 1, 0),
 577};
 578
 579/* Left ADC mixer switch */
 580static const struct snd_kcontrol_new max98095_left_ADC_mixer_controls[] = {
 581	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04A_MIX_ADC_LEFT, 7, 1, 0),
 582	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04A_MIX_ADC_LEFT, 6, 1, 0),
 583	SOC_DAPM_SINGLE("IN1 Switch", M98095_04A_MIX_ADC_LEFT, 3, 1, 0),
 584	SOC_DAPM_SINGLE("IN2 Switch", M98095_04A_MIX_ADC_LEFT, 2, 1, 0),
 585};
 586
 587/* Right ADC mixer switch */
 588static const struct snd_kcontrol_new max98095_right_ADC_mixer_controls[] = {
 589	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04B_MIX_ADC_RIGHT, 7, 1, 0),
 590	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04B_MIX_ADC_RIGHT, 6, 1, 0),
 591	SOC_DAPM_SINGLE("IN1 Switch", M98095_04B_MIX_ADC_RIGHT, 3, 1, 0),
 592	SOC_DAPM_SINGLE("IN2 Switch", M98095_04B_MIX_ADC_RIGHT, 2, 1, 0),
 593};
 594
 595static int max98095_mic_event(struct snd_soc_dapm_widget *w,
 596			     struct snd_kcontrol *kcontrol, int event)
 597{
 598	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 599	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 600
 601	switch (event) {
 602	case SND_SOC_DAPM_POST_PMU:
 603		if (w->reg == M98095_05F_LVL_MIC1) {
 604			snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK,
 605				(1+max98095->mic1pre)<<M98095_MICPRE_SHIFT);
 606		} else {
 607			snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK,
 608				(1+max98095->mic2pre)<<M98095_MICPRE_SHIFT);
 609		}
 610		break;
 611	case SND_SOC_DAPM_POST_PMD:
 612		snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK, 0);
 613		break;
 614	default:
 615		return -EINVAL;
 616	}
 617
 618	return 0;
 619}
 620
 621/*
 622 * The line inputs are stereo inputs with the left and right
 623 * channels sharing a common PGA power control signal.
 624 */
 625static int max98095_line_pga(struct snd_soc_dapm_widget *w,
 626			     int event, u8 channel)
 627{
 628	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 629	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 630	u8 *state;
 631
 632	if (WARN_ON(!(channel == 1 || channel == 2)))
 633		return -EINVAL;
 634
 635	state = &max98095->lin_state;
 636
 637	switch (event) {
 638	case SND_SOC_DAPM_POST_PMU:
 639		*state |= channel;
 640		snd_soc_component_update_bits(component, w->reg,
 641			(1 << w->shift), (1 << w->shift));
 642		break;
 643	case SND_SOC_DAPM_POST_PMD:
 644		*state &= ~channel;
 645		if (*state == 0) {
 646			snd_soc_component_update_bits(component, w->reg,
 647				(1 << w->shift), 0);
 648		}
 649		break;
 650	default:
 651		return -EINVAL;
 652	}
 653
 654	return 0;
 655}
 656
 657static int max98095_pga_in1_event(struct snd_soc_dapm_widget *w,
 658				   struct snd_kcontrol *k, int event)
 659{
 660	return max98095_line_pga(w, event, 1);
 661}
 662
 663static int max98095_pga_in2_event(struct snd_soc_dapm_widget *w,
 664				   struct snd_kcontrol *k, int event)
 665{
 666	return max98095_line_pga(w, event, 2);
 667}
 668
 669/*
 670 * The stereo line out mixer outputs to two stereo line outs.
 671 * The 2nd pair has a separate set of enables.
 672 */
 673static int max98095_lineout_event(struct snd_soc_dapm_widget *w,
 674			     struct snd_kcontrol *kcontrol, int event)
 675{
 676	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 677
 678	switch (event) {
 679	case SND_SOC_DAPM_POST_PMU:
 680		snd_soc_component_update_bits(component, w->reg,
 681			(1 << (w->shift+2)), (1 << (w->shift+2)));
 682		break;
 683	case SND_SOC_DAPM_POST_PMD:
 684		snd_soc_component_update_bits(component, w->reg,
 685			(1 << (w->shift+2)), 0);
 686		break;
 687	default:
 688		return -EINVAL;
 689	}
 690
 691	return 0;
 692}
 693
 694static const struct snd_soc_dapm_widget max98095_dapm_widgets[] = {
 695
 696	SND_SOC_DAPM_ADC("ADCL", "HiFi Capture", M98095_090_PWR_EN_IN, 0, 0),
 697	SND_SOC_DAPM_ADC("ADCR", "HiFi Capture", M98095_090_PWR_EN_IN, 1, 0),
 698
 699	SND_SOC_DAPM_DAC("DACL1", "HiFi Playback",
 700		M98095_091_PWR_EN_OUT, 0, 0),
 701	SND_SOC_DAPM_DAC("DACR1", "HiFi Playback",
 702		M98095_091_PWR_EN_OUT, 1, 0),
 703	SND_SOC_DAPM_DAC("DACM2", "Aux Playback",
 704		M98095_091_PWR_EN_OUT, 2, 0),
 705	SND_SOC_DAPM_DAC("DACM3", "Voice Playback",
 706		M98095_091_PWR_EN_OUT, 2, 0),
 707
 708	SND_SOC_DAPM_PGA("HP Left Out", M98095_091_PWR_EN_OUT,
 709		6, 0, NULL, 0),
 710	SND_SOC_DAPM_PGA("HP Right Out", M98095_091_PWR_EN_OUT,
 711		7, 0, NULL, 0),
 712
 713	SND_SOC_DAPM_PGA("SPK Left Out", M98095_091_PWR_EN_OUT,
 714		4, 0, NULL, 0),
 715	SND_SOC_DAPM_PGA("SPK Right Out", M98095_091_PWR_EN_OUT,
 716		5, 0, NULL, 0),
 717
 718	SND_SOC_DAPM_PGA("RCV Mono Out", M98095_091_PWR_EN_OUT,
 719		3, 0, NULL, 0),
 720
 721	SND_SOC_DAPM_PGA_E("LINE Left Out", M98095_092_PWR_EN_OUT,
 722		0, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
 723	SND_SOC_DAPM_PGA_E("LINE Right Out", M98095_092_PWR_EN_OUT,
 724		1, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
 725
 726	SND_SOC_DAPM_MUX("External MIC", SND_SOC_NOPM, 0, 0,
 727		&max98095_extmic_mux),
 728
 729	SND_SOC_DAPM_MUX("Linein Mux", SND_SOC_NOPM, 0, 0,
 730		&max98095_linein_mux),
 731
 732	SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
 733		&max98095_left_hp_mixer_controls[0],
 734		ARRAY_SIZE(max98095_left_hp_mixer_controls)),
 735
 736	SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
 737		&max98095_right_hp_mixer_controls[0],
 738		ARRAY_SIZE(max98095_right_hp_mixer_controls)),
 739
 740	SND_SOC_DAPM_MIXER("Left Speaker Mixer", SND_SOC_NOPM, 0, 0,
 741		&max98095_left_speaker_mixer_controls[0],
 742		ARRAY_SIZE(max98095_left_speaker_mixer_controls)),
 743
 744	SND_SOC_DAPM_MIXER("Right Speaker Mixer", SND_SOC_NOPM, 0, 0,
 745		&max98095_right_speaker_mixer_controls[0],
 746		ARRAY_SIZE(max98095_right_speaker_mixer_controls)),
 747
 748	SND_SOC_DAPM_MIXER("Receiver Mixer", SND_SOC_NOPM, 0, 0,
 749	  &max98095_mono_rcv_mixer_controls[0],
 750		ARRAY_SIZE(max98095_mono_rcv_mixer_controls)),
 751
 752	SND_SOC_DAPM_MIXER("Left Lineout Mixer", SND_SOC_NOPM, 0, 0,
 753		&max98095_left_lineout_mixer_controls[0],
 754		ARRAY_SIZE(max98095_left_lineout_mixer_controls)),
 755
 756	SND_SOC_DAPM_MIXER("Right Lineout Mixer", SND_SOC_NOPM, 0, 0,
 757		&max98095_right_lineout_mixer_controls[0],
 758		ARRAY_SIZE(max98095_right_lineout_mixer_controls)),
 759
 760	SND_SOC_DAPM_MIXER("Left ADC Mixer", SND_SOC_NOPM, 0, 0,
 761		&max98095_left_ADC_mixer_controls[0],
 762		ARRAY_SIZE(max98095_left_ADC_mixer_controls)),
 763
 764	SND_SOC_DAPM_MIXER("Right ADC Mixer", SND_SOC_NOPM, 0, 0,
 765		&max98095_right_ADC_mixer_controls[0],
 766		ARRAY_SIZE(max98095_right_ADC_mixer_controls)),
 767
 768	SND_SOC_DAPM_PGA_E("MIC1 Input", M98095_05F_LVL_MIC1,
 769		5, 0, NULL, 0, max98095_mic_event,
 770		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 771
 772	SND_SOC_DAPM_PGA_E("MIC2 Input", M98095_060_LVL_MIC2,
 773		5, 0, NULL, 0, max98095_mic_event,
 774		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 775
 776	SND_SOC_DAPM_PGA_E("IN1 Input", M98095_090_PWR_EN_IN,
 777		7, 0, NULL, 0, max98095_pga_in1_event,
 778		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 779
 780	SND_SOC_DAPM_PGA_E("IN2 Input", M98095_090_PWR_EN_IN,
 781		7, 0, NULL, 0, max98095_pga_in2_event,
 782		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 783
 784	SND_SOC_DAPM_MICBIAS("MICBIAS1", M98095_090_PWR_EN_IN, 2, 0),
 785	SND_SOC_DAPM_MICBIAS("MICBIAS2", M98095_090_PWR_EN_IN, 3, 0),
 786
 787	SND_SOC_DAPM_OUTPUT("HPL"),
 788	SND_SOC_DAPM_OUTPUT("HPR"),
 789	SND_SOC_DAPM_OUTPUT("SPKL"),
 790	SND_SOC_DAPM_OUTPUT("SPKR"),
 791	SND_SOC_DAPM_OUTPUT("RCV"),
 792	SND_SOC_DAPM_OUTPUT("OUT1"),
 793	SND_SOC_DAPM_OUTPUT("OUT2"),
 794	SND_SOC_DAPM_OUTPUT("OUT3"),
 795	SND_SOC_DAPM_OUTPUT("OUT4"),
 796
 797	SND_SOC_DAPM_INPUT("MIC1"),
 798	SND_SOC_DAPM_INPUT("MIC2"),
 799	SND_SOC_DAPM_INPUT("INA1"),
 800	SND_SOC_DAPM_INPUT("INA2"),
 801	SND_SOC_DAPM_INPUT("INB1"),
 802	SND_SOC_DAPM_INPUT("INB2"),
 803};
 804
 805static const struct snd_soc_dapm_route max98095_audio_map[] = {
 806	/* Left headphone output mixer */
 807	{"Left Headphone Mixer", "Left DAC1 Switch", "DACL1"},
 808	{"Left Headphone Mixer", "Right DAC1 Switch", "DACR1"},
 809	{"Left Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
 810	{"Left Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
 811	{"Left Headphone Mixer", "IN1 Switch", "IN1 Input"},
 812	{"Left Headphone Mixer", "IN2 Switch", "IN2 Input"},
 813
 814	/* Right headphone output mixer */
 815	{"Right Headphone Mixer", "Left DAC1 Switch", "DACL1"},
 816	{"Right Headphone Mixer", "Right DAC1 Switch", "DACR1"},
 817	{"Right Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
 818	{"Right Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
 819	{"Right Headphone Mixer", "IN1 Switch", "IN1 Input"},
 820	{"Right Headphone Mixer", "IN2 Switch", "IN2 Input"},
 821
 822	/* Left speaker output mixer */
 823	{"Left Speaker Mixer", "Left DAC1 Switch", "DACL1"},
 824	{"Left Speaker Mixer", "Right DAC1 Switch", "DACR1"},
 825	{"Left Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
 826	{"Left Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
 827	{"Left Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
 828	{"Left Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
 829	{"Left Speaker Mixer", "IN1 Switch", "IN1 Input"},
 830	{"Left Speaker Mixer", "IN2 Switch", "IN2 Input"},
 831
 832	/* Right speaker output mixer */
 833	{"Right Speaker Mixer", "Left DAC1 Switch", "DACL1"},
 834	{"Right Speaker Mixer", "Right DAC1 Switch", "DACR1"},
 835	{"Right Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
 836	{"Right Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
 837	{"Right Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
 838	{"Right Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
 839	{"Right Speaker Mixer", "IN1 Switch", "IN1 Input"},
 840	{"Right Speaker Mixer", "IN2 Switch", "IN2 Input"},
 841
 842	/* Earpiece/Receiver output mixer */
 843	{"Receiver Mixer", "Left DAC1 Switch", "DACL1"},
 844	{"Receiver Mixer", "Right DAC1 Switch", "DACR1"},
 845	{"Receiver Mixer", "MIC1 Switch", "MIC1 Input"},
 846	{"Receiver Mixer", "MIC2 Switch", "MIC2 Input"},
 847	{"Receiver Mixer", "IN1 Switch", "IN1 Input"},
 848	{"Receiver Mixer", "IN2 Switch", "IN2 Input"},
 849
 850	/* Left Lineout output mixer */
 851	{"Left Lineout Mixer", "Left DAC1 Switch", "DACL1"},
 852	{"Left Lineout Mixer", "Right DAC1 Switch", "DACR1"},
 853	{"Left Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
 854	{"Left Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
 855	{"Left Lineout Mixer", "IN1 Switch", "IN1 Input"},
 856	{"Left Lineout Mixer", "IN2 Switch", "IN2 Input"},
 857
 858	/* Right lineout output mixer */
 859	{"Right Lineout Mixer", "Left DAC1 Switch", "DACL1"},
 860	{"Right Lineout Mixer", "Right DAC1 Switch", "DACR1"},
 861	{"Right Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
 862	{"Right Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
 863	{"Right Lineout Mixer", "IN1 Switch", "IN1 Input"},
 864	{"Right Lineout Mixer", "IN2 Switch", "IN2 Input"},
 865
 866	{"HP Left Out", NULL, "Left Headphone Mixer"},
 867	{"HP Right Out", NULL, "Right Headphone Mixer"},
 868	{"SPK Left Out", NULL, "Left Speaker Mixer"},
 869	{"SPK Right Out", NULL, "Right Speaker Mixer"},
 870	{"RCV Mono Out", NULL, "Receiver Mixer"},
 871	{"LINE Left Out", NULL, "Left Lineout Mixer"},
 872	{"LINE Right Out", NULL, "Right Lineout Mixer"},
 873
 874	{"HPL", NULL, "HP Left Out"},
 875	{"HPR", NULL, "HP Right Out"},
 876	{"SPKL", NULL, "SPK Left Out"},
 877	{"SPKR", NULL, "SPK Right Out"},
 878	{"RCV", NULL, "RCV Mono Out"},
 879	{"OUT1", NULL, "LINE Left Out"},
 880	{"OUT2", NULL, "LINE Right Out"},
 881	{"OUT3", NULL, "LINE Left Out"},
 882	{"OUT4", NULL, "LINE Right Out"},
 883
 884	/* Left ADC input mixer */
 885	{"Left ADC Mixer", "MIC1 Switch", "MIC1 Input"},
 886	{"Left ADC Mixer", "MIC2 Switch", "MIC2 Input"},
 887	{"Left ADC Mixer", "IN1 Switch", "IN1 Input"},
 888	{"Left ADC Mixer", "IN2 Switch", "IN2 Input"},
 889
 890	/* Right ADC input mixer */
 891	{"Right ADC Mixer", "MIC1 Switch", "MIC1 Input"},
 892	{"Right ADC Mixer", "MIC2 Switch", "MIC2 Input"},
 893	{"Right ADC Mixer", "IN1 Switch", "IN1 Input"},
 894	{"Right ADC Mixer", "IN2 Switch", "IN2 Input"},
 895
 896	/* Inputs */
 897	{"ADCL", NULL, "Left ADC Mixer"},
 898	{"ADCR", NULL, "Right ADC Mixer"},
 899
 900	{"IN1 Input", NULL, "INA1"},
 901	{"IN2 Input", NULL, "INA2"},
 902
 903	{"MIC1 Input", NULL, "MIC1"},
 904	{"MIC2 Input", NULL, "MIC2"},
 905};
 906
 
 
 
 
 
 
 
 
 907/* codec mclk clock divider coefficients */
 908static const struct {
 909	u32 rate;
 910	u8  sr;
 911} rate_table[] = {
 912	{8000,  0x01},
 913	{11025, 0x02},
 914	{16000, 0x03},
 915	{22050, 0x04},
 916	{24000, 0x05},
 917	{32000, 0x06},
 918	{44100, 0x07},
 919	{48000, 0x08},
 920	{88200, 0x09},
 921	{96000, 0x0A},
 922};
 923
 924static int rate_value(int rate, u8 *value)
 925{
 926	int i;
 927
 928	for (i = 0; i < ARRAY_SIZE(rate_table); i++) {
 929		if (rate_table[i].rate >= rate) {
 930			*value = rate_table[i].sr;
 931			return 0;
 932		}
 933	}
 934	*value = rate_table[0].sr;
 935	return -EINVAL;
 936}
 937
 938static int max98095_dai1_hw_params(struct snd_pcm_substream *substream,
 939				   struct snd_pcm_hw_params *params,
 940				   struct snd_soc_dai *dai)
 941{
 942	struct snd_soc_component *component = dai->component;
 943	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
 944	struct max98095_cdata *cdata;
 945	unsigned long long ni;
 946	unsigned int rate;
 947	u8 regval;
 948
 949	cdata = &max98095->dai[0];
 950
 951	rate = params_rate(params);
 952
 953	switch (params_width(params)) {
 954	case 16:
 955		snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
 956			M98095_DAI_WS, 0);
 957		break;
 958	case 24:
 959		snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
 960			M98095_DAI_WS, M98095_DAI_WS);
 961		break;
 962	default:
 963		return -EINVAL;
 964	}
 965
 966	if (rate_value(rate, &regval))
 967		return -EINVAL;
 968
 969	snd_soc_component_update_bits(component, M98095_027_DAI1_CLKMODE,
 970		M98095_CLKMODE_MASK, regval);
 971	cdata->rate = rate;
 972
 973	/* Configure NI when operating as master */
 974	if (snd_soc_component_read(component, M98095_02A_DAI1_FORMAT) & M98095_DAI_MAS) {
 975		if (max98095->sysclk == 0) {
 976			dev_err(component->dev, "Invalid system clock frequency\n");
 977			return -EINVAL;
 978		}
 979		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
 980				* (unsigned long long int)rate;
 981		do_div(ni, (unsigned long long int)max98095->sysclk);
 982		snd_soc_component_write(component, M98095_028_DAI1_CLKCFG_HI,
 983			(ni >> 8) & 0x7F);
 984		snd_soc_component_write(component, M98095_029_DAI1_CLKCFG_LO,
 985			ni & 0xFF);
 986	}
 987
 988	/* Update sample rate mode */
 989	if (rate < 50000)
 990		snd_soc_component_update_bits(component, M98095_02E_DAI1_FILTERS,
 991			M98095_DAI_DHF, 0);
 992	else
 993		snd_soc_component_update_bits(component, M98095_02E_DAI1_FILTERS,
 994			M98095_DAI_DHF, M98095_DAI_DHF);
 995
 996	return 0;
 997}
 998
 999static int max98095_dai2_hw_params(struct snd_pcm_substream *substream,
1000				   struct snd_pcm_hw_params *params,
1001				   struct snd_soc_dai *dai)
1002{
1003	struct snd_soc_component *component = dai->component;
1004	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1005	struct max98095_cdata *cdata;
1006	unsigned long long ni;
1007	unsigned int rate;
1008	u8 regval;
1009
1010	cdata = &max98095->dai[1];
1011
1012	rate = params_rate(params);
1013
1014	switch (params_width(params)) {
1015	case 16:
1016		snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1017			M98095_DAI_WS, 0);
1018		break;
1019	case 24:
1020		snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1021			M98095_DAI_WS, M98095_DAI_WS);
1022		break;
1023	default:
1024		return -EINVAL;
1025	}
1026
1027	if (rate_value(rate, &regval))
1028		return -EINVAL;
1029
1030	snd_soc_component_update_bits(component, M98095_031_DAI2_CLKMODE,
1031		M98095_CLKMODE_MASK, regval);
1032	cdata->rate = rate;
1033
1034	/* Configure NI when operating as master */
1035	if (snd_soc_component_read(component, M98095_034_DAI2_FORMAT) & M98095_DAI_MAS) {
1036		if (max98095->sysclk == 0) {
1037			dev_err(component->dev, "Invalid system clock frequency\n");
1038			return -EINVAL;
1039		}
1040		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1041				* (unsigned long long int)rate;
1042		do_div(ni, (unsigned long long int)max98095->sysclk);
1043		snd_soc_component_write(component, M98095_032_DAI2_CLKCFG_HI,
1044			(ni >> 8) & 0x7F);
1045		snd_soc_component_write(component, M98095_033_DAI2_CLKCFG_LO,
1046			ni & 0xFF);
1047	}
1048
1049	/* Update sample rate mode */
1050	if (rate < 50000)
1051		snd_soc_component_update_bits(component, M98095_038_DAI2_FILTERS,
1052			M98095_DAI_DHF, 0);
1053	else
1054		snd_soc_component_update_bits(component, M98095_038_DAI2_FILTERS,
1055			M98095_DAI_DHF, M98095_DAI_DHF);
1056
1057	return 0;
1058}
1059
1060static int max98095_dai3_hw_params(struct snd_pcm_substream *substream,
1061				   struct snd_pcm_hw_params *params,
1062				   struct snd_soc_dai *dai)
1063{
1064	struct snd_soc_component *component = dai->component;
1065	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1066	struct max98095_cdata *cdata;
1067	unsigned long long ni;
1068	unsigned int rate;
1069	u8 regval;
1070
1071	cdata = &max98095->dai[2];
1072
1073	rate = params_rate(params);
1074
1075	switch (params_width(params)) {
1076	case 16:
1077		snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1078			M98095_DAI_WS, 0);
1079		break;
1080	case 24:
1081		snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1082			M98095_DAI_WS, M98095_DAI_WS);
1083		break;
1084	default:
1085		return -EINVAL;
1086	}
1087
1088	if (rate_value(rate, &regval))
1089		return -EINVAL;
1090
1091	snd_soc_component_update_bits(component, M98095_03B_DAI3_CLKMODE,
1092		M98095_CLKMODE_MASK, regval);
1093	cdata->rate = rate;
1094
1095	/* Configure NI when operating as master */
1096	if (snd_soc_component_read(component, M98095_03E_DAI3_FORMAT) & M98095_DAI_MAS) {
1097		if (max98095->sysclk == 0) {
1098			dev_err(component->dev, "Invalid system clock frequency\n");
1099			return -EINVAL;
1100		}
1101		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1102				* (unsigned long long int)rate;
1103		do_div(ni, (unsigned long long int)max98095->sysclk);
1104		snd_soc_component_write(component, M98095_03C_DAI3_CLKCFG_HI,
1105			(ni >> 8) & 0x7F);
1106		snd_soc_component_write(component, M98095_03D_DAI3_CLKCFG_LO,
1107			ni & 0xFF);
1108	}
1109
1110	/* Update sample rate mode */
1111	if (rate < 50000)
1112		snd_soc_component_update_bits(component, M98095_042_DAI3_FILTERS,
1113			M98095_DAI_DHF, 0);
1114	else
1115		snd_soc_component_update_bits(component, M98095_042_DAI3_FILTERS,
1116			M98095_DAI_DHF, M98095_DAI_DHF);
1117
1118	return 0;
1119}
1120
1121static int max98095_dai_set_sysclk(struct snd_soc_dai *dai,
1122				   int clk_id, unsigned int freq, int dir)
1123{
1124	struct snd_soc_component *component = dai->component;
1125	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1126
1127	/* Requested clock frequency is already setup */
1128	if (freq == max98095->sysclk)
1129		return 0;
1130
1131	if (!IS_ERR(max98095->mclk)) {
1132		freq = clk_round_rate(max98095->mclk, freq);
1133		clk_set_rate(max98095->mclk, freq);
1134	}
1135
1136	/* Setup clocks for slave mode, and using the PLL
1137	 * PSCLK = 0x01 (when master clk is 10MHz to 20MHz)
1138	 *         0x02 (when master clk is 20MHz to 40MHz)..
1139	 *         0x03 (when master clk is 40MHz to 60MHz)..
1140	 */
1141	if ((freq >= 10000000) && (freq < 20000000)) {
1142		snd_soc_component_write(component, M98095_026_SYS_CLK, 0x10);
1143	} else if ((freq >= 20000000) && (freq < 40000000)) {
1144		snd_soc_component_write(component, M98095_026_SYS_CLK, 0x20);
1145	} else if ((freq >= 40000000) && (freq < 60000000)) {
1146		snd_soc_component_write(component, M98095_026_SYS_CLK, 0x30);
1147	} else {
1148		dev_err(component->dev, "Invalid master clock frequency\n");
1149		return -EINVAL;
1150	}
1151
1152	dev_dbg(dai->dev, "Clock source is %d at %uHz\n", clk_id, freq);
1153
1154	max98095->sysclk = freq;
1155	return 0;
1156}
1157
1158static int max98095_dai1_set_fmt(struct snd_soc_dai *codec_dai,
1159				 unsigned int fmt)
1160{
1161	struct snd_soc_component *component = codec_dai->component;
1162	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1163	struct max98095_cdata *cdata;
1164	u8 regval = 0;
1165
1166	cdata = &max98095->dai[0];
1167
1168	if (fmt != cdata->fmt) {
1169		cdata->fmt = fmt;
1170
1171		switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1172		case SND_SOC_DAIFMT_CBC_CFC:
1173			/* Consumer mode PLL */
1174			snd_soc_component_write(component, M98095_028_DAI1_CLKCFG_HI,
1175				0x80);
1176			snd_soc_component_write(component, M98095_029_DAI1_CLKCFG_LO,
1177				0x00);
1178			break;
1179		case SND_SOC_DAIFMT_CBP_CFP:
1180			/* Set to provider mode */
1181			regval |= M98095_DAI_MAS;
1182			break;
 
 
1183		default:
1184			dev_err(component->dev, "Clock mode unsupported");
1185			return -EINVAL;
1186		}
1187
1188		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1189		case SND_SOC_DAIFMT_I2S:
1190			regval |= M98095_DAI_DLY;
1191			break;
1192		case SND_SOC_DAIFMT_LEFT_J:
1193			break;
1194		default:
1195			return -EINVAL;
1196		}
1197
1198		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1199		case SND_SOC_DAIFMT_NB_NF:
1200			break;
1201		case SND_SOC_DAIFMT_NB_IF:
1202			regval |= M98095_DAI_WCI;
1203			break;
1204		case SND_SOC_DAIFMT_IB_NF:
1205			regval |= M98095_DAI_BCI;
1206			break;
1207		case SND_SOC_DAIFMT_IB_IF:
1208			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1209			break;
1210		default:
1211			return -EINVAL;
1212		}
1213
1214		snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
1215			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1216			M98095_DAI_WCI, regval);
1217
1218		snd_soc_component_write(component, M98095_02B_DAI1_CLOCK, M98095_DAI_BSEL64);
1219	}
1220
1221	return 0;
1222}
1223
1224static int max98095_dai2_set_fmt(struct snd_soc_dai *codec_dai,
1225				 unsigned int fmt)
1226{
1227	struct snd_soc_component *component = codec_dai->component;
1228	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1229	struct max98095_cdata *cdata;
1230	u8 regval = 0;
1231
1232	cdata = &max98095->dai[1];
1233
1234	if (fmt != cdata->fmt) {
1235		cdata->fmt = fmt;
1236
1237		switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1238		case SND_SOC_DAIFMT_CBC_CFC:
1239			/* Consumer mode PLL */
1240			snd_soc_component_write(component, M98095_032_DAI2_CLKCFG_HI,
1241				0x80);
1242			snd_soc_component_write(component, M98095_033_DAI2_CLKCFG_LO,
1243				0x00);
1244			break;
1245		case SND_SOC_DAIFMT_CBP_CFP:
1246			/* Set to provider mode */
1247			regval |= M98095_DAI_MAS;
1248			break;
 
 
1249		default:
1250			dev_err(component->dev, "Clock mode unsupported");
1251			return -EINVAL;
1252		}
1253
1254		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1255		case SND_SOC_DAIFMT_I2S:
1256			regval |= M98095_DAI_DLY;
1257			break;
1258		case SND_SOC_DAIFMT_LEFT_J:
1259			break;
1260		default:
1261			return -EINVAL;
1262		}
1263
1264		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1265		case SND_SOC_DAIFMT_NB_NF:
1266			break;
1267		case SND_SOC_DAIFMT_NB_IF:
1268			regval |= M98095_DAI_WCI;
1269			break;
1270		case SND_SOC_DAIFMT_IB_NF:
1271			regval |= M98095_DAI_BCI;
1272			break;
1273		case SND_SOC_DAIFMT_IB_IF:
1274			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1275			break;
1276		default:
1277			return -EINVAL;
1278		}
1279
1280		snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1281			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1282			M98095_DAI_WCI, regval);
1283
1284		snd_soc_component_write(component, M98095_035_DAI2_CLOCK,
1285			M98095_DAI_BSEL64);
1286	}
1287
1288	return 0;
1289}
1290
1291static int max98095_dai3_set_fmt(struct snd_soc_dai *codec_dai,
1292				 unsigned int fmt)
1293{
1294	struct snd_soc_component *component = codec_dai->component;
1295	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1296	struct max98095_cdata *cdata;
1297	u8 regval = 0;
1298
1299	cdata = &max98095->dai[2];
1300
1301	if (fmt != cdata->fmt) {
1302		cdata->fmt = fmt;
1303
1304		switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1305		case SND_SOC_DAIFMT_CBC_CFC:
1306			/* Consumer mode PLL */
1307			snd_soc_component_write(component, M98095_03C_DAI3_CLKCFG_HI,
1308				0x80);
1309			snd_soc_component_write(component, M98095_03D_DAI3_CLKCFG_LO,
1310				0x00);
1311			break;
1312		case SND_SOC_DAIFMT_CBP_CFP:
1313			/* Set to provider mode */
1314			regval |= M98095_DAI_MAS;
1315			break;
 
 
1316		default:
1317			dev_err(component->dev, "Clock mode unsupported");
1318			return -EINVAL;
1319		}
1320
1321		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1322		case SND_SOC_DAIFMT_I2S:
1323			regval |= M98095_DAI_DLY;
1324			break;
1325		case SND_SOC_DAIFMT_LEFT_J:
1326			break;
1327		default:
1328			return -EINVAL;
1329		}
1330
1331		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1332		case SND_SOC_DAIFMT_NB_NF:
1333			break;
1334		case SND_SOC_DAIFMT_NB_IF:
1335			regval |= M98095_DAI_WCI;
1336			break;
1337		case SND_SOC_DAIFMT_IB_NF:
1338			regval |= M98095_DAI_BCI;
1339			break;
1340		case SND_SOC_DAIFMT_IB_IF:
1341			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1342			break;
1343		default:
1344			return -EINVAL;
1345		}
1346
1347		snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1348			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1349			M98095_DAI_WCI, regval);
1350
1351		snd_soc_component_write(component, M98095_03F_DAI3_CLOCK,
1352			M98095_DAI_BSEL64);
1353	}
1354
1355	return 0;
1356}
1357
1358static int max98095_set_bias_level(struct snd_soc_component *component,
1359				   enum snd_soc_bias_level level)
1360{
1361	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1362	int ret;
1363
1364	switch (level) {
1365	case SND_SOC_BIAS_ON:
1366		break;
1367
1368	case SND_SOC_BIAS_PREPARE:
1369		/*
1370		 * SND_SOC_BIAS_PREPARE is called while preparing for a
1371		 * transition to ON or away from ON. If current bias_level
1372		 * is SND_SOC_BIAS_ON, then it is preparing for a transition
1373		 * away from ON. Disable the clock in that case, otherwise
1374		 * enable it.
1375		 */
1376		if (IS_ERR(max98095->mclk))
1377			break;
1378
1379		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_ON) {
1380			clk_disable_unprepare(max98095->mclk);
1381		} else {
1382			ret = clk_prepare_enable(max98095->mclk);
1383			if (ret)
1384				return ret;
1385		}
1386		break;
1387
1388	case SND_SOC_BIAS_STANDBY:
1389		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
1390			ret = regcache_sync(max98095->regmap);
1391
1392			if (ret != 0) {
1393				dev_err(component->dev, "Failed to sync cache: %d\n", ret);
1394				return ret;
1395			}
1396		}
1397
1398		snd_soc_component_update_bits(component, M98095_090_PWR_EN_IN,
1399				M98095_MBEN, M98095_MBEN);
1400		break;
1401
1402	case SND_SOC_BIAS_OFF:
1403		snd_soc_component_update_bits(component, M98095_090_PWR_EN_IN,
1404				M98095_MBEN, 0);
1405		regcache_mark_dirty(max98095->regmap);
1406		break;
1407	}
 
1408	return 0;
1409}
1410
1411#define MAX98095_RATES SNDRV_PCM_RATE_8000_96000
1412#define MAX98095_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
1413
1414static const struct snd_soc_dai_ops max98095_dai1_ops = {
1415	.set_sysclk = max98095_dai_set_sysclk,
1416	.set_fmt = max98095_dai1_set_fmt,
1417	.hw_params = max98095_dai1_hw_params,
1418};
1419
1420static const struct snd_soc_dai_ops max98095_dai2_ops = {
1421	.set_sysclk = max98095_dai_set_sysclk,
1422	.set_fmt = max98095_dai2_set_fmt,
1423	.hw_params = max98095_dai2_hw_params,
1424};
1425
1426static const struct snd_soc_dai_ops max98095_dai3_ops = {
1427	.set_sysclk = max98095_dai_set_sysclk,
1428	.set_fmt = max98095_dai3_set_fmt,
1429	.hw_params = max98095_dai3_hw_params,
1430};
1431
1432static struct snd_soc_dai_driver max98095_dai[] = {
1433{
1434	.name = "HiFi",
1435	.playback = {
1436		.stream_name = "HiFi Playback",
1437		.channels_min = 1,
1438		.channels_max = 2,
1439		.rates = MAX98095_RATES,
1440		.formats = MAX98095_FORMATS,
1441	},
1442	.capture = {
1443		.stream_name = "HiFi Capture",
1444		.channels_min = 1,
1445		.channels_max = 2,
1446		.rates = MAX98095_RATES,
1447		.formats = MAX98095_FORMATS,
1448	},
1449	 .ops = &max98095_dai1_ops,
1450},
1451{
1452	.name = "Aux",
1453	.playback = {
1454		.stream_name = "Aux Playback",
1455		.channels_min = 1,
1456		.channels_max = 1,
1457		.rates = MAX98095_RATES,
1458		.formats = MAX98095_FORMATS,
1459	},
1460	.ops = &max98095_dai2_ops,
1461},
1462{
1463	.name = "Voice",
1464	.playback = {
1465		.stream_name = "Voice Playback",
1466		.channels_min = 1,
1467		.channels_max = 1,
1468		.rates = MAX98095_RATES,
1469		.formats = MAX98095_FORMATS,
1470	},
1471	.ops = &max98095_dai3_ops,
1472}
1473
1474};
1475
1476static int max98095_get_eq_channel(const char *name)
1477{
1478	if (strcmp(name, "EQ1 Mode") == 0)
1479		return 0;
1480	if (strcmp(name, "EQ2 Mode") == 0)
1481		return 1;
1482	return -EINVAL;
1483}
1484
1485static int max98095_put_eq_enum(struct snd_kcontrol *kcontrol,
1486				 struct snd_ctl_elem_value *ucontrol)
1487{
1488	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1489	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1490	struct max98095_pdata *pdata = max98095->pdata;
1491	int channel = max98095_get_eq_channel(kcontrol->id.name);
1492	struct max98095_cdata *cdata;
1493	unsigned int sel = ucontrol->value.enumerated.item[0];
1494	struct max98095_eq_cfg *coef_set;
1495	int fs, best, best_val, i;
1496	int regmask, regsave;
1497
1498	if (WARN_ON(channel > 1))
1499		return -EINVAL;
1500
1501	if (!pdata || !max98095->eq_textcnt)
1502		return 0;
1503
1504	if (sel >= pdata->eq_cfgcnt)
1505		return -EINVAL;
1506
1507	cdata = &max98095->dai[channel];
1508	cdata->eq_sel = sel;
1509	fs = cdata->rate;
1510
1511	/* Find the selected configuration with nearest sample rate */
1512	best = 0;
1513	best_val = INT_MAX;
1514	for (i = 0; i < pdata->eq_cfgcnt; i++) {
1515		if (strcmp(pdata->eq_cfg[i].name, max98095->eq_texts[sel]) == 0 &&
1516			abs(pdata->eq_cfg[i].rate - fs) < best_val) {
1517			best = i;
1518			best_val = abs(pdata->eq_cfg[i].rate - fs);
1519		}
1520	}
1521
1522	dev_dbg(component->dev, "Selected %s/%dHz for %dHz sample rate\n",
1523		pdata->eq_cfg[best].name,
1524		pdata->eq_cfg[best].rate, fs);
1525
1526	coef_set = &pdata->eq_cfg[best];
1527
1528	regmask = (channel == 0) ? M98095_EQ1EN : M98095_EQ2EN;
1529
1530	/* Disable filter while configuring, and save current on/off state */
1531	regsave = snd_soc_component_read(component, M98095_088_CFG_LEVEL);
1532	snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, 0);
1533
1534	mutex_lock(&max98095->lock);
1535	snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1536	m98095_eq_band(component, channel, 0, coef_set->band1);
1537	m98095_eq_band(component, channel, 1, coef_set->band2);
1538	m98095_eq_band(component, channel, 2, coef_set->band3);
1539	m98095_eq_band(component, channel, 3, coef_set->band4);
1540	m98095_eq_band(component, channel, 4, coef_set->band5);
1541	snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, 0);
1542	mutex_unlock(&max98095->lock);
1543
1544	/* Restore the original on/off state */
1545	snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, regsave);
1546	return 0;
1547}
1548
1549static int max98095_get_eq_enum(struct snd_kcontrol *kcontrol,
1550				 struct snd_ctl_elem_value *ucontrol)
1551{
1552	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1553	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1554	int channel = max98095_get_eq_channel(kcontrol->id.name);
1555	struct max98095_cdata *cdata;
1556
1557	cdata = &max98095->dai[channel];
1558	ucontrol->value.enumerated.item[0] = cdata->eq_sel;
1559
1560	return 0;
1561}
1562
1563static void max98095_handle_eq_pdata(struct snd_soc_component *component)
1564{
1565	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1566	struct max98095_pdata *pdata = max98095->pdata;
1567	struct max98095_eq_cfg *cfg;
1568	unsigned int cfgcnt;
1569	int i, j;
1570	const char **t;
1571	int ret;
1572
1573	struct snd_kcontrol_new controls[] = {
1574		SOC_ENUM_EXT("EQ1 Mode",
1575			max98095->eq_enum,
1576			max98095_get_eq_enum,
1577			max98095_put_eq_enum),
1578		SOC_ENUM_EXT("EQ2 Mode",
1579			max98095->eq_enum,
1580			max98095_get_eq_enum,
1581			max98095_put_eq_enum),
1582	};
1583
1584	cfg = pdata->eq_cfg;
1585	cfgcnt = pdata->eq_cfgcnt;
1586
1587	/* Setup an array of texts for the equalizer enum.
1588	 * This is based on Mark Brown's equalizer driver code.
1589	 */
1590	max98095->eq_textcnt = 0;
1591	max98095->eq_texts = NULL;
1592	for (i = 0; i < cfgcnt; i++) {
1593		for (j = 0; j < max98095->eq_textcnt; j++) {
1594			if (strcmp(cfg[i].name, max98095->eq_texts[j]) == 0)
1595				break;
1596		}
1597
1598		if (j != max98095->eq_textcnt)
1599			continue;
1600
1601		/* Expand the array */
1602		t = krealloc(max98095->eq_texts,
1603			     sizeof(char *) * (max98095->eq_textcnt + 1),
1604			     GFP_KERNEL);
1605		if (t == NULL)
1606			continue;
1607
1608		/* Store the new entry */
1609		t[max98095->eq_textcnt] = cfg[i].name;
1610		max98095->eq_textcnt++;
1611		max98095->eq_texts = t;
1612	}
1613
1614	/* Now point the soc_enum to .texts array items */
1615	max98095->eq_enum.texts = max98095->eq_texts;
1616	max98095->eq_enum.items = max98095->eq_textcnt;
1617
1618	ret = snd_soc_add_component_controls(component, controls, ARRAY_SIZE(controls));
1619	if (ret != 0)
1620		dev_err(component->dev, "Failed to add EQ control: %d\n", ret);
1621}
1622
1623static const char *bq_mode_name[] = {"Biquad1 Mode", "Biquad2 Mode"};
1624
1625static int max98095_get_bq_channel(struct snd_soc_component *component,
1626				   const char *name)
1627{
1628	int ret;
1629
1630	ret = match_string(bq_mode_name, ARRAY_SIZE(bq_mode_name), name);
1631	if (ret < 0)
1632		dev_err(component->dev, "Bad biquad channel name '%s'\n", name);
1633	return ret;
1634}
1635
1636static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
1637				 struct snd_ctl_elem_value *ucontrol)
1638{
1639	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1640	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1641	struct max98095_pdata *pdata = max98095->pdata;
1642	int channel = max98095_get_bq_channel(component, kcontrol->id.name);
1643	struct max98095_cdata *cdata;
1644	unsigned int sel = ucontrol->value.enumerated.item[0];
1645	struct max98095_biquad_cfg *coef_set;
1646	int fs, best, best_val, i;
1647	int regmask, regsave;
1648
1649	if (channel < 0)
1650		return channel;
1651
1652	if (!pdata || !max98095->bq_textcnt)
1653		return 0;
1654
1655	if (sel >= pdata->bq_cfgcnt)
1656		return -EINVAL;
1657
1658	cdata = &max98095->dai[channel];
1659	cdata->bq_sel = sel;
1660	fs = cdata->rate;
1661
1662	/* Find the selected configuration with nearest sample rate */
1663	best = 0;
1664	best_val = INT_MAX;
1665	for (i = 0; i < pdata->bq_cfgcnt; i++) {
1666		if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
1667			abs(pdata->bq_cfg[i].rate - fs) < best_val) {
1668			best = i;
1669			best_val = abs(pdata->bq_cfg[i].rate - fs);
1670		}
1671	}
1672
1673	dev_dbg(component->dev, "Selected %s/%dHz for %dHz sample rate\n",
1674		pdata->bq_cfg[best].name,
1675		pdata->bq_cfg[best].rate, fs);
1676
1677	coef_set = &pdata->bq_cfg[best];
1678
1679	regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
1680
1681	/* Disable filter while configuring, and save current on/off state */
1682	regsave = snd_soc_component_read(component, M98095_088_CFG_LEVEL);
1683	snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, 0);
1684
1685	mutex_lock(&max98095->lock);
1686	snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1687	m98095_biquad_band(component, channel, 0, coef_set->band1);
1688	m98095_biquad_band(component, channel, 1, coef_set->band2);
1689	snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, 0);
1690	mutex_unlock(&max98095->lock);
1691
1692	/* Restore the original on/off state */
1693	snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, regsave);
1694	return 0;
1695}
1696
1697static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
1698				 struct snd_ctl_elem_value *ucontrol)
1699{
1700	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1701	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1702	int channel = max98095_get_bq_channel(component, kcontrol->id.name);
1703	struct max98095_cdata *cdata;
1704
1705	if (channel < 0)
1706		return channel;
1707
1708	cdata = &max98095->dai[channel];
1709	ucontrol->value.enumerated.item[0] = cdata->bq_sel;
1710
1711	return 0;
1712}
1713
1714static void max98095_handle_bq_pdata(struct snd_soc_component *component)
1715{
1716	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1717	struct max98095_pdata *pdata = max98095->pdata;
1718	struct max98095_biquad_cfg *cfg;
1719	unsigned int cfgcnt;
1720	int i, j;
1721	const char **t;
1722	int ret;
1723
1724	struct snd_kcontrol_new controls[] = {
1725		SOC_ENUM_EXT((char *)bq_mode_name[0],
1726			max98095->bq_enum,
1727			max98095_get_bq_enum,
1728			max98095_put_bq_enum),
1729		SOC_ENUM_EXT((char *)bq_mode_name[1],
1730			max98095->bq_enum,
1731			max98095_get_bq_enum,
1732			max98095_put_bq_enum),
1733	};
1734	BUILD_BUG_ON(ARRAY_SIZE(controls) != ARRAY_SIZE(bq_mode_name));
1735
1736	cfg = pdata->bq_cfg;
1737	cfgcnt = pdata->bq_cfgcnt;
1738
1739	/* Setup an array of texts for the biquad enum.
1740	 * This is based on Mark Brown's equalizer driver code.
1741	 */
1742	max98095->bq_textcnt = 0;
1743	max98095->bq_texts = NULL;
1744	for (i = 0; i < cfgcnt; i++) {
1745		for (j = 0; j < max98095->bq_textcnt; j++) {
1746			if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
1747				break;
1748		}
1749
1750		if (j != max98095->bq_textcnt)
1751			continue;
1752
1753		/* Expand the array */
1754		t = krealloc(max98095->bq_texts,
1755			     sizeof(char *) * (max98095->bq_textcnt + 1),
1756			     GFP_KERNEL);
1757		if (t == NULL)
1758			continue;
1759
1760		/* Store the new entry */
1761		t[max98095->bq_textcnt] = cfg[i].name;
1762		max98095->bq_textcnt++;
1763		max98095->bq_texts = t;
1764	}
1765
1766	/* Now point the soc_enum to .texts array items */
1767	max98095->bq_enum.texts = max98095->bq_texts;
1768	max98095->bq_enum.items = max98095->bq_textcnt;
1769
1770	ret = snd_soc_add_component_controls(component, controls, ARRAY_SIZE(controls));
1771	if (ret != 0)
1772		dev_err(component->dev, "Failed to add Biquad control: %d\n", ret);
1773}
1774
1775static void max98095_handle_pdata(struct snd_soc_component *component)
1776{
1777	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1778	struct max98095_pdata *pdata = max98095->pdata;
1779	u8 regval = 0;
1780
1781	if (!pdata) {
1782		dev_dbg(component->dev, "No platform data\n");
1783		return;
1784	}
1785
1786	/* Configure mic for analog/digital mic mode */
1787	if (pdata->digmic_left_mode)
1788		regval |= M98095_DIGMIC_L;
1789
1790	if (pdata->digmic_right_mode)
1791		regval |= M98095_DIGMIC_R;
1792
1793	snd_soc_component_write(component, M98095_087_CFG_MIC, regval);
1794
1795	/* Configure equalizers */
1796	if (pdata->eq_cfgcnt)
1797		max98095_handle_eq_pdata(component);
1798
1799	/* Configure bi-quad filters */
1800	if (pdata->bq_cfgcnt)
1801		max98095_handle_bq_pdata(component);
1802}
1803
1804static irqreturn_t max98095_report_jack(int irq, void *data)
1805{
1806	struct snd_soc_component *component = data;
1807	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1808	unsigned int value;
1809	int hp_report = 0;
1810	int mic_report = 0;
1811
1812	/* Read the Jack Status Register */
1813	value = snd_soc_component_read(component, M98095_007_JACK_AUTO_STS);
1814
1815	/* If ddone is not set, then detection isn't finished yet */
1816	if ((value & M98095_DDONE) == 0)
1817		return IRQ_NONE;
1818
1819	/* if hp, check its bit, and if set, clear it */
1820	if ((value & M98095_HP_IN || value & M98095_LO_IN) &&
1821		max98095->headphone_jack)
1822		hp_report |= SND_JACK_HEADPHONE;
1823
1824	/* if mic, check its bit, and if set, clear it */
1825	if ((value & M98095_MIC_IN) && max98095->mic_jack)
1826		mic_report |= SND_JACK_MICROPHONE;
1827
1828	if (max98095->headphone_jack == max98095->mic_jack) {
1829		snd_soc_jack_report(max98095->headphone_jack,
1830					hp_report | mic_report,
1831					SND_JACK_HEADSET);
1832	} else {
1833		if (max98095->headphone_jack)
1834			snd_soc_jack_report(max98095->headphone_jack,
1835					hp_report, SND_JACK_HEADPHONE);
1836		if (max98095->mic_jack)
1837			snd_soc_jack_report(max98095->mic_jack,
1838					mic_report, SND_JACK_MICROPHONE);
1839	}
1840
1841	return IRQ_HANDLED;
1842}
1843
1844static int max98095_jack_detect_enable(struct snd_soc_component *component)
1845{
1846	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1847	int ret = 0;
1848	int detect_enable = M98095_JDEN;
1849	unsigned int slew = M98095_DEFAULT_SLEW_DELAY;
1850
1851	if (max98095->pdata->jack_detect_pin5en)
1852		detect_enable |= M98095_PIN5EN;
1853
1854	if (max98095->pdata->jack_detect_delay)
1855		slew = max98095->pdata->jack_detect_delay;
1856
1857	ret = snd_soc_component_write(component, M98095_08E_JACK_DC_SLEW, slew);
1858	if (ret < 0) {
1859		dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1860		return ret;
1861	}
1862
1863	/* configure auto detection to be enabled */
1864	ret = snd_soc_component_write(component, M98095_089_JACK_DET_AUTO, detect_enable);
1865	if (ret < 0) {
1866		dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1867		return ret;
1868	}
1869
1870	return ret;
1871}
1872
1873static int max98095_jack_detect_disable(struct snd_soc_component *component)
1874{
1875	int ret = 0;
1876
1877	/* configure auto detection to be disabled */
1878	ret = snd_soc_component_write(component, M98095_089_JACK_DET_AUTO, 0x0);
1879	if (ret < 0) {
1880		dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1881		return ret;
1882	}
1883
1884	return ret;
1885}
1886
1887int max98095_jack_detect(struct snd_soc_component *component,
1888	struct snd_soc_jack *hp_jack, struct snd_soc_jack *mic_jack)
1889{
1890	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1891	struct i2c_client *client = to_i2c_client(component->dev);
1892	int ret = 0;
1893
1894	max98095->headphone_jack = hp_jack;
1895	max98095->mic_jack = mic_jack;
1896
1897	/* only progress if we have at least 1 jack pointer */
1898	if (!hp_jack && !mic_jack)
1899		return -EINVAL;
1900
1901	max98095_jack_detect_enable(component);
1902
1903	/* enable interrupts for headphone jack detection */
1904	ret = snd_soc_component_update_bits(component, M98095_013_JACK_INT_EN,
1905		M98095_IDDONE, M98095_IDDONE);
1906	if (ret < 0) {
1907		dev_err(component->dev, "Failed to cfg jack irqs %d\n", ret);
1908		return ret;
1909	}
1910
1911	max98095_report_jack(client->irq, component);
1912	return 0;
1913}
1914EXPORT_SYMBOL_GPL(max98095_jack_detect);
1915
1916#ifdef CONFIG_PM
1917static int max98095_suspend(struct snd_soc_component *component)
1918{
1919	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1920
1921	if (max98095->headphone_jack || max98095->mic_jack)
1922		max98095_jack_detect_disable(component);
1923
1924	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
1925
1926	return 0;
1927}
1928
1929static int max98095_resume(struct snd_soc_component *component)
1930{
1931	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1932	struct i2c_client *client = to_i2c_client(component->dev);
1933
1934	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_STANDBY);
1935
1936	if (max98095->headphone_jack || max98095->mic_jack) {
1937		max98095_jack_detect_enable(component);
1938		max98095_report_jack(client->irq, component);
1939	}
1940
1941	return 0;
1942}
1943#else
1944#define max98095_suspend NULL
1945#define max98095_resume NULL
1946#endif
1947
1948static int max98095_reset(struct snd_soc_component *component)
1949{
1950	int i, ret;
1951
1952	/* Gracefully reset the DSP core and the codec hardware
1953	 * in a proper sequence */
1954	ret = snd_soc_component_write(component, M98095_00F_HOST_CFG, 0);
1955	if (ret < 0) {
1956		dev_err(component->dev, "Failed to reset DSP: %d\n", ret);
1957		return ret;
1958	}
1959
1960	ret = snd_soc_component_write(component, M98095_097_PWR_SYS, 0);
1961	if (ret < 0) {
1962		dev_err(component->dev, "Failed to reset component: %d\n", ret);
1963		return ret;
1964	}
1965
1966	/* Reset to hardware default for registers, as there is not
1967	 * a soft reset hardware control register */
1968	for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
1969		ret = snd_soc_component_write(component, i, snd_soc_component_read(component, i));
1970		if (ret < 0) {
1971			dev_err(component->dev, "Failed to reset: %d\n", ret);
1972			return ret;
1973		}
1974	}
1975
1976	return ret;
1977}
1978
1979static int max98095_probe(struct snd_soc_component *component)
1980{
1981	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1982	struct max98095_cdata *cdata;
1983	struct i2c_client *client;
1984	int ret = 0;
1985
1986	max98095->mclk = devm_clk_get(component->dev, "mclk");
1987	if (PTR_ERR(max98095->mclk) == -EPROBE_DEFER)
1988		return -EPROBE_DEFER;
 
 
1989
1990	/* reset the codec, the DSP core, and disable all interrupts */
1991	max98095_reset(component);
1992
1993	client = to_i2c_client(component->dev);
1994
1995	/* initialize private data */
1996
1997	max98095->sysclk = (unsigned)-1;
1998	max98095->eq_textcnt = 0;
1999	max98095->bq_textcnt = 0;
2000
2001	cdata = &max98095->dai[0];
2002	cdata->rate = (unsigned)-1;
2003	cdata->fmt  = (unsigned)-1;
2004	cdata->eq_sel = 0;
2005	cdata->bq_sel = 0;
2006
2007	cdata = &max98095->dai[1];
2008	cdata->rate = (unsigned)-1;
2009	cdata->fmt  = (unsigned)-1;
2010	cdata->eq_sel = 0;
2011	cdata->bq_sel = 0;
2012
2013	cdata = &max98095->dai[2];
2014	cdata->rate = (unsigned)-1;
2015	cdata->fmt  = (unsigned)-1;
2016	cdata->eq_sel = 0;
2017	cdata->bq_sel = 0;
2018
2019	max98095->lin_state = 0;
2020	max98095->mic1pre = 0;
2021	max98095->mic2pre = 0;
2022
2023	if (client->irq) {
2024		/* register an audio interrupt */
2025		ret = request_threaded_irq(client->irq, NULL,
2026			max98095_report_jack,
2027			IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING |
2028			IRQF_ONESHOT, "max98095", component);
2029		if (ret) {
2030			dev_err(component->dev, "Failed to request IRQ: %d\n", ret);
2031			goto err_access;
2032		}
2033	}
2034
2035	ret = snd_soc_component_read(component, M98095_0FF_REV_ID);
2036	if (ret < 0) {
2037		dev_err(component->dev, "Failure reading hardware revision: %d\n",
2038			ret);
2039		goto err_irq;
2040	}
2041	dev_info(component->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
 
 
2042
2043	snd_soc_component_write(component, M98095_097_PWR_SYS, M98095_PWRSV);
 
2044
2045	snd_soc_component_write(component, M98095_048_MIX_DAC_LR,
2046		M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2047
2048	snd_soc_component_write(component, M98095_049_MIX_DAC_M,
2049		M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2050
2051	snd_soc_component_write(component, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2052	snd_soc_component_write(component, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2053	snd_soc_component_write(component, M98095_04E_CFG_HP, M98095_HPNORMAL);
2054
2055	snd_soc_component_write(component, M98095_02C_DAI1_IOCFG,
2056		M98095_S1NORMAL|M98095_SDATA);
2057
2058	snd_soc_component_write(component, M98095_036_DAI2_IOCFG,
2059		M98095_S2NORMAL|M98095_SDATA);
2060
2061	snd_soc_component_write(component, M98095_040_DAI3_IOCFG,
2062		M98095_S3NORMAL|M98095_SDATA);
2063
2064	max98095_handle_pdata(component);
2065
2066	/* take the codec out of the shut down */
2067	snd_soc_component_update_bits(component, M98095_097_PWR_SYS, M98095_SHDNRUN,
2068		M98095_SHDNRUN);
2069
2070	return 0;
2071
2072err_irq:
2073	if (client->irq)
2074		free_irq(client->irq, component);
2075err_access:
2076	return ret;
2077}
2078
2079static void max98095_remove(struct snd_soc_component *component)
2080{
2081	struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
2082	struct i2c_client *client = to_i2c_client(component->dev);
2083
2084	if (max98095->headphone_jack || max98095->mic_jack)
2085		max98095_jack_detect_disable(component);
2086
2087	if (client->irq)
2088		free_irq(client->irq, component);
2089}
2090
2091static const struct snd_soc_component_driver soc_component_dev_max98095 = {
2092	.probe			= max98095_probe,
2093	.remove			= max98095_remove,
2094	.suspend		= max98095_suspend,
2095	.resume			= max98095_resume,
2096	.set_bias_level		= max98095_set_bias_level,
2097	.controls		= max98095_snd_controls,
2098	.num_controls		= ARRAY_SIZE(max98095_snd_controls),
2099	.dapm_widgets		= max98095_dapm_widgets,
2100	.num_dapm_widgets	= ARRAY_SIZE(max98095_dapm_widgets),
2101	.dapm_routes		= max98095_audio_map,
2102	.num_dapm_routes	= ARRAY_SIZE(max98095_audio_map),
2103	.idle_bias_on		= 1,
2104	.use_pmdown_time	= 1,
2105	.endianness		= 1,
2106};
2107
2108static const struct i2c_device_id max98095_i2c_id[] = {
2109	{ "max98095", MAX98095 },
2110	{ }
 
 
 
 
 
 
 
 
 
 
 
 
2111};
2112MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
2113
2114static int max98095_i2c_probe(struct i2c_client *i2c)
 
2115{
2116	struct max98095_priv *max98095;
2117	int ret;
2118	const struct i2c_device_id *id;
2119
2120	max98095 = devm_kzalloc(&i2c->dev, sizeof(struct max98095_priv),
2121				GFP_KERNEL);
2122	if (max98095 == NULL)
2123		return -ENOMEM;
2124
2125	mutex_init(&max98095->lock);
2126
2127	max98095->regmap = devm_regmap_init_i2c(i2c, &max98095_regmap);
2128	if (IS_ERR(max98095->regmap)) {
2129		ret = PTR_ERR(max98095->regmap);
2130		dev_err(&i2c->dev, "Failed to allocate regmap: %d\n", ret);
2131		return ret;
2132	}
2133
2134	id = i2c_match_id(max98095_i2c_id, i2c);
2135	max98095->devtype = id->driver_data;
2136	i2c_set_clientdata(i2c, max98095);
 
2137	max98095->pdata = i2c->dev.platform_data;
2138
2139	ret = devm_snd_soc_register_component(&i2c->dev,
2140				     &soc_component_dev_max98095,
2141				     max98095_dai, ARRAY_SIZE(max98095_dai));
 
 
2142	return ret;
2143}
2144
2145#ifdef CONFIG_OF
2146static const struct of_device_id max98095_of_match[] = {
2147	{ .compatible = "maxim,max98095", },
 
 
 
 
 
 
 
2148	{ }
2149};
2150MODULE_DEVICE_TABLE(of, max98095_of_match);
2151#endif
2152
2153static struct i2c_driver max98095_i2c_driver = {
2154	.driver = {
2155		.name = "max98095",
2156		.of_match_table = of_match_ptr(max98095_of_match),
2157	},
2158	.probe = max98095_i2c_probe,
 
2159	.id_table = max98095_i2c_id,
2160};
2161
2162module_i2c_driver(max98095_i2c_driver);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2163
2164MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2165MODULE_AUTHOR("Peter Hsiang");
2166MODULE_LICENSE("GPL");
v3.1
 
   1/*
   2 * max98095.c -- MAX98095 ALSA SoC Audio driver
   3 *
   4 * Copyright 2011 Maxim Integrated Products
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License version 2 as
   8 * published by the Free Software Foundation.
   9 */
  10
  11#include <linux/module.h>
  12#include <linux/moduleparam.h>
  13#include <linux/kernel.h>
  14#include <linux/init.h>
  15#include <linux/delay.h>
  16#include <linux/pm.h>
  17#include <linux/i2c.h>
  18#include <linux/platform_device.h>
 
  19#include <sound/core.h>
  20#include <sound/pcm.h>
  21#include <sound/pcm_params.h>
  22#include <sound/soc.h>
  23#include <sound/initval.h>
  24#include <sound/tlv.h>
  25#include <linux/slab.h>
  26#include <asm/div64.h>
  27#include <sound/max98095.h>
 
  28#include "max98095.h"
  29
  30enum max98095_type {
  31	MAX98095,
  32};
  33
  34struct max98095_cdata {
  35	unsigned int rate;
  36	unsigned int fmt;
  37	int eq_sel;
  38	int bq_sel;
  39};
  40
  41struct max98095_priv {
 
  42	enum max98095_type devtype;
  43	void *control_data;
  44	struct max98095_pdata *pdata;
 
  45	unsigned int sysclk;
  46	struct max98095_cdata dai[3];
  47	const char **eq_texts;
  48	const char **bq_texts;
  49	struct soc_enum eq_enum;
  50	struct soc_enum bq_enum;
  51	int eq_textcnt;
  52	int bq_textcnt;
  53	u8 lin_state;
  54	unsigned int mic1pre;
  55	unsigned int mic2pre;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  56};
  57
  58static const u8 max98095_reg_def[M98095_REG_CNT] = {
  59	0x00, /* 00 */
  60	0x00, /* 01 */
  61	0x00, /* 02 */
  62	0x00, /* 03 */
  63	0x00, /* 04 */
  64	0x00, /* 05 */
  65	0x00, /* 06 */
  66	0x00, /* 07 */
  67	0x00, /* 08 */
  68	0x00, /* 09 */
  69	0x00, /* 0A */
  70	0x00, /* 0B */
  71	0x00, /* 0C */
  72	0x00, /* 0D */
  73	0x00, /* 0E */
  74	0x00, /* 0F */
  75	0x00, /* 10 */
  76	0x00, /* 11 */
  77	0x00, /* 12 */
  78	0x00, /* 13 */
  79	0x00, /* 14 */
  80	0x00, /* 15 */
  81	0x00, /* 16 */
  82	0x00, /* 17 */
  83	0x00, /* 18 */
  84	0x00, /* 19 */
  85	0x00, /* 1A */
  86	0x00, /* 1B */
  87	0x00, /* 1C */
  88	0x00, /* 1D */
  89	0x00, /* 1E */
  90	0x00, /* 1F */
  91	0x00, /* 20 */
  92	0x00, /* 21 */
  93	0x00, /* 22 */
  94	0x00, /* 23 */
  95	0x00, /* 24 */
  96	0x00, /* 25 */
  97	0x00, /* 26 */
  98	0x00, /* 27 */
  99	0x00, /* 28 */
 100	0x00, /* 29 */
 101	0x00, /* 2A */
 102	0x00, /* 2B */
 103	0x00, /* 2C */
 104	0x00, /* 2D */
 105	0x00, /* 2E */
 106	0x00, /* 2F */
 107	0x00, /* 30 */
 108	0x00, /* 31 */
 109	0x00, /* 32 */
 110	0x00, /* 33 */
 111	0x00, /* 34 */
 112	0x00, /* 35 */
 113	0x00, /* 36 */
 114	0x00, /* 37 */
 115	0x00, /* 38 */
 116	0x00, /* 39 */
 117	0x00, /* 3A */
 118	0x00, /* 3B */
 119	0x00, /* 3C */
 120	0x00, /* 3D */
 121	0x00, /* 3E */
 122	0x00, /* 3F */
 123	0x00, /* 40 */
 124	0x00, /* 41 */
 125	0x00, /* 42 */
 126	0x00, /* 43 */
 127	0x00, /* 44 */
 128	0x00, /* 45 */
 129	0x00, /* 46 */
 130	0x00, /* 47 */
 131	0x00, /* 48 */
 132	0x00, /* 49 */
 133	0x00, /* 4A */
 134	0x00, /* 4B */
 135	0x00, /* 4C */
 136	0x00, /* 4D */
 137	0x00, /* 4E */
 138	0x00, /* 4F */
 139	0x00, /* 50 */
 140	0x00, /* 51 */
 141	0x00, /* 52 */
 142	0x00, /* 53 */
 143	0x00, /* 54 */
 144	0x00, /* 55 */
 145	0x00, /* 56 */
 146	0x00, /* 57 */
 147	0x00, /* 58 */
 148	0x00, /* 59 */
 149	0x00, /* 5A */
 150	0x00, /* 5B */
 151	0x00, /* 5C */
 152	0x00, /* 5D */
 153	0x00, /* 5E */
 154	0x00, /* 5F */
 155	0x00, /* 60 */
 156	0x00, /* 61 */
 157	0x00, /* 62 */
 158	0x00, /* 63 */
 159	0x00, /* 64 */
 160	0x00, /* 65 */
 161	0x00, /* 66 */
 162	0x00, /* 67 */
 163	0x00, /* 68 */
 164	0x00, /* 69 */
 165	0x00, /* 6A */
 166	0x00, /* 6B */
 167	0x00, /* 6C */
 168	0x00, /* 6D */
 169	0x00, /* 6E */
 170	0x00, /* 6F */
 171	0x00, /* 70 */
 172	0x00, /* 71 */
 173	0x00, /* 72 */
 174	0x00, /* 73 */
 175	0x00, /* 74 */
 176	0x00, /* 75 */
 177	0x00, /* 76 */
 178	0x00, /* 77 */
 179	0x00, /* 78 */
 180	0x00, /* 79 */
 181	0x00, /* 7A */
 182	0x00, /* 7B */
 183	0x00, /* 7C */
 184	0x00, /* 7D */
 185	0x00, /* 7E */
 186	0x00, /* 7F */
 187	0x00, /* 80 */
 188	0x00, /* 81 */
 189	0x00, /* 82 */
 190	0x00, /* 83 */
 191	0x00, /* 84 */
 192	0x00, /* 85 */
 193	0x00, /* 86 */
 194	0x00, /* 87 */
 195	0x00, /* 88 */
 196	0x00, /* 89 */
 197	0x00, /* 8A */
 198	0x00, /* 8B */
 199	0x00, /* 8C */
 200	0x00, /* 8D */
 201	0x00, /* 8E */
 202	0x00, /* 8F */
 203	0x00, /* 90 */
 204	0x00, /* 91 */
 205	0x30, /* 92 */
 206	0xF0, /* 93 */
 207	0x00, /* 94 */
 208	0x00, /* 95 */
 209	0x3F, /* 96 */
 210	0x00, /* 97 */
 211	0x00, /* 98 */
 212	0x00, /* 99 */
 213	0x00, /* 9A */
 214	0x00, /* 9B */
 215	0x00, /* 9C */
 216	0x00, /* 9D */
 217	0x00, /* 9E */
 218	0x00, /* 9F */
 219	0x00, /* A0 */
 220	0x00, /* A1 */
 221	0x00, /* A2 */
 222	0x00, /* A3 */
 223	0x00, /* A4 */
 224	0x00, /* A5 */
 225	0x00, /* A6 */
 226	0x00, /* A7 */
 227	0x00, /* A8 */
 228	0x00, /* A9 */
 229	0x00, /* AA */
 230	0x00, /* AB */
 231	0x00, /* AC */
 232	0x00, /* AD */
 233	0x00, /* AE */
 234	0x00, /* AF */
 235	0x00, /* B0 */
 236	0x00, /* B1 */
 237	0x00, /* B2 */
 238	0x00, /* B3 */
 239	0x00, /* B4 */
 240	0x00, /* B5 */
 241	0x00, /* B6 */
 242	0x00, /* B7 */
 243	0x00, /* B8 */
 244	0x00, /* B9 */
 245	0x00, /* BA */
 246	0x00, /* BB */
 247	0x00, /* BC */
 248	0x00, /* BD */
 249	0x00, /* BE */
 250	0x00, /* BF */
 251	0x00, /* C0 */
 252	0x00, /* C1 */
 253	0x00, /* C2 */
 254	0x00, /* C3 */
 255	0x00, /* C4 */
 256	0x00, /* C5 */
 257	0x00, /* C6 */
 258	0x00, /* C7 */
 259	0x00, /* C8 */
 260	0x00, /* C9 */
 261	0x00, /* CA */
 262	0x00, /* CB */
 263	0x00, /* CC */
 264	0x00, /* CD */
 265	0x00, /* CE */
 266	0x00, /* CF */
 267	0x00, /* D0 */
 268	0x00, /* D1 */
 269	0x00, /* D2 */
 270	0x00, /* D3 */
 271	0x00, /* D4 */
 272	0x00, /* D5 */
 273	0x00, /* D6 */
 274	0x00, /* D7 */
 275	0x00, /* D8 */
 276	0x00, /* D9 */
 277	0x00, /* DA */
 278	0x00, /* DB */
 279	0x00, /* DC */
 280	0x00, /* DD */
 281	0x00, /* DE */
 282	0x00, /* DF */
 283	0x00, /* E0 */
 284	0x00, /* E1 */
 285	0x00, /* E2 */
 286	0x00, /* E3 */
 287	0x00, /* E4 */
 288	0x00, /* E5 */
 289	0x00, /* E6 */
 290	0x00, /* E7 */
 291	0x00, /* E8 */
 292	0x00, /* E9 */
 293	0x00, /* EA */
 294	0x00, /* EB */
 295	0x00, /* EC */
 296	0x00, /* ED */
 297	0x00, /* EE */
 298	0x00, /* EF */
 299	0x00, /* F0 */
 300	0x00, /* F1 */
 301	0x00, /* F2 */
 302	0x00, /* F3 */
 303	0x00, /* F4 */
 304	0x00, /* F5 */
 305	0x00, /* F6 */
 306	0x00, /* F7 */
 307	0x00, /* F8 */
 308	0x00, /* F9 */
 309	0x00, /* FA */
 310	0x00, /* FB */
 311	0x00, /* FC */
 312	0x00, /* FD */
 313	0x00, /* FE */
 314	0x00, /* FF */
 315};
 316
 317static struct {
 318	int readable;
 319	int writable;
 320} max98095_access[M98095_REG_CNT] = {
 321	{ 0x00, 0x00 }, /* 00 */
 322	{ 0xFF, 0x00 }, /* 01 */
 323	{ 0xFF, 0x00 }, /* 02 */
 324	{ 0xFF, 0x00 }, /* 03 */
 325	{ 0xFF, 0x00 }, /* 04 */
 326	{ 0xFF, 0x00 }, /* 05 */
 327	{ 0xFF, 0x00 }, /* 06 */
 328	{ 0xFF, 0x00 }, /* 07 */
 329	{ 0xFF, 0x00 }, /* 08 */
 330	{ 0xFF, 0x00 }, /* 09 */
 331	{ 0xFF, 0x00 }, /* 0A */
 332	{ 0xFF, 0x00 }, /* 0B */
 333	{ 0xFF, 0x00 }, /* 0C */
 334	{ 0xFF, 0x00 }, /* 0D */
 335	{ 0xFF, 0x00 }, /* 0E */
 336	{ 0xFF, 0x9F }, /* 0F */
 337	{ 0xFF, 0xFF }, /* 10 */
 338	{ 0xFF, 0xFF }, /* 11 */
 339	{ 0xFF, 0xFF }, /* 12 */
 340	{ 0xFF, 0xFF }, /* 13 */
 341	{ 0xFF, 0xFF }, /* 14 */
 342	{ 0xFF, 0xFF }, /* 15 */
 343	{ 0xFF, 0xFF }, /* 16 */
 344	{ 0xFF, 0xFF }, /* 17 */
 345	{ 0xFF, 0xFF }, /* 18 */
 346	{ 0xFF, 0xFF }, /* 19 */
 347	{ 0xFF, 0xFF }, /* 1A */
 348	{ 0xFF, 0xFF }, /* 1B */
 349	{ 0xFF, 0xFF }, /* 1C */
 350	{ 0xFF, 0xFF }, /* 1D */
 351	{ 0xFF, 0x77 }, /* 1E */
 352	{ 0xFF, 0x77 }, /* 1F */
 353	{ 0xFF, 0x77 }, /* 20 */
 354	{ 0xFF, 0x77 }, /* 21 */
 355	{ 0xFF, 0x77 }, /* 22 */
 356	{ 0xFF, 0x77 }, /* 23 */
 357	{ 0xFF, 0xFF }, /* 24 */
 358	{ 0xFF, 0x7F }, /* 25 */
 359	{ 0xFF, 0x31 }, /* 26 */
 360	{ 0xFF, 0xFF }, /* 27 */
 361	{ 0xFF, 0xFF }, /* 28 */
 362	{ 0xFF, 0xFF }, /* 29 */
 363	{ 0xFF, 0xF7 }, /* 2A */
 364	{ 0xFF, 0x2F }, /* 2B */
 365	{ 0xFF, 0xEF }, /* 2C */
 366	{ 0xFF, 0xFF }, /* 2D */
 367	{ 0xFF, 0xFF }, /* 2E */
 368	{ 0xFF, 0xFF }, /* 2F */
 369	{ 0xFF, 0xFF }, /* 30 */
 370	{ 0xFF, 0xFF }, /* 31 */
 371	{ 0xFF, 0xFF }, /* 32 */
 372	{ 0xFF, 0xFF }, /* 33 */
 373	{ 0xFF, 0xF7 }, /* 34 */
 374	{ 0xFF, 0x2F }, /* 35 */
 375	{ 0xFF, 0xCF }, /* 36 */
 376	{ 0xFF, 0xFF }, /* 37 */
 377	{ 0xFF, 0xFF }, /* 38 */
 378	{ 0xFF, 0xFF }, /* 39 */
 379	{ 0xFF, 0xFF }, /* 3A */
 380	{ 0xFF, 0xFF }, /* 3B */
 381	{ 0xFF, 0xFF }, /* 3C */
 382	{ 0xFF, 0xFF }, /* 3D */
 383	{ 0xFF, 0xF7 }, /* 3E */
 384	{ 0xFF, 0x2F }, /* 3F */
 385	{ 0xFF, 0xCF }, /* 40 */
 386	{ 0xFF, 0xFF }, /* 41 */
 387	{ 0xFF, 0x77 }, /* 42 */
 388	{ 0xFF, 0xFF }, /* 43 */
 389	{ 0xFF, 0xFF }, /* 44 */
 390	{ 0xFF, 0xFF }, /* 45 */
 391	{ 0xFF, 0xFF }, /* 46 */
 392	{ 0xFF, 0xFF }, /* 47 */
 393	{ 0xFF, 0xFF }, /* 48 */
 394	{ 0xFF, 0x0F }, /* 49 */
 395	{ 0xFF, 0xFF }, /* 4A */
 396	{ 0xFF, 0xFF }, /* 4B */
 397	{ 0xFF, 0x3F }, /* 4C */
 398	{ 0xFF, 0x3F }, /* 4D */
 399	{ 0xFF, 0x3F }, /* 4E */
 400	{ 0xFF, 0xFF }, /* 4F */
 401	{ 0xFF, 0x7F }, /* 50 */
 402	{ 0xFF, 0x7F }, /* 51 */
 403	{ 0xFF, 0x0F }, /* 52 */
 404	{ 0xFF, 0x3F }, /* 53 */
 405	{ 0xFF, 0x3F }, /* 54 */
 406	{ 0xFF, 0x3F }, /* 55 */
 407	{ 0xFF, 0xFF }, /* 56 */
 408	{ 0xFF, 0xFF }, /* 57 */
 409	{ 0xFF, 0xBF }, /* 58 */
 410	{ 0xFF, 0x1F }, /* 59 */
 411	{ 0xFF, 0xBF }, /* 5A */
 412	{ 0xFF, 0x1F }, /* 5B */
 413	{ 0xFF, 0xBF }, /* 5C */
 414	{ 0xFF, 0x3F }, /* 5D */
 415	{ 0xFF, 0x3F }, /* 5E */
 416	{ 0xFF, 0x7F }, /* 5F */
 417	{ 0xFF, 0x7F }, /* 60 */
 418	{ 0xFF, 0x47 }, /* 61 */
 419	{ 0xFF, 0x9F }, /* 62 */
 420	{ 0xFF, 0x9F }, /* 63 */
 421	{ 0xFF, 0x9F }, /* 64 */
 422	{ 0xFF, 0x9F }, /* 65 */
 423	{ 0xFF, 0x9F }, /* 66 */
 424	{ 0xFF, 0xBF }, /* 67 */
 425	{ 0xFF, 0xBF }, /* 68 */
 426	{ 0xFF, 0xFF }, /* 69 */
 427	{ 0xFF, 0xFF }, /* 6A */
 428	{ 0xFF, 0x7F }, /* 6B */
 429	{ 0xFF, 0xF7 }, /* 6C */
 430	{ 0xFF, 0xFF }, /* 6D */
 431	{ 0xFF, 0xFF }, /* 6E */
 432	{ 0xFF, 0x1F }, /* 6F */
 433	{ 0xFF, 0xF7 }, /* 70 */
 434	{ 0xFF, 0xFF }, /* 71 */
 435	{ 0xFF, 0xFF }, /* 72 */
 436	{ 0xFF, 0x1F }, /* 73 */
 437	{ 0xFF, 0xF7 }, /* 74 */
 438	{ 0xFF, 0xFF }, /* 75 */
 439	{ 0xFF, 0xFF }, /* 76 */
 440	{ 0xFF, 0x1F }, /* 77 */
 441	{ 0xFF, 0xF7 }, /* 78 */
 442	{ 0xFF, 0xFF }, /* 79 */
 443	{ 0xFF, 0xFF }, /* 7A */
 444	{ 0xFF, 0x1F }, /* 7B */
 445	{ 0xFF, 0xF7 }, /* 7C */
 446	{ 0xFF, 0xFF }, /* 7D */
 447	{ 0xFF, 0xFF }, /* 7E */
 448	{ 0xFF, 0x1F }, /* 7F */
 449	{ 0xFF, 0xF7 }, /* 80 */
 450	{ 0xFF, 0xFF }, /* 81 */
 451	{ 0xFF, 0xFF }, /* 82 */
 452	{ 0xFF, 0x1F }, /* 83 */
 453	{ 0xFF, 0x7F }, /* 84 */
 454	{ 0xFF, 0x0F }, /* 85 */
 455	{ 0xFF, 0xD8 }, /* 86 */
 456	{ 0xFF, 0xFF }, /* 87 */
 457	{ 0xFF, 0xEF }, /* 88 */
 458	{ 0xFF, 0xFE }, /* 89 */
 459	{ 0xFF, 0xFE }, /* 8A */
 460	{ 0xFF, 0xFF }, /* 8B */
 461	{ 0xFF, 0xFF }, /* 8C */
 462	{ 0xFF, 0x3F }, /* 8D */
 463	{ 0xFF, 0xFF }, /* 8E */
 464	{ 0xFF, 0x3F }, /* 8F */
 465	{ 0xFF, 0x8F }, /* 90 */
 466	{ 0xFF, 0xFF }, /* 91 */
 467	{ 0xFF, 0x3F }, /* 92 */
 468	{ 0xFF, 0xFF }, /* 93 */
 469	{ 0xFF, 0xFF }, /* 94 */
 470	{ 0xFF, 0x0F }, /* 95 */
 471	{ 0xFF, 0x3F }, /* 96 */
 472	{ 0xFF, 0x8C }, /* 97 */
 473	{ 0x00, 0x00 }, /* 98 */
 474	{ 0x00, 0x00 }, /* 99 */
 475	{ 0x00, 0x00 }, /* 9A */
 476	{ 0x00, 0x00 }, /* 9B */
 477	{ 0x00, 0x00 }, /* 9C */
 478	{ 0x00, 0x00 }, /* 9D */
 479	{ 0x00, 0x00 }, /* 9E */
 480	{ 0x00, 0x00 }, /* 9F */
 481	{ 0x00, 0x00 }, /* A0 */
 482	{ 0x00, 0x00 }, /* A1 */
 483	{ 0x00, 0x00 }, /* A2 */
 484	{ 0x00, 0x00 }, /* A3 */
 485	{ 0x00, 0x00 }, /* A4 */
 486	{ 0x00, 0x00 }, /* A5 */
 487	{ 0x00, 0x00 }, /* A6 */
 488	{ 0x00, 0x00 }, /* A7 */
 489	{ 0x00, 0x00 }, /* A8 */
 490	{ 0x00, 0x00 }, /* A9 */
 491	{ 0x00, 0x00 }, /* AA */
 492	{ 0x00, 0x00 }, /* AB */
 493	{ 0x00, 0x00 }, /* AC */
 494	{ 0x00, 0x00 }, /* AD */
 495	{ 0x00, 0x00 }, /* AE */
 496	{ 0x00, 0x00 }, /* AF */
 497	{ 0x00, 0x00 }, /* B0 */
 498	{ 0x00, 0x00 }, /* B1 */
 499	{ 0x00, 0x00 }, /* B2 */
 500	{ 0x00, 0x00 }, /* B3 */
 501	{ 0x00, 0x00 }, /* B4 */
 502	{ 0x00, 0x00 }, /* B5 */
 503	{ 0x00, 0x00 }, /* B6 */
 504	{ 0x00, 0x00 }, /* B7 */
 505	{ 0x00, 0x00 }, /* B8 */
 506	{ 0x00, 0x00 }, /* B9 */
 507	{ 0x00, 0x00 }, /* BA */
 508	{ 0x00, 0x00 }, /* BB */
 509	{ 0x00, 0x00 }, /* BC */
 510	{ 0x00, 0x00 }, /* BD */
 511	{ 0x00, 0x00 }, /* BE */
 512	{ 0x00, 0x00 }, /* BF */
 513	{ 0x00, 0x00 }, /* C0 */
 514	{ 0x00, 0x00 }, /* C1 */
 515	{ 0x00, 0x00 }, /* C2 */
 516	{ 0x00, 0x00 }, /* C3 */
 517	{ 0x00, 0x00 }, /* C4 */
 518	{ 0x00, 0x00 }, /* C5 */
 519	{ 0x00, 0x00 }, /* C6 */
 520	{ 0x00, 0x00 }, /* C7 */
 521	{ 0x00, 0x00 }, /* C8 */
 522	{ 0x00, 0x00 }, /* C9 */
 523	{ 0x00, 0x00 }, /* CA */
 524	{ 0x00, 0x00 }, /* CB */
 525	{ 0x00, 0x00 }, /* CC */
 526	{ 0x00, 0x00 }, /* CD */
 527	{ 0x00, 0x00 }, /* CE */
 528	{ 0x00, 0x00 }, /* CF */
 529	{ 0x00, 0x00 }, /* D0 */
 530	{ 0x00, 0x00 }, /* D1 */
 531	{ 0x00, 0x00 }, /* D2 */
 532	{ 0x00, 0x00 }, /* D3 */
 533	{ 0x00, 0x00 }, /* D4 */
 534	{ 0x00, 0x00 }, /* D5 */
 535	{ 0x00, 0x00 }, /* D6 */
 536	{ 0x00, 0x00 }, /* D7 */
 537	{ 0x00, 0x00 }, /* D8 */
 538	{ 0x00, 0x00 }, /* D9 */
 539	{ 0x00, 0x00 }, /* DA */
 540	{ 0x00, 0x00 }, /* DB */
 541	{ 0x00, 0x00 }, /* DC */
 542	{ 0x00, 0x00 }, /* DD */
 543	{ 0x00, 0x00 }, /* DE */
 544	{ 0x00, 0x00 }, /* DF */
 545	{ 0x00, 0x00 }, /* E0 */
 546	{ 0x00, 0x00 }, /* E1 */
 547	{ 0x00, 0x00 }, /* E2 */
 548	{ 0x00, 0x00 }, /* E3 */
 549	{ 0x00, 0x00 }, /* E4 */
 550	{ 0x00, 0x00 }, /* E5 */
 551	{ 0x00, 0x00 }, /* E6 */
 552	{ 0x00, 0x00 }, /* E7 */
 553	{ 0x00, 0x00 }, /* E8 */
 554	{ 0x00, 0x00 }, /* E9 */
 555	{ 0x00, 0x00 }, /* EA */
 556	{ 0x00, 0x00 }, /* EB */
 557	{ 0x00, 0x00 }, /* EC */
 558	{ 0x00, 0x00 }, /* ED */
 559	{ 0x00, 0x00 }, /* EE */
 560	{ 0x00, 0x00 }, /* EF */
 561	{ 0x00, 0x00 }, /* F0 */
 562	{ 0x00, 0x00 }, /* F1 */
 563	{ 0x00, 0x00 }, /* F2 */
 564	{ 0x00, 0x00 }, /* F3 */
 565	{ 0x00, 0x00 }, /* F4 */
 566	{ 0x00, 0x00 }, /* F5 */
 567	{ 0x00, 0x00 }, /* F6 */
 568	{ 0x00, 0x00 }, /* F7 */
 569	{ 0x00, 0x00 }, /* F8 */
 570	{ 0x00, 0x00 }, /* F9 */
 571	{ 0x00, 0x00 }, /* FA */
 572	{ 0x00, 0x00 }, /* FB */
 573	{ 0x00, 0x00 }, /* FC */
 574	{ 0x00, 0x00 }, /* FD */
 575	{ 0x00, 0x00 }, /* FE */
 576	{ 0xFF, 0x00 }, /* FF */
 577};
 578
 579static int max98095_readable(struct snd_soc_codec *codec, unsigned int reg)
 580{
 581	if (reg >= M98095_REG_CNT)
 582		return 0;
 583	return max98095_access[reg].readable != 0;
 
 
 
 584}
 585
 586static int max98095_volatile(struct snd_soc_codec *codec, unsigned int reg)
 587{
 588	if (reg > M98095_REG_MAX_CACHED)
 589		return 1;
 590
 591	switch (reg) {
 592	case M98095_000_HOST_DATA:
 593	case M98095_001_HOST_INT_STS:
 594	case M98095_002_HOST_RSP_STS:
 595	case M98095_003_HOST_CMD_STS:
 596	case M98095_004_CODEC_STS:
 597	case M98095_005_DAI1_ALC_STS:
 598	case M98095_006_DAI2_ALC_STS:
 599	case M98095_007_JACK_AUTO_STS:
 600	case M98095_008_JACK_MANUAL_STS:
 601	case M98095_009_JACK_VBAT_STS:
 602	case M98095_00A_ACC_ADC_STS:
 603	case M98095_00B_MIC_NG_AGC_STS:
 604	case M98095_00C_SPK_L_VOLT_STS:
 605	case M98095_00D_SPK_R_VOLT_STS:
 606	case M98095_00E_TEMP_SENSOR_STS:
 607		return 1;
 608	}
 
 609
 610	return 0;
 611}
 
 612
 613/*
 614 * Filter coefficients are in a separate register segment
 615 * and they share the address space of the normal registers.
 616 * The coefficient registers do not need or share the cache.
 617 */
 618static int max98095_hw_write(struct snd_soc_codec *codec, unsigned int reg,
 619			     unsigned int value)
 620{
 621	u8 data[2];
 622
 623	data[0] = reg;
 624	data[1] = value;
 625	if (codec->hw_write(codec->control_data, data, 2) == 2)
 626		return 0;
 627	else
 628		return -EIO;
 629}
 630
 631/*
 632 * Load equalizer DSP coefficient configurations registers
 633 */
 634static void m98095_eq_band(struct snd_soc_codec *codec, unsigned int dai,
 635		    unsigned int band, u16 *coefs)
 636{
 637	unsigned int eq_reg;
 638	unsigned int i;
 639
 640	BUG_ON(band > 4);
 641	BUG_ON(dai > 1);
 
 642
 643	/* Load the base register address */
 644	eq_reg = dai ? M98095_142_DAI2_EQ_BASE : M98095_110_DAI1_EQ_BASE;
 645
 646	/* Add the band address offset, note adjustment for word address */
 647	eq_reg += band * (M98095_COEFS_PER_BAND << 1);
 648
 649	/* Step through the registers and coefs */
 650	for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
 651		max98095_hw_write(codec, eq_reg++, M98095_BYTE1(coefs[i]));
 652		max98095_hw_write(codec, eq_reg++, M98095_BYTE0(coefs[i]));
 653	}
 654}
 655
 656/*
 657 * Load biquad filter coefficient configurations registers
 658 */
 659static void m98095_biquad_band(struct snd_soc_codec *codec, unsigned int dai,
 660		    unsigned int band, u16 *coefs)
 661{
 662	unsigned int bq_reg;
 663	unsigned int i;
 664
 665	BUG_ON(band > 1);
 666	BUG_ON(dai > 1);
 
 667
 668	/* Load the base register address */
 669	bq_reg = dai ? M98095_17E_DAI2_BQ_BASE : M98095_174_DAI1_BQ_BASE;
 670
 671	/* Add the band address offset, note adjustment for word address */
 672	bq_reg += band * (M98095_COEFS_PER_BAND << 1);
 673
 674	/* Step through the registers and coefs */
 675	for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
 676		max98095_hw_write(codec, bq_reg++, M98095_BYTE1(coefs[i]));
 677		max98095_hw_write(codec, bq_reg++, M98095_BYTE0(coefs[i]));
 678	}
 679}
 680
 681static const char * const max98095_fltr_mode[] = { "Voice", "Music" };
 682static const struct soc_enum max98095_dai1_filter_mode_enum[] = {
 683	SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 7, 2, max98095_fltr_mode),
 684};
 685static const struct soc_enum max98095_dai2_filter_mode_enum[] = {
 686	SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 7, 2, max98095_fltr_mode),
 687};
 688
 689static const char * const max98095_extmic_text[] = { "None", "MIC1", "MIC2" };
 690
 691static const struct soc_enum max98095_extmic_enum =
 692	SOC_ENUM_SINGLE(M98095_087_CFG_MIC, 0, 3, max98095_extmic_text);
 
 693
 694static const struct snd_kcontrol_new max98095_extmic_mux =
 695	SOC_DAPM_ENUM("External MIC Mux", max98095_extmic_enum);
 696
 697static const char * const max98095_linein_text[] = { "INA", "INB" };
 698
 699static const struct soc_enum max98095_linein_enum =
 700	SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 6, 2, max98095_linein_text);
 
 701
 702static const struct snd_kcontrol_new max98095_linein_mux =
 703	SOC_DAPM_ENUM("Linein Input Mux", max98095_linein_enum);
 704
 705static const char * const max98095_line_mode_text[] = {
 706	"Stereo", "Differential"};
 707
 708static const struct soc_enum max98095_linein_mode_enum =
 709	SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 7, 2, max98095_line_mode_text);
 710
 711static const struct soc_enum max98095_lineout_mode_enum =
 712	SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 4, 2, max98095_line_mode_text);
 
 
 713
 714static const char * const max98095_dai_fltr[] = {
 715	"Off", "Elliptical-HPF-16k", "Butterworth-HPF-16k",
 716	"Elliptical-HPF-8k", "Butterworth-HPF-8k", "Butterworth-HPF-Fs/240"};
 717static const struct soc_enum max98095_dai1_dac_filter_enum[] = {
 718	SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 0, 6, max98095_dai_fltr),
 719};
 720static const struct soc_enum max98095_dai2_dac_filter_enum[] = {
 721	SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 0, 6, max98095_dai_fltr),
 722};
 723static const struct soc_enum max98095_dai3_dac_filter_enum[] = {
 724	SOC_ENUM_SINGLE(M98095_042_DAI3_FILTERS, 0, 6, max98095_dai_fltr),
 725};
 726
 727static int max98095_mic1pre_set(struct snd_kcontrol *kcontrol,
 728				struct snd_ctl_elem_value *ucontrol)
 729{
 730	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 731	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
 732	unsigned int sel = ucontrol->value.integer.value[0];
 733
 734	max98095->mic1pre = sel;
 735	snd_soc_update_bits(codec, M98095_05F_LVL_MIC1, M98095_MICPRE_MASK,
 736		(1+sel)<<M98095_MICPRE_SHIFT);
 737
 738	return 0;
 739}
 740
 741static int max98095_mic1pre_get(struct snd_kcontrol *kcontrol,
 742				struct snd_ctl_elem_value *ucontrol)
 743{
 744	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 745	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
 746
 747	ucontrol->value.integer.value[0] = max98095->mic1pre;
 748	return 0;
 749}
 750
 751static int max98095_mic2pre_set(struct snd_kcontrol *kcontrol,
 752				struct snd_ctl_elem_value *ucontrol)
 753{
 754	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 755	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
 756	unsigned int sel = ucontrol->value.integer.value[0];
 757
 758	max98095->mic2pre = sel;
 759	snd_soc_update_bits(codec, M98095_060_LVL_MIC2, M98095_MICPRE_MASK,
 760		(1+sel)<<M98095_MICPRE_SHIFT);
 761
 762	return 0;
 763}
 764
 765static int max98095_mic2pre_get(struct snd_kcontrol *kcontrol,
 766				struct snd_ctl_elem_value *ucontrol)
 767{
 768	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 769	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
 770
 771	ucontrol->value.integer.value[0] = max98095->mic2pre;
 772	return 0;
 773}
 774
 775static const unsigned int max98095_micboost_tlv[] = {
 776	TLV_DB_RANGE_HEAD(2),
 777	0, 1, TLV_DB_SCALE_ITEM(0, 2000, 0),
 778	2, 2, TLV_DB_SCALE_ITEM(3000, 0, 0),
 779};
 780
 781static const DECLARE_TLV_DB_SCALE(max98095_mic_tlv, 0, 100, 0);
 782static const DECLARE_TLV_DB_SCALE(max98095_adc_tlv, -1200, 100, 0);
 783static const DECLARE_TLV_DB_SCALE(max98095_adcboost_tlv, 0, 600, 0);
 784
 785static const unsigned int max98095_hp_tlv[] = {
 786	TLV_DB_RANGE_HEAD(5),
 787	0, 6, TLV_DB_SCALE_ITEM(-6700, 400, 0),
 788	7, 14, TLV_DB_SCALE_ITEM(-4000, 300, 0),
 789	15, 21, TLV_DB_SCALE_ITEM(-1700, 200, 0),
 790	22, 27, TLV_DB_SCALE_ITEM(-400, 100, 0),
 791	28, 31, TLV_DB_SCALE_ITEM(150, 50, 0),
 792};
 793
 794static const unsigned int max98095_spk_tlv[] = {
 795	TLV_DB_RANGE_HEAD(4),
 796	0, 10, TLV_DB_SCALE_ITEM(-5900, 400, 0),
 797	11, 18, TLV_DB_SCALE_ITEM(-1700, 200, 0),
 798	19, 27, TLV_DB_SCALE_ITEM(-200, 100, 0),
 799	28, 39, TLV_DB_SCALE_ITEM(650, 50, 0),
 800};
 801
 802static const unsigned int max98095_rcv_lout_tlv[] = {
 803	TLV_DB_RANGE_HEAD(5),
 804	0, 6, TLV_DB_SCALE_ITEM(-6200, 400, 0),
 805	7, 14, TLV_DB_SCALE_ITEM(-3500, 300, 0),
 806	15, 21, TLV_DB_SCALE_ITEM(-1200, 200, 0),
 807	22, 27, TLV_DB_SCALE_ITEM(100, 100, 0),
 808	28, 31, TLV_DB_SCALE_ITEM(650, 50, 0),
 809};
 810
 811static const unsigned int max98095_lin_tlv[] = {
 812	TLV_DB_RANGE_HEAD(3),
 813	0, 2, TLV_DB_SCALE_ITEM(-600, 300, 0),
 814	3, 3, TLV_DB_SCALE_ITEM(300, 1100, 0),
 815	4, 5, TLV_DB_SCALE_ITEM(1400, 600, 0),
 816};
 817
 818static const struct snd_kcontrol_new max98095_snd_controls[] = {
 819
 820	SOC_DOUBLE_R_TLV("Headphone Volume", M98095_064_LVL_HP_L,
 821		M98095_065_LVL_HP_R, 0, 31, 0, max98095_hp_tlv),
 822
 823	SOC_DOUBLE_R_TLV("Speaker Volume", M98095_067_LVL_SPK_L,
 824		M98095_068_LVL_SPK_R, 0, 39, 0, max98095_spk_tlv),
 825
 826	SOC_SINGLE_TLV("Receiver Volume", M98095_066_LVL_RCV,
 827		0, 31, 0, max98095_rcv_lout_tlv),
 828
 829	SOC_DOUBLE_R_TLV("Lineout Volume", M98095_062_LVL_LINEOUT1,
 830		M98095_063_LVL_LINEOUT2, 0, 31, 0, max98095_rcv_lout_tlv),
 831
 832	SOC_DOUBLE_R("Headphone Switch", M98095_064_LVL_HP_L,
 833		M98095_065_LVL_HP_R, 7, 1, 1),
 834
 835	SOC_DOUBLE_R("Speaker Switch", M98095_067_LVL_SPK_L,
 836		M98095_068_LVL_SPK_R, 7, 1, 1),
 837
 838	SOC_SINGLE("Receiver Switch", M98095_066_LVL_RCV, 7, 1, 1),
 839
 840	SOC_DOUBLE_R("Lineout Switch", M98095_062_LVL_LINEOUT1,
 841		M98095_063_LVL_LINEOUT2, 7, 1, 1),
 842
 843	SOC_SINGLE_TLV("MIC1 Volume", M98095_05F_LVL_MIC1, 0, 20, 1,
 844		max98095_mic_tlv),
 845
 846	SOC_SINGLE_TLV("MIC2 Volume", M98095_060_LVL_MIC2, 0, 20, 1,
 847		max98095_mic_tlv),
 848
 849	SOC_SINGLE_EXT_TLV("MIC1 Boost Volume",
 850			M98095_05F_LVL_MIC1, 5, 2, 0,
 851			max98095_mic1pre_get, max98095_mic1pre_set,
 852			max98095_micboost_tlv),
 853	SOC_SINGLE_EXT_TLV("MIC2 Boost Volume",
 854			M98095_060_LVL_MIC2, 5, 2, 0,
 855			max98095_mic2pre_get, max98095_mic2pre_set,
 856			max98095_micboost_tlv),
 857
 858	SOC_SINGLE_TLV("Linein Volume", M98095_061_LVL_LINEIN, 0, 5, 1,
 859		max98095_lin_tlv),
 860
 861	SOC_SINGLE_TLV("ADCL Volume", M98095_05D_LVL_ADC_L, 0, 15, 1,
 862		max98095_adc_tlv),
 863	SOC_SINGLE_TLV("ADCR Volume", M98095_05E_LVL_ADC_R, 0, 15, 1,
 864		max98095_adc_tlv),
 865
 866	SOC_SINGLE_TLV("ADCL Boost Volume", M98095_05D_LVL_ADC_L, 4, 3, 0,
 867		max98095_adcboost_tlv),
 868	SOC_SINGLE_TLV("ADCR Boost Volume", M98095_05E_LVL_ADC_R, 4, 3, 0,
 869		max98095_adcboost_tlv),
 870
 871	SOC_SINGLE("EQ1 Switch", M98095_088_CFG_LEVEL, 0, 1, 0),
 872	SOC_SINGLE("EQ2 Switch", M98095_088_CFG_LEVEL, 1, 1, 0),
 873
 874	SOC_SINGLE("Biquad1 Switch", M98095_088_CFG_LEVEL, 2, 1, 0),
 875	SOC_SINGLE("Biquad2 Switch", M98095_088_CFG_LEVEL, 3, 1, 0),
 876
 877	SOC_ENUM("DAI1 Filter Mode", max98095_dai1_filter_mode_enum),
 878	SOC_ENUM("DAI2 Filter Mode", max98095_dai2_filter_mode_enum),
 879	SOC_ENUM("DAI1 DAC Filter", max98095_dai1_dac_filter_enum),
 880	SOC_ENUM("DAI2 DAC Filter", max98095_dai2_dac_filter_enum),
 881	SOC_ENUM("DAI3 DAC Filter", max98095_dai3_dac_filter_enum),
 882
 883	SOC_ENUM("Linein Mode", max98095_linein_mode_enum),
 884	SOC_ENUM("Lineout Mode", max98095_lineout_mode_enum),
 885};
 886
 887/* Left speaker mixer switch */
 888static const struct snd_kcontrol_new max98095_left_speaker_mixer_controls[] = {
 889	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_050_MIX_SPK_LEFT, 0, 1, 0),
 890	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_050_MIX_SPK_LEFT, 6, 1, 0),
 891	SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
 892	SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
 893	SOC_DAPM_SINGLE("MIC1 Switch", M98095_050_MIX_SPK_LEFT, 4, 1, 0),
 894	SOC_DAPM_SINGLE("MIC2 Switch", M98095_050_MIX_SPK_LEFT, 5, 1, 0),
 895	SOC_DAPM_SINGLE("IN1 Switch", M98095_050_MIX_SPK_LEFT, 1, 1, 0),
 896	SOC_DAPM_SINGLE("IN2 Switch", M98095_050_MIX_SPK_LEFT, 2, 1, 0),
 897};
 898
 899/* Right speaker mixer switch */
 900static const struct snd_kcontrol_new max98095_right_speaker_mixer_controls[] = {
 901	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 6, 1, 0),
 902	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 0, 1, 0),
 903	SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
 904	SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
 905	SOC_DAPM_SINGLE("MIC1 Switch", M98095_051_MIX_SPK_RIGHT, 5, 1, 0),
 906	SOC_DAPM_SINGLE("MIC2 Switch", M98095_051_MIX_SPK_RIGHT, 4, 1, 0),
 907	SOC_DAPM_SINGLE("IN1 Switch", M98095_051_MIX_SPK_RIGHT, 1, 1, 0),
 908	SOC_DAPM_SINGLE("IN2 Switch", M98095_051_MIX_SPK_RIGHT, 2, 1, 0),
 909};
 910
 911/* Left headphone mixer switch */
 912static const struct snd_kcontrol_new max98095_left_hp_mixer_controls[] = {
 913	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04C_MIX_HP_LEFT, 0, 1, 0),
 914	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04C_MIX_HP_LEFT, 5, 1, 0),
 915	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04C_MIX_HP_LEFT, 3, 1, 0),
 916	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04C_MIX_HP_LEFT, 4, 1, 0),
 917	SOC_DAPM_SINGLE("IN1 Switch", M98095_04C_MIX_HP_LEFT, 1, 1, 0),
 918	SOC_DAPM_SINGLE("IN2 Switch", M98095_04C_MIX_HP_LEFT, 2, 1, 0),
 919};
 920
 921/* Right headphone mixer switch */
 922static const struct snd_kcontrol_new max98095_right_hp_mixer_controls[] = {
 923	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 5, 1, 0),
 924	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 0, 1, 0),
 925	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04D_MIX_HP_RIGHT, 3, 1, 0),
 926	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04D_MIX_HP_RIGHT, 4, 1, 0),
 927	SOC_DAPM_SINGLE("IN1 Switch", M98095_04D_MIX_HP_RIGHT, 1, 1, 0),
 928	SOC_DAPM_SINGLE("IN2 Switch", M98095_04D_MIX_HP_RIGHT, 2, 1, 0),
 929};
 930
 931/* Receiver earpiece mixer switch */
 932static const struct snd_kcontrol_new max98095_mono_rcv_mixer_controls[] = {
 933	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04F_MIX_RCV, 0, 1, 0),
 934	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04F_MIX_RCV, 5, 1, 0),
 935	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04F_MIX_RCV, 3, 1, 0),
 936	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04F_MIX_RCV, 4, 1, 0),
 937	SOC_DAPM_SINGLE("IN1 Switch", M98095_04F_MIX_RCV, 1, 1, 0),
 938	SOC_DAPM_SINGLE("IN2 Switch", M98095_04F_MIX_RCV, 2, 1, 0),
 939};
 940
 941/* Left lineout mixer switch */
 942static const struct snd_kcontrol_new max98095_left_lineout_mixer_controls[] = {
 943	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_053_MIX_LINEOUT1, 5, 1, 0),
 944	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_053_MIX_LINEOUT1, 0, 1, 0),
 945	SOC_DAPM_SINGLE("MIC1 Switch", M98095_053_MIX_LINEOUT1, 3, 1, 0),
 946	SOC_DAPM_SINGLE("MIC2 Switch", M98095_053_MIX_LINEOUT1, 4, 1, 0),
 947	SOC_DAPM_SINGLE("IN1 Switch", M98095_053_MIX_LINEOUT1, 1, 1, 0),
 948	SOC_DAPM_SINGLE("IN2 Switch", M98095_053_MIX_LINEOUT1, 2, 1, 0),
 949};
 950
 951/* Right lineout mixer switch */
 952static const struct snd_kcontrol_new max98095_right_lineout_mixer_controls[] = {
 953	SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_054_MIX_LINEOUT2, 0, 1, 0),
 954	SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_054_MIX_LINEOUT2, 5, 1, 0),
 955	SOC_DAPM_SINGLE("MIC1 Switch", M98095_054_MIX_LINEOUT2, 3, 1, 0),
 956	SOC_DAPM_SINGLE("MIC2 Switch", M98095_054_MIX_LINEOUT2, 4, 1, 0),
 957	SOC_DAPM_SINGLE("IN1 Switch", M98095_054_MIX_LINEOUT2, 1, 1, 0),
 958	SOC_DAPM_SINGLE("IN2 Switch", M98095_054_MIX_LINEOUT2, 2, 1, 0),
 959};
 960
 961/* Left ADC mixer switch */
 962static const struct snd_kcontrol_new max98095_left_ADC_mixer_controls[] = {
 963	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04A_MIX_ADC_LEFT, 7, 1, 0),
 964	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04A_MIX_ADC_LEFT, 6, 1, 0),
 965	SOC_DAPM_SINGLE("IN1 Switch", M98095_04A_MIX_ADC_LEFT, 3, 1, 0),
 966	SOC_DAPM_SINGLE("IN2 Switch", M98095_04A_MIX_ADC_LEFT, 2, 1, 0),
 967};
 968
 969/* Right ADC mixer switch */
 970static const struct snd_kcontrol_new max98095_right_ADC_mixer_controls[] = {
 971	SOC_DAPM_SINGLE("MIC1 Switch", M98095_04B_MIX_ADC_RIGHT, 7, 1, 0),
 972	SOC_DAPM_SINGLE("MIC2 Switch", M98095_04B_MIX_ADC_RIGHT, 6, 1, 0),
 973	SOC_DAPM_SINGLE("IN1 Switch", M98095_04B_MIX_ADC_RIGHT, 3, 1, 0),
 974	SOC_DAPM_SINGLE("IN2 Switch", M98095_04B_MIX_ADC_RIGHT, 2, 1, 0),
 975};
 976
 977static int max98095_mic_event(struct snd_soc_dapm_widget *w,
 978			     struct snd_kcontrol *kcontrol, int event)
 979{
 980	struct snd_soc_codec *codec = w->codec;
 981	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
 982
 983	switch (event) {
 984	case SND_SOC_DAPM_POST_PMU:
 985		if (w->reg == M98095_05F_LVL_MIC1) {
 986			snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
 987				(1+max98095->mic1pre)<<M98095_MICPRE_SHIFT);
 988		} else {
 989			snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
 990				(1+max98095->mic2pre)<<M98095_MICPRE_SHIFT);
 991		}
 992		break;
 993	case SND_SOC_DAPM_POST_PMD:
 994		snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK, 0);
 995		break;
 996	default:
 997		return -EINVAL;
 998	}
 999
1000	return 0;
1001}
1002
1003/*
1004 * The line inputs are stereo inputs with the left and right
1005 * channels sharing a common PGA power control signal.
1006 */
1007static int max98095_line_pga(struct snd_soc_dapm_widget *w,
1008			     int event, u8 channel)
1009{
1010	struct snd_soc_codec *codec = w->codec;
1011	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1012	u8 *state;
1013
1014	BUG_ON(!((channel == 1) || (channel == 2)));
 
1015
1016	state = &max98095->lin_state;
1017
1018	switch (event) {
1019	case SND_SOC_DAPM_POST_PMU:
1020		*state |= channel;
1021		snd_soc_update_bits(codec, w->reg,
1022			(1 << w->shift), (1 << w->shift));
1023		break;
1024	case SND_SOC_DAPM_POST_PMD:
1025		*state &= ~channel;
1026		if (*state == 0) {
1027			snd_soc_update_bits(codec, w->reg,
1028				(1 << w->shift), 0);
1029		}
1030		break;
1031	default:
1032		return -EINVAL;
1033	}
1034
1035	return 0;
1036}
1037
1038static int max98095_pga_in1_event(struct snd_soc_dapm_widget *w,
1039				   struct snd_kcontrol *k, int event)
1040{
1041	return max98095_line_pga(w, event, 1);
1042}
1043
1044static int max98095_pga_in2_event(struct snd_soc_dapm_widget *w,
1045				   struct snd_kcontrol *k, int event)
1046{
1047	return max98095_line_pga(w, event, 2);
1048}
1049
1050/*
1051 * The stereo line out mixer outputs to two stereo line outs.
1052 * The 2nd pair has a separate set of enables.
1053 */
1054static int max98095_lineout_event(struct snd_soc_dapm_widget *w,
1055			     struct snd_kcontrol *kcontrol, int event)
1056{
1057	struct snd_soc_codec *codec = w->codec;
1058
1059	switch (event) {
1060	case SND_SOC_DAPM_POST_PMU:
1061		snd_soc_update_bits(codec, w->reg,
1062			(1 << (w->shift+2)), (1 << (w->shift+2)));
1063		break;
1064	case SND_SOC_DAPM_POST_PMD:
1065		snd_soc_update_bits(codec, w->reg,
1066			(1 << (w->shift+2)), 0);
1067		break;
1068	default:
1069		return -EINVAL;
1070	}
1071
1072	return 0;
1073}
1074
1075static const struct snd_soc_dapm_widget max98095_dapm_widgets[] = {
1076
1077	SND_SOC_DAPM_ADC("ADCL", "HiFi Capture", M98095_090_PWR_EN_IN, 0, 0),
1078	SND_SOC_DAPM_ADC("ADCR", "HiFi Capture", M98095_090_PWR_EN_IN, 1, 0),
1079
1080	SND_SOC_DAPM_DAC("DACL1", "HiFi Playback",
1081		M98095_091_PWR_EN_OUT, 0, 0),
1082	SND_SOC_DAPM_DAC("DACR1", "HiFi Playback",
1083		M98095_091_PWR_EN_OUT, 1, 0),
1084	SND_SOC_DAPM_DAC("DACM2", "Aux Playback",
1085		M98095_091_PWR_EN_OUT, 2, 0),
1086	SND_SOC_DAPM_DAC("DACM3", "Voice Playback",
1087		M98095_091_PWR_EN_OUT, 2, 0),
1088
1089	SND_SOC_DAPM_PGA("HP Left Out", M98095_091_PWR_EN_OUT,
1090		6, 0, NULL, 0),
1091	SND_SOC_DAPM_PGA("HP Right Out", M98095_091_PWR_EN_OUT,
1092		7, 0, NULL, 0),
1093
1094	SND_SOC_DAPM_PGA("SPK Left Out", M98095_091_PWR_EN_OUT,
1095		4, 0, NULL, 0),
1096	SND_SOC_DAPM_PGA("SPK Right Out", M98095_091_PWR_EN_OUT,
1097		5, 0, NULL, 0),
1098
1099	SND_SOC_DAPM_PGA("RCV Mono Out", M98095_091_PWR_EN_OUT,
1100		3, 0, NULL, 0),
1101
1102	SND_SOC_DAPM_PGA_E("LINE Left Out", M98095_092_PWR_EN_OUT,
1103		0, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
1104	SND_SOC_DAPM_PGA_E("LINE Right Out", M98095_092_PWR_EN_OUT,
1105		1, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
1106
1107	SND_SOC_DAPM_MUX("External MIC", SND_SOC_NOPM, 0, 0,
1108		&max98095_extmic_mux),
1109
1110	SND_SOC_DAPM_MUX("Linein Mux", SND_SOC_NOPM, 0, 0,
1111		&max98095_linein_mux),
1112
1113	SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
1114		&max98095_left_hp_mixer_controls[0],
1115		ARRAY_SIZE(max98095_left_hp_mixer_controls)),
1116
1117	SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
1118		&max98095_right_hp_mixer_controls[0],
1119		ARRAY_SIZE(max98095_right_hp_mixer_controls)),
1120
1121	SND_SOC_DAPM_MIXER("Left Speaker Mixer", SND_SOC_NOPM, 0, 0,
1122		&max98095_left_speaker_mixer_controls[0],
1123		ARRAY_SIZE(max98095_left_speaker_mixer_controls)),
1124
1125	SND_SOC_DAPM_MIXER("Right Speaker Mixer", SND_SOC_NOPM, 0, 0,
1126		&max98095_right_speaker_mixer_controls[0],
1127		ARRAY_SIZE(max98095_right_speaker_mixer_controls)),
1128
1129	SND_SOC_DAPM_MIXER("Receiver Mixer", SND_SOC_NOPM, 0, 0,
1130	  &max98095_mono_rcv_mixer_controls[0],
1131		ARRAY_SIZE(max98095_mono_rcv_mixer_controls)),
1132
1133	SND_SOC_DAPM_MIXER("Left Lineout Mixer", SND_SOC_NOPM, 0, 0,
1134		&max98095_left_lineout_mixer_controls[0],
1135		ARRAY_SIZE(max98095_left_lineout_mixer_controls)),
1136
1137	SND_SOC_DAPM_MIXER("Right Lineout Mixer", SND_SOC_NOPM, 0, 0,
1138		&max98095_right_lineout_mixer_controls[0],
1139		ARRAY_SIZE(max98095_right_lineout_mixer_controls)),
1140
1141	SND_SOC_DAPM_MIXER("Left ADC Mixer", SND_SOC_NOPM, 0, 0,
1142		&max98095_left_ADC_mixer_controls[0],
1143		ARRAY_SIZE(max98095_left_ADC_mixer_controls)),
1144
1145	SND_SOC_DAPM_MIXER("Right ADC Mixer", SND_SOC_NOPM, 0, 0,
1146		&max98095_right_ADC_mixer_controls[0],
1147		ARRAY_SIZE(max98095_right_ADC_mixer_controls)),
1148
1149	SND_SOC_DAPM_PGA_E("MIC1 Input", M98095_05F_LVL_MIC1,
1150		5, 0, NULL, 0, max98095_mic_event,
1151		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1152
1153	SND_SOC_DAPM_PGA_E("MIC2 Input", M98095_060_LVL_MIC2,
1154		5, 0, NULL, 0, max98095_mic_event,
1155		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1156
1157	SND_SOC_DAPM_PGA_E("IN1 Input", M98095_090_PWR_EN_IN,
1158		7, 0, NULL, 0, max98095_pga_in1_event,
1159		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1160
1161	SND_SOC_DAPM_PGA_E("IN2 Input", M98095_090_PWR_EN_IN,
1162		7, 0, NULL, 0, max98095_pga_in2_event,
1163		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1164
1165	SND_SOC_DAPM_MICBIAS("MICBIAS1", M98095_090_PWR_EN_IN, 2, 0),
1166	SND_SOC_DAPM_MICBIAS("MICBIAS2", M98095_090_PWR_EN_IN, 3, 0),
1167
1168	SND_SOC_DAPM_OUTPUT("HPL"),
1169	SND_SOC_DAPM_OUTPUT("HPR"),
1170	SND_SOC_DAPM_OUTPUT("SPKL"),
1171	SND_SOC_DAPM_OUTPUT("SPKR"),
1172	SND_SOC_DAPM_OUTPUT("RCV"),
1173	SND_SOC_DAPM_OUTPUT("OUT1"),
1174	SND_SOC_DAPM_OUTPUT("OUT2"),
1175	SND_SOC_DAPM_OUTPUT("OUT3"),
1176	SND_SOC_DAPM_OUTPUT("OUT4"),
1177
1178	SND_SOC_DAPM_INPUT("MIC1"),
1179	SND_SOC_DAPM_INPUT("MIC2"),
1180	SND_SOC_DAPM_INPUT("INA1"),
1181	SND_SOC_DAPM_INPUT("INA2"),
1182	SND_SOC_DAPM_INPUT("INB1"),
1183	SND_SOC_DAPM_INPUT("INB2"),
1184};
1185
1186static const struct snd_soc_dapm_route max98095_audio_map[] = {
1187	/* Left headphone output mixer */
1188	{"Left Headphone Mixer", "Left DAC1 Switch", "DACL1"},
1189	{"Left Headphone Mixer", "Right DAC1 Switch", "DACR1"},
1190	{"Left Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
1191	{"Left Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
1192	{"Left Headphone Mixer", "IN1 Switch", "IN1 Input"},
1193	{"Left Headphone Mixer", "IN2 Switch", "IN2 Input"},
1194
1195	/* Right headphone output mixer */
1196	{"Right Headphone Mixer", "Left DAC1 Switch", "DACL1"},
1197	{"Right Headphone Mixer", "Right DAC1 Switch", "DACR1"},
1198	{"Right Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
1199	{"Right Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
1200	{"Right Headphone Mixer", "IN1 Switch", "IN1 Input"},
1201	{"Right Headphone Mixer", "IN2 Switch", "IN2 Input"},
1202
1203	/* Left speaker output mixer */
1204	{"Left Speaker Mixer", "Left DAC1 Switch", "DACL1"},
1205	{"Left Speaker Mixer", "Right DAC1 Switch", "DACR1"},
1206	{"Left Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
1207	{"Left Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
1208	{"Left Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
1209	{"Left Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
1210	{"Left Speaker Mixer", "IN1 Switch", "IN1 Input"},
1211	{"Left Speaker Mixer", "IN2 Switch", "IN2 Input"},
1212
1213	/* Right speaker output mixer */
1214	{"Right Speaker Mixer", "Left DAC1 Switch", "DACL1"},
1215	{"Right Speaker Mixer", "Right DAC1 Switch", "DACR1"},
1216	{"Right Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
1217	{"Right Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
1218	{"Right Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
1219	{"Right Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
1220	{"Right Speaker Mixer", "IN1 Switch", "IN1 Input"},
1221	{"Right Speaker Mixer", "IN2 Switch", "IN2 Input"},
1222
1223	/* Earpiece/Receiver output mixer */
1224	{"Receiver Mixer", "Left DAC1 Switch", "DACL1"},
1225	{"Receiver Mixer", "Right DAC1 Switch", "DACR1"},
1226	{"Receiver Mixer", "MIC1 Switch", "MIC1 Input"},
1227	{"Receiver Mixer", "MIC2 Switch", "MIC2 Input"},
1228	{"Receiver Mixer", "IN1 Switch", "IN1 Input"},
1229	{"Receiver Mixer", "IN2 Switch", "IN2 Input"},
1230
1231	/* Left Lineout output mixer */
1232	{"Left Lineout Mixer", "Left DAC1 Switch", "DACL1"},
1233	{"Left Lineout Mixer", "Right DAC1 Switch", "DACR1"},
1234	{"Left Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
1235	{"Left Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
1236	{"Left Lineout Mixer", "IN1 Switch", "IN1 Input"},
1237	{"Left Lineout Mixer", "IN2 Switch", "IN2 Input"},
1238
1239	/* Right lineout output mixer */
1240	{"Right Lineout Mixer", "Left DAC1 Switch", "DACL1"},
1241	{"Right Lineout Mixer", "Right DAC1 Switch", "DACR1"},
1242	{"Right Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
1243	{"Right Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
1244	{"Right Lineout Mixer", "IN1 Switch", "IN1 Input"},
1245	{"Right Lineout Mixer", "IN2 Switch", "IN2 Input"},
1246
1247	{"HP Left Out", NULL, "Left Headphone Mixer"},
1248	{"HP Right Out", NULL, "Right Headphone Mixer"},
1249	{"SPK Left Out", NULL, "Left Speaker Mixer"},
1250	{"SPK Right Out", NULL, "Right Speaker Mixer"},
1251	{"RCV Mono Out", NULL, "Receiver Mixer"},
1252	{"LINE Left Out", NULL, "Left Lineout Mixer"},
1253	{"LINE Right Out", NULL, "Right Lineout Mixer"},
1254
1255	{"HPL", NULL, "HP Left Out"},
1256	{"HPR", NULL, "HP Right Out"},
1257	{"SPKL", NULL, "SPK Left Out"},
1258	{"SPKR", NULL, "SPK Right Out"},
1259	{"RCV", NULL, "RCV Mono Out"},
1260	{"OUT1", NULL, "LINE Left Out"},
1261	{"OUT2", NULL, "LINE Right Out"},
1262	{"OUT3", NULL, "LINE Left Out"},
1263	{"OUT4", NULL, "LINE Right Out"},
1264
1265	/* Left ADC input mixer */
1266	{"Left ADC Mixer", "MIC1 Switch", "MIC1 Input"},
1267	{"Left ADC Mixer", "MIC2 Switch", "MIC2 Input"},
1268	{"Left ADC Mixer", "IN1 Switch", "IN1 Input"},
1269	{"Left ADC Mixer", "IN2 Switch", "IN2 Input"},
1270
1271	/* Right ADC input mixer */
1272	{"Right ADC Mixer", "MIC1 Switch", "MIC1 Input"},
1273	{"Right ADC Mixer", "MIC2 Switch", "MIC2 Input"},
1274	{"Right ADC Mixer", "IN1 Switch", "IN1 Input"},
1275	{"Right ADC Mixer", "IN2 Switch", "IN2 Input"},
1276
1277	/* Inputs */
1278	{"ADCL", NULL, "Left ADC Mixer"},
1279	{"ADCR", NULL, "Right ADC Mixer"},
1280
1281	{"IN1 Input", NULL, "INA1"},
1282	{"IN2 Input", NULL, "INA2"},
1283
1284	{"MIC1 Input", NULL, "MIC1"},
1285	{"MIC2 Input", NULL, "MIC2"},
1286};
1287
1288static int max98095_add_widgets(struct snd_soc_codec *codec)
1289{
1290	snd_soc_add_controls(codec, max98095_snd_controls,
1291			     ARRAY_SIZE(max98095_snd_controls));
1292
1293	return 0;
1294}
1295
1296/* codec mclk clock divider coefficients */
1297static const struct {
1298	u32 rate;
1299	u8  sr;
1300} rate_table[] = {
1301	{8000,  0x01},
1302	{11025, 0x02},
1303	{16000, 0x03},
1304	{22050, 0x04},
1305	{24000, 0x05},
1306	{32000, 0x06},
1307	{44100, 0x07},
1308	{48000, 0x08},
1309	{88200, 0x09},
1310	{96000, 0x0A},
1311};
1312
1313static int rate_value(int rate, u8 *value)
1314{
1315	int i;
1316
1317	for (i = 0; i < ARRAY_SIZE(rate_table); i++) {
1318		if (rate_table[i].rate >= rate) {
1319			*value = rate_table[i].sr;
1320			return 0;
1321		}
1322	}
1323	*value = rate_table[0].sr;
1324	return -EINVAL;
1325}
1326
1327static int max98095_dai1_hw_params(struct snd_pcm_substream *substream,
1328				   struct snd_pcm_hw_params *params,
1329				   struct snd_soc_dai *dai)
1330{
1331	struct snd_soc_codec *codec = dai->codec;
1332	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1333	struct max98095_cdata *cdata;
1334	unsigned long long ni;
1335	unsigned int rate;
1336	u8 regval;
1337
1338	cdata = &max98095->dai[0];
1339
1340	rate = params_rate(params);
1341
1342	switch (params_format(params)) {
1343	case SNDRV_PCM_FORMAT_S16_LE:
1344		snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1345			M98095_DAI_WS, 0);
1346		break;
1347	case SNDRV_PCM_FORMAT_S24_LE:
1348		snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1349			M98095_DAI_WS, M98095_DAI_WS);
1350		break;
1351	default:
1352		return -EINVAL;
1353	}
1354
1355	if (rate_value(rate, &regval))
1356		return -EINVAL;
1357
1358	snd_soc_update_bits(codec, M98095_027_DAI1_CLKMODE,
1359		M98095_CLKMODE_MASK, regval);
1360	cdata->rate = rate;
1361
1362	/* Configure NI when operating as master */
1363	if (snd_soc_read(codec, M98095_02A_DAI1_FORMAT) & M98095_DAI_MAS) {
1364		if (max98095->sysclk == 0) {
1365			dev_err(codec->dev, "Invalid system clock frequency\n");
1366			return -EINVAL;
1367		}
1368		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1369				* (unsigned long long int)rate;
1370		do_div(ni, (unsigned long long int)max98095->sysclk);
1371		snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
1372			(ni >> 8) & 0x7F);
1373		snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
1374			ni & 0xFF);
1375	}
1376
1377	/* Update sample rate mode */
1378	if (rate < 50000)
1379		snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
1380			M98095_DAI_DHF, 0);
1381	else
1382		snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
1383			M98095_DAI_DHF, M98095_DAI_DHF);
1384
1385	return 0;
1386}
1387
1388static int max98095_dai2_hw_params(struct snd_pcm_substream *substream,
1389				   struct snd_pcm_hw_params *params,
1390				   struct snd_soc_dai *dai)
1391{
1392	struct snd_soc_codec *codec = dai->codec;
1393	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1394	struct max98095_cdata *cdata;
1395	unsigned long long ni;
1396	unsigned int rate;
1397	u8 regval;
1398
1399	cdata = &max98095->dai[1];
1400
1401	rate = params_rate(params);
1402
1403	switch (params_format(params)) {
1404	case SNDRV_PCM_FORMAT_S16_LE:
1405		snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1406			M98095_DAI_WS, 0);
1407		break;
1408	case SNDRV_PCM_FORMAT_S24_LE:
1409		snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1410			M98095_DAI_WS, M98095_DAI_WS);
1411		break;
1412	default:
1413		return -EINVAL;
1414	}
1415
1416	if (rate_value(rate, &regval))
1417		return -EINVAL;
1418
1419	snd_soc_update_bits(codec, M98095_031_DAI2_CLKMODE,
1420		M98095_CLKMODE_MASK, regval);
1421	cdata->rate = rate;
1422
1423	/* Configure NI when operating as master */
1424	if (snd_soc_read(codec, M98095_034_DAI2_FORMAT) & M98095_DAI_MAS) {
1425		if (max98095->sysclk == 0) {
1426			dev_err(codec->dev, "Invalid system clock frequency\n");
1427			return -EINVAL;
1428		}
1429		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1430				* (unsigned long long int)rate;
1431		do_div(ni, (unsigned long long int)max98095->sysclk);
1432		snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
1433			(ni >> 8) & 0x7F);
1434		snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
1435			ni & 0xFF);
1436	}
1437
1438	/* Update sample rate mode */
1439	if (rate < 50000)
1440		snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
1441			M98095_DAI_DHF, 0);
1442	else
1443		snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
1444			M98095_DAI_DHF, M98095_DAI_DHF);
1445
1446	return 0;
1447}
1448
1449static int max98095_dai3_hw_params(struct snd_pcm_substream *substream,
1450				   struct snd_pcm_hw_params *params,
1451				   struct snd_soc_dai *dai)
1452{
1453	struct snd_soc_codec *codec = dai->codec;
1454	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1455	struct max98095_cdata *cdata;
1456	unsigned long long ni;
1457	unsigned int rate;
1458	u8 regval;
1459
1460	cdata = &max98095->dai[2];
1461
1462	rate = params_rate(params);
1463
1464	switch (params_format(params)) {
1465	case SNDRV_PCM_FORMAT_S16_LE:
1466		snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1467			M98095_DAI_WS, 0);
1468		break;
1469	case SNDRV_PCM_FORMAT_S24_LE:
1470		snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1471			M98095_DAI_WS, M98095_DAI_WS);
1472		break;
1473	default:
1474		return -EINVAL;
1475	}
1476
1477	if (rate_value(rate, &regval))
1478		return -EINVAL;
1479
1480	snd_soc_update_bits(codec, M98095_03B_DAI3_CLKMODE,
1481		M98095_CLKMODE_MASK, regval);
1482	cdata->rate = rate;
1483
1484	/* Configure NI when operating as master */
1485	if (snd_soc_read(codec, M98095_03E_DAI3_FORMAT) & M98095_DAI_MAS) {
1486		if (max98095->sysclk == 0) {
1487			dev_err(codec->dev, "Invalid system clock frequency\n");
1488			return -EINVAL;
1489		}
1490		ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1491				* (unsigned long long int)rate;
1492		do_div(ni, (unsigned long long int)max98095->sysclk);
1493		snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
1494			(ni >> 8) & 0x7F);
1495		snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
1496			ni & 0xFF);
1497	}
1498
1499	/* Update sample rate mode */
1500	if (rate < 50000)
1501		snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
1502			M98095_DAI_DHF, 0);
1503	else
1504		snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
1505			M98095_DAI_DHF, M98095_DAI_DHF);
1506
1507	return 0;
1508}
1509
1510static int max98095_dai_set_sysclk(struct snd_soc_dai *dai,
1511				   int clk_id, unsigned int freq, int dir)
1512{
1513	struct snd_soc_codec *codec = dai->codec;
1514	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1515
1516	/* Requested clock frequency is already setup */
1517	if (freq == max98095->sysclk)
1518		return 0;
1519
 
 
 
 
 
1520	/* Setup clocks for slave mode, and using the PLL
1521	 * PSCLK = 0x01 (when master clk is 10MHz to 20MHz)
1522	 *         0x02 (when master clk is 20MHz to 40MHz)..
1523	 *         0x03 (when master clk is 40MHz to 60MHz)..
1524	 */
1525	if ((freq >= 10000000) && (freq < 20000000)) {
1526		snd_soc_write(codec, M98095_026_SYS_CLK, 0x10);
1527	} else if ((freq >= 20000000) && (freq < 40000000)) {
1528		snd_soc_write(codec, M98095_026_SYS_CLK, 0x20);
1529	} else if ((freq >= 40000000) && (freq < 60000000)) {
1530		snd_soc_write(codec, M98095_026_SYS_CLK, 0x30);
1531	} else {
1532		dev_err(codec->dev, "Invalid master clock frequency\n");
1533		return -EINVAL;
1534	}
1535
1536	dev_dbg(dai->dev, "Clock source is %d at %uHz\n", clk_id, freq);
1537
1538	max98095->sysclk = freq;
1539	return 0;
1540}
1541
1542static int max98095_dai1_set_fmt(struct snd_soc_dai *codec_dai,
1543				 unsigned int fmt)
1544{
1545	struct snd_soc_codec *codec = codec_dai->codec;
1546	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1547	struct max98095_cdata *cdata;
1548	u8 regval = 0;
1549
1550	cdata = &max98095->dai[0];
1551
1552	if (fmt != cdata->fmt) {
1553		cdata->fmt = fmt;
1554
1555		switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1556		case SND_SOC_DAIFMT_CBS_CFS:
1557			/* Slave mode PLL */
1558			snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
1559				0x80);
1560			snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
1561				0x00);
1562			break;
1563		case SND_SOC_DAIFMT_CBM_CFM:
1564			/* Set to master mode */
1565			regval |= M98095_DAI_MAS;
1566			break;
1567		case SND_SOC_DAIFMT_CBS_CFM:
1568		case SND_SOC_DAIFMT_CBM_CFS:
1569		default:
1570			dev_err(codec->dev, "Clock mode unsupported");
1571			return -EINVAL;
1572		}
1573
1574		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1575		case SND_SOC_DAIFMT_I2S:
1576			regval |= M98095_DAI_DLY;
1577			break;
1578		case SND_SOC_DAIFMT_LEFT_J:
1579			break;
1580		default:
1581			return -EINVAL;
1582		}
1583
1584		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1585		case SND_SOC_DAIFMT_NB_NF:
1586			break;
1587		case SND_SOC_DAIFMT_NB_IF:
1588			regval |= M98095_DAI_WCI;
1589			break;
1590		case SND_SOC_DAIFMT_IB_NF:
1591			regval |= M98095_DAI_BCI;
1592			break;
1593		case SND_SOC_DAIFMT_IB_IF:
1594			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1595			break;
1596		default:
1597			return -EINVAL;
1598		}
1599
1600		snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1601			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1602			M98095_DAI_WCI, regval);
1603
1604		snd_soc_write(codec, M98095_02B_DAI1_CLOCK, M98095_DAI_BSEL64);
1605	}
1606
1607	return 0;
1608}
1609
1610static int max98095_dai2_set_fmt(struct snd_soc_dai *codec_dai,
1611				 unsigned int fmt)
1612{
1613	struct snd_soc_codec *codec = codec_dai->codec;
1614	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1615	struct max98095_cdata *cdata;
1616	u8 regval = 0;
1617
1618	cdata = &max98095->dai[1];
1619
1620	if (fmt != cdata->fmt) {
1621		cdata->fmt = fmt;
1622
1623		switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1624		case SND_SOC_DAIFMT_CBS_CFS:
1625			/* Slave mode PLL */
1626			snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
1627				0x80);
1628			snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
1629				0x00);
1630			break;
1631		case SND_SOC_DAIFMT_CBM_CFM:
1632			/* Set to master mode */
1633			regval |= M98095_DAI_MAS;
1634			break;
1635		case SND_SOC_DAIFMT_CBS_CFM:
1636		case SND_SOC_DAIFMT_CBM_CFS:
1637		default:
1638			dev_err(codec->dev, "Clock mode unsupported");
1639			return -EINVAL;
1640		}
1641
1642		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1643		case SND_SOC_DAIFMT_I2S:
1644			regval |= M98095_DAI_DLY;
1645			break;
1646		case SND_SOC_DAIFMT_LEFT_J:
1647			break;
1648		default:
1649			return -EINVAL;
1650		}
1651
1652		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1653		case SND_SOC_DAIFMT_NB_NF:
1654			break;
1655		case SND_SOC_DAIFMT_NB_IF:
1656			regval |= M98095_DAI_WCI;
1657			break;
1658		case SND_SOC_DAIFMT_IB_NF:
1659			regval |= M98095_DAI_BCI;
1660			break;
1661		case SND_SOC_DAIFMT_IB_IF:
1662			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1663			break;
1664		default:
1665			return -EINVAL;
1666		}
1667
1668		snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1669			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1670			M98095_DAI_WCI, regval);
1671
1672		snd_soc_write(codec, M98095_035_DAI2_CLOCK,
1673			M98095_DAI_BSEL64);
1674	}
1675
1676	return 0;
1677}
1678
1679static int max98095_dai3_set_fmt(struct snd_soc_dai *codec_dai,
1680				 unsigned int fmt)
1681{
1682	struct snd_soc_codec *codec = codec_dai->codec;
1683	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1684	struct max98095_cdata *cdata;
1685	u8 regval = 0;
1686
1687	cdata = &max98095->dai[2];
1688
1689	if (fmt != cdata->fmt) {
1690		cdata->fmt = fmt;
1691
1692		switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1693		case SND_SOC_DAIFMT_CBS_CFS:
1694			/* Slave mode PLL */
1695			snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
1696				0x80);
1697			snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
1698				0x00);
1699			break;
1700		case SND_SOC_DAIFMT_CBM_CFM:
1701			/* Set to master mode */
1702			regval |= M98095_DAI_MAS;
1703			break;
1704		case SND_SOC_DAIFMT_CBS_CFM:
1705		case SND_SOC_DAIFMT_CBM_CFS:
1706		default:
1707			dev_err(codec->dev, "Clock mode unsupported");
1708			return -EINVAL;
1709		}
1710
1711		switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1712		case SND_SOC_DAIFMT_I2S:
1713			regval |= M98095_DAI_DLY;
1714			break;
1715		case SND_SOC_DAIFMT_LEFT_J:
1716			break;
1717		default:
1718			return -EINVAL;
1719		}
1720
1721		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1722		case SND_SOC_DAIFMT_NB_NF:
1723			break;
1724		case SND_SOC_DAIFMT_NB_IF:
1725			regval |= M98095_DAI_WCI;
1726			break;
1727		case SND_SOC_DAIFMT_IB_NF:
1728			regval |= M98095_DAI_BCI;
1729			break;
1730		case SND_SOC_DAIFMT_IB_IF:
1731			regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1732			break;
1733		default:
1734			return -EINVAL;
1735		}
1736
1737		snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1738			M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1739			M98095_DAI_WCI, regval);
1740
1741		snd_soc_write(codec, M98095_03F_DAI3_CLOCK,
1742			M98095_DAI_BSEL64);
1743	}
1744
1745	return 0;
1746}
1747
1748static int max98095_set_bias_level(struct snd_soc_codec *codec,
1749				   enum snd_soc_bias_level level)
1750{
 
1751	int ret;
1752
1753	switch (level) {
1754	case SND_SOC_BIAS_ON:
1755		break;
1756
1757	case SND_SOC_BIAS_PREPARE:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1758		break;
1759
1760	case SND_SOC_BIAS_STANDBY:
1761		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
1762			ret = snd_soc_cache_sync(codec);
1763
1764			if (ret != 0) {
1765				dev_err(codec->dev, "Failed to sync cache: %d\n", ret);
1766				return ret;
1767			}
1768		}
1769
1770		snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
1771				M98095_MBEN, M98095_MBEN);
1772		break;
1773
1774	case SND_SOC_BIAS_OFF:
1775		snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
1776				M98095_MBEN, 0);
1777		codec->cache_sync = 1;
1778		break;
1779	}
1780	codec->dapm.bias_level = level;
1781	return 0;
1782}
1783
1784#define MAX98095_RATES SNDRV_PCM_RATE_8000_96000
1785#define MAX98095_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
1786
1787static struct snd_soc_dai_ops max98095_dai1_ops = {
1788	.set_sysclk = max98095_dai_set_sysclk,
1789	.set_fmt = max98095_dai1_set_fmt,
1790	.hw_params = max98095_dai1_hw_params,
1791};
1792
1793static struct snd_soc_dai_ops max98095_dai2_ops = {
1794	.set_sysclk = max98095_dai_set_sysclk,
1795	.set_fmt = max98095_dai2_set_fmt,
1796	.hw_params = max98095_dai2_hw_params,
1797};
1798
1799static struct snd_soc_dai_ops max98095_dai3_ops = {
1800	.set_sysclk = max98095_dai_set_sysclk,
1801	.set_fmt = max98095_dai3_set_fmt,
1802	.hw_params = max98095_dai3_hw_params,
1803};
1804
1805static struct snd_soc_dai_driver max98095_dai[] = {
1806{
1807	.name = "HiFi",
1808	.playback = {
1809		.stream_name = "HiFi Playback",
1810		.channels_min = 1,
1811		.channels_max = 2,
1812		.rates = MAX98095_RATES,
1813		.formats = MAX98095_FORMATS,
1814	},
1815	.capture = {
1816		.stream_name = "HiFi Capture",
1817		.channels_min = 1,
1818		.channels_max = 2,
1819		.rates = MAX98095_RATES,
1820		.formats = MAX98095_FORMATS,
1821	},
1822	 .ops = &max98095_dai1_ops,
1823},
1824{
1825	.name = "Aux",
1826	.playback = {
1827		.stream_name = "Aux Playback",
1828		.channels_min = 1,
1829		.channels_max = 1,
1830		.rates = MAX98095_RATES,
1831		.formats = MAX98095_FORMATS,
1832	},
1833	.ops = &max98095_dai2_ops,
1834},
1835{
1836	.name = "Voice",
1837	.playback = {
1838		.stream_name = "Voice Playback",
1839		.channels_min = 1,
1840		.channels_max = 1,
1841		.rates = MAX98095_RATES,
1842		.formats = MAX98095_FORMATS,
1843	},
1844	.ops = &max98095_dai3_ops,
1845}
1846
1847};
1848
1849static int max98095_get_eq_channel(const char *name)
1850{
1851	if (strcmp(name, "EQ1 Mode") == 0)
1852		return 0;
1853	if (strcmp(name, "EQ2 Mode") == 0)
1854		return 1;
1855	return -EINVAL;
1856}
1857
1858static int max98095_put_eq_enum(struct snd_kcontrol *kcontrol,
1859				 struct snd_ctl_elem_value *ucontrol)
1860{
1861	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1862	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1863	struct max98095_pdata *pdata = max98095->pdata;
1864	int channel = max98095_get_eq_channel(kcontrol->id.name);
1865	struct max98095_cdata *cdata;
1866	int sel = ucontrol->value.integer.value[0];
1867	struct max98095_eq_cfg *coef_set;
1868	int fs, best, best_val, i;
1869	int regmask, regsave;
1870
1871	BUG_ON(channel > 1);
 
1872
1873	if (!pdata || !max98095->eq_textcnt)
1874		return 0;
1875
1876	if (sel >= pdata->eq_cfgcnt)
1877		return -EINVAL;
1878
1879	cdata = &max98095->dai[channel];
1880	cdata->eq_sel = sel;
1881	fs = cdata->rate;
1882
1883	/* Find the selected configuration with nearest sample rate */
1884	best = 0;
1885	best_val = INT_MAX;
1886	for (i = 0; i < pdata->eq_cfgcnt; i++) {
1887		if (strcmp(pdata->eq_cfg[i].name, max98095->eq_texts[sel]) == 0 &&
1888			abs(pdata->eq_cfg[i].rate - fs) < best_val) {
1889			best = i;
1890			best_val = abs(pdata->eq_cfg[i].rate - fs);
1891		}
1892	}
1893
1894	dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
1895		pdata->eq_cfg[best].name,
1896		pdata->eq_cfg[best].rate, fs);
1897
1898	coef_set = &pdata->eq_cfg[best];
1899
1900	regmask = (channel == 0) ? M98095_EQ1EN : M98095_EQ2EN;
1901
1902	/* Disable filter while configuring, and save current on/off state */
1903	regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
1904	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
1905
1906	mutex_lock(&codec->mutex);
1907	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1908	m98095_eq_band(codec, channel, 0, coef_set->band1);
1909	m98095_eq_band(codec, channel, 1, coef_set->band2);
1910	m98095_eq_band(codec, channel, 2, coef_set->band3);
1911	m98095_eq_band(codec, channel, 3, coef_set->band4);
1912	m98095_eq_band(codec, channel, 4, coef_set->band5);
1913	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
1914	mutex_unlock(&codec->mutex);
1915
1916	/* Restore the original on/off state */
1917	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
1918	return 0;
1919}
1920
1921static int max98095_get_eq_enum(struct snd_kcontrol *kcontrol,
1922				 struct snd_ctl_elem_value *ucontrol)
1923{
1924	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1925	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1926	int channel = max98095_get_eq_channel(kcontrol->id.name);
1927	struct max98095_cdata *cdata;
1928
1929	cdata = &max98095->dai[channel];
1930	ucontrol->value.enumerated.item[0] = cdata->eq_sel;
1931
1932	return 0;
1933}
1934
1935static void max98095_handle_eq_pdata(struct snd_soc_codec *codec)
1936{
1937	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1938	struct max98095_pdata *pdata = max98095->pdata;
1939	struct max98095_eq_cfg *cfg;
1940	unsigned int cfgcnt;
1941	int i, j;
1942	const char **t;
1943	int ret;
1944
1945	struct snd_kcontrol_new controls[] = {
1946		SOC_ENUM_EXT("EQ1 Mode",
1947			max98095->eq_enum,
1948			max98095_get_eq_enum,
1949			max98095_put_eq_enum),
1950		SOC_ENUM_EXT("EQ2 Mode",
1951			max98095->eq_enum,
1952			max98095_get_eq_enum,
1953			max98095_put_eq_enum),
1954	};
1955
1956	cfg = pdata->eq_cfg;
1957	cfgcnt = pdata->eq_cfgcnt;
1958
1959	/* Setup an array of texts for the equalizer enum.
1960	 * This is based on Mark Brown's equalizer driver code.
1961	 */
1962	max98095->eq_textcnt = 0;
1963	max98095->eq_texts = NULL;
1964	for (i = 0; i < cfgcnt; i++) {
1965		for (j = 0; j < max98095->eq_textcnt; j++) {
1966			if (strcmp(cfg[i].name, max98095->eq_texts[j]) == 0)
1967				break;
1968		}
1969
1970		if (j != max98095->eq_textcnt)
1971			continue;
1972
1973		/* Expand the array */
1974		t = krealloc(max98095->eq_texts,
1975			     sizeof(char *) * (max98095->eq_textcnt + 1),
1976			     GFP_KERNEL);
1977		if (t == NULL)
1978			continue;
1979
1980		/* Store the new entry */
1981		t[max98095->eq_textcnt] = cfg[i].name;
1982		max98095->eq_textcnt++;
1983		max98095->eq_texts = t;
1984	}
1985
1986	/* Now point the soc_enum to .texts array items */
1987	max98095->eq_enum.texts = max98095->eq_texts;
1988	max98095->eq_enum.max = max98095->eq_textcnt;
1989
1990	ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
1991	if (ret != 0)
1992		dev_err(codec->dev, "Failed to add EQ control: %d\n", ret);
1993}
1994
1995static int max98095_get_bq_channel(const char *name)
 
 
 
1996{
1997	if (strcmp(name, "Biquad1 Mode") == 0)
1998		return 0;
1999	if (strcmp(name, "Biquad2 Mode") == 0)
2000		return 1;
2001	return -EINVAL;
 
2002}
2003
2004static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
2005				 struct snd_ctl_elem_value *ucontrol)
2006{
2007	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2008	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2009	struct max98095_pdata *pdata = max98095->pdata;
2010	int channel = max98095_get_bq_channel(kcontrol->id.name);
2011	struct max98095_cdata *cdata;
2012	int sel = ucontrol->value.integer.value[0];
2013	struct max98095_biquad_cfg *coef_set;
2014	int fs, best, best_val, i;
2015	int regmask, regsave;
2016
2017	BUG_ON(channel > 1);
 
2018
2019	if (!pdata || !max98095->bq_textcnt)
2020		return 0;
2021
2022	if (sel >= pdata->bq_cfgcnt)
2023		return -EINVAL;
2024
2025	cdata = &max98095->dai[channel];
2026	cdata->bq_sel = sel;
2027	fs = cdata->rate;
2028
2029	/* Find the selected configuration with nearest sample rate */
2030	best = 0;
2031	best_val = INT_MAX;
2032	for (i = 0; i < pdata->bq_cfgcnt; i++) {
2033		if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
2034			abs(pdata->bq_cfg[i].rate - fs) < best_val) {
2035			best = i;
2036			best_val = abs(pdata->bq_cfg[i].rate - fs);
2037		}
2038	}
2039
2040	dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
2041		pdata->bq_cfg[best].name,
2042		pdata->bq_cfg[best].rate, fs);
2043
2044	coef_set = &pdata->bq_cfg[best];
2045
2046	regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
2047
2048	/* Disable filter while configuring, and save current on/off state */
2049	regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
2050	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
2051
2052	mutex_lock(&codec->mutex);
2053	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
2054	m98095_biquad_band(codec, channel, 0, coef_set->band1);
2055	m98095_biquad_band(codec, channel, 1, coef_set->band2);
2056	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
2057	mutex_unlock(&codec->mutex);
2058
2059	/* Restore the original on/off state */
2060	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
2061	return 0;
2062}
2063
2064static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
2065				 struct snd_ctl_elem_value *ucontrol)
2066{
2067	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2068	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2069	int channel = max98095_get_bq_channel(kcontrol->id.name);
2070	struct max98095_cdata *cdata;
2071
 
 
 
2072	cdata = &max98095->dai[channel];
2073	ucontrol->value.enumerated.item[0] = cdata->bq_sel;
2074
2075	return 0;
2076}
2077
2078static void max98095_handle_bq_pdata(struct snd_soc_codec *codec)
2079{
2080	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2081	struct max98095_pdata *pdata = max98095->pdata;
2082	struct max98095_biquad_cfg *cfg;
2083	unsigned int cfgcnt;
2084	int i, j;
2085	const char **t;
2086	int ret;
2087
2088	struct snd_kcontrol_new controls[] = {
2089		SOC_ENUM_EXT("Biquad1 Mode",
2090			max98095->bq_enum,
2091			max98095_get_bq_enum,
2092			max98095_put_bq_enum),
2093		SOC_ENUM_EXT("Biquad2 Mode",
2094			max98095->bq_enum,
2095			max98095_get_bq_enum,
2096			max98095_put_bq_enum),
2097	};
 
2098
2099	cfg = pdata->bq_cfg;
2100	cfgcnt = pdata->bq_cfgcnt;
2101
2102	/* Setup an array of texts for the biquad enum.
2103	 * This is based on Mark Brown's equalizer driver code.
2104	 */
2105	max98095->bq_textcnt = 0;
2106	max98095->bq_texts = NULL;
2107	for (i = 0; i < cfgcnt; i++) {
2108		for (j = 0; j < max98095->bq_textcnt; j++) {
2109			if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
2110				break;
2111		}
2112
2113		if (j != max98095->bq_textcnt)
2114			continue;
2115
2116		/* Expand the array */
2117		t = krealloc(max98095->bq_texts,
2118			     sizeof(char *) * (max98095->bq_textcnt + 1),
2119			     GFP_KERNEL);
2120		if (t == NULL)
2121			continue;
2122
2123		/* Store the new entry */
2124		t[max98095->bq_textcnt] = cfg[i].name;
2125		max98095->bq_textcnt++;
2126		max98095->bq_texts = t;
2127	}
2128
2129	/* Now point the soc_enum to .texts array items */
2130	max98095->bq_enum.texts = max98095->bq_texts;
2131	max98095->bq_enum.max = max98095->bq_textcnt;
2132
2133	ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
2134	if (ret != 0)
2135		dev_err(codec->dev, "Failed to add Biquad control: %d\n", ret);
2136}
2137
2138static void max98095_handle_pdata(struct snd_soc_codec *codec)
2139{
2140	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2141	struct max98095_pdata *pdata = max98095->pdata;
2142	u8 regval = 0;
2143
2144	if (!pdata) {
2145		dev_dbg(codec->dev, "No platform data\n");
2146		return;
2147	}
2148
2149	/* Configure mic for analog/digital mic mode */
2150	if (pdata->digmic_left_mode)
2151		regval |= M98095_DIGMIC_L;
2152
2153	if (pdata->digmic_right_mode)
2154		regval |= M98095_DIGMIC_R;
2155
2156	snd_soc_write(codec, M98095_087_CFG_MIC, regval);
2157
2158	/* Configure equalizers */
2159	if (pdata->eq_cfgcnt)
2160		max98095_handle_eq_pdata(codec);
2161
2162	/* Configure bi-quad filters */
2163	if (pdata->bq_cfgcnt)
2164		max98095_handle_bq_pdata(codec);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2165}
2166
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2167#ifdef CONFIG_PM
2168static int max98095_suspend(struct snd_soc_codec *codec, pm_message_t state)
2169{
2170	max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
 
 
 
 
 
2171
2172	return 0;
2173}
2174
2175static int max98095_resume(struct snd_soc_codec *codec)
2176{
2177	max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 
 
 
 
 
 
 
 
2178
2179	return 0;
2180}
2181#else
2182#define max98095_suspend NULL
2183#define max98095_resume NULL
2184#endif
2185
2186static int max98095_reset(struct snd_soc_codec *codec)
2187{
2188	int i, ret;
2189
2190	/* Gracefully reset the DSP core and the codec hardware
2191	 * in a proper sequence */
2192	ret = snd_soc_write(codec, M98095_00F_HOST_CFG, 0);
2193	if (ret < 0) {
2194		dev_err(codec->dev, "Failed to reset DSP: %d\n", ret);
2195		return ret;
2196	}
2197
2198	ret = snd_soc_write(codec, M98095_097_PWR_SYS, 0);
2199	if (ret < 0) {
2200		dev_err(codec->dev, "Failed to reset codec: %d\n", ret);
2201		return ret;
2202	}
2203
2204	/* Reset to hardware default for registers, as there is not
2205	 * a soft reset hardware control register */
2206	for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
2207		ret = snd_soc_write(codec, i, max98095_reg_def[i]);
2208		if (ret < 0) {
2209			dev_err(codec->dev, "Failed to reset: %d\n", ret);
2210			return ret;
2211		}
2212	}
2213
2214	return ret;
2215}
2216
2217static int max98095_probe(struct snd_soc_codec *codec)
2218{
2219	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2220	struct max98095_cdata *cdata;
 
2221	int ret = 0;
2222
2223	ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
2224	if (ret != 0) {
2225		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
2226		return ret;
2227	}
2228
2229	/* reset the codec, the DSP core, and disable all interrupts */
2230	max98095_reset(codec);
 
 
2231
2232	/* initialize private data */
2233
2234	max98095->sysclk = (unsigned)-1;
2235	max98095->eq_textcnt = 0;
2236	max98095->bq_textcnt = 0;
2237
2238	cdata = &max98095->dai[0];
2239	cdata->rate = (unsigned)-1;
2240	cdata->fmt  = (unsigned)-1;
2241	cdata->eq_sel = 0;
2242	cdata->bq_sel = 0;
2243
2244	cdata = &max98095->dai[1];
2245	cdata->rate = (unsigned)-1;
2246	cdata->fmt  = (unsigned)-1;
2247	cdata->eq_sel = 0;
2248	cdata->bq_sel = 0;
2249
2250	cdata = &max98095->dai[2];
2251	cdata->rate = (unsigned)-1;
2252	cdata->fmt  = (unsigned)-1;
2253	cdata->eq_sel = 0;
2254	cdata->bq_sel = 0;
2255
2256	max98095->lin_state = 0;
2257	max98095->mic1pre = 0;
2258	max98095->mic2pre = 0;
2259
2260	ret = snd_soc_read(codec, M98095_0FF_REV_ID);
 
 
 
 
 
 
 
 
 
 
 
 
2261	if (ret < 0) {
2262		dev_err(codec->dev, "Failure reading hardware revision: %d\n",
2263			ret);
2264		goto err_access;
2265	}
2266	dev_info(codec->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
2267
2268	snd_soc_write(codec, M98095_097_PWR_SYS, M98095_PWRSV);
2269
2270	/* initialize registers cache to hardware default */
2271	max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2272
2273	snd_soc_write(codec, M98095_048_MIX_DAC_LR,
2274		M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2275
2276	snd_soc_write(codec, M98095_049_MIX_DAC_M,
2277		M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2278
2279	snd_soc_write(codec, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2280	snd_soc_write(codec, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2281	snd_soc_write(codec, M98095_04E_CFG_HP, M98095_HPNORMAL);
2282
2283	snd_soc_write(codec, M98095_02C_DAI1_IOCFG,
2284		M98095_S1NORMAL|M98095_SDATA);
2285
2286	snd_soc_write(codec, M98095_036_DAI2_IOCFG,
2287		M98095_S2NORMAL|M98095_SDATA);
2288
2289	snd_soc_write(codec, M98095_040_DAI3_IOCFG,
2290		M98095_S3NORMAL|M98095_SDATA);
2291
2292	max98095_handle_pdata(codec);
2293
2294	/* take the codec out of the shut down */
2295	snd_soc_update_bits(codec, M98095_097_PWR_SYS, M98095_SHDNRUN,
2296		M98095_SHDNRUN);
2297
2298	max98095_add_widgets(codec);
2299
 
 
 
2300err_access:
2301	return ret;
2302}
2303
2304static int max98095_remove(struct snd_soc_codec *codec)
2305{
2306	max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
 
2307
2308	return 0;
2309}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2310
2311static struct snd_soc_codec_driver soc_codec_dev_max98095 = {
2312	.probe   = max98095_probe,
2313	.remove  = max98095_remove,
2314	.suspend = max98095_suspend,
2315	.resume  = max98095_resume,
2316	.set_bias_level = max98095_set_bias_level,
2317	.reg_cache_size = ARRAY_SIZE(max98095_reg_def),
2318	.reg_word_size = sizeof(u8),
2319	.reg_cache_default = max98095_reg_def,
2320	.readable_register = max98095_readable,
2321	.volatile_register = max98095_volatile,
2322	.dapm_widgets	  = max98095_dapm_widgets,
2323	.num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
2324	.dapm_routes     = max98095_audio_map,
2325	.num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
2326};
 
2327
2328static int max98095_i2c_probe(struct i2c_client *i2c,
2329			     const struct i2c_device_id *id)
2330{
2331	struct max98095_priv *max98095;
2332	int ret;
 
2333
2334	max98095 = kzalloc(sizeof(struct max98095_priv), GFP_KERNEL);
 
2335	if (max98095 == NULL)
2336		return -ENOMEM;
2337
 
 
 
 
 
 
 
 
 
 
2338	max98095->devtype = id->driver_data;
2339	i2c_set_clientdata(i2c, max98095);
2340	max98095->control_data = i2c;
2341	max98095->pdata = i2c->dev.platform_data;
2342
2343	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_max98095,
 
2344				     max98095_dai, ARRAY_SIZE(max98095_dai));
2345	if (ret < 0)
2346		kfree(max98095);
2347	return ret;
2348}
2349
2350static int __devexit max98095_i2c_remove(struct i2c_client *client)
2351{
2352	snd_soc_unregister_codec(&client->dev);
2353	kfree(i2c_get_clientdata(client));
2354
2355	return 0;
2356}
2357
2358static const struct i2c_device_id max98095_i2c_id[] = {
2359	{ "max98095", MAX98095 },
2360	{ }
2361};
2362MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
 
2363
2364static struct i2c_driver max98095_i2c_driver = {
2365	.driver = {
2366		.name = "max98095",
2367		.owner = THIS_MODULE,
2368	},
2369	.probe  = max98095_i2c_probe,
2370	.remove = __devexit_p(max98095_i2c_remove),
2371	.id_table = max98095_i2c_id,
2372};
2373
2374static int __init max98095_init(void)
2375{
2376	int ret;
2377
2378	ret = i2c_add_driver(&max98095_i2c_driver);
2379	if (ret)
2380		pr_err("Failed to register max98095 I2C driver: %d\n", ret);
2381
2382	return ret;
2383}
2384module_init(max98095_init);
2385
2386static void __exit max98095_exit(void)
2387{
2388	i2c_del_driver(&max98095_i2c_driver);
2389}
2390module_exit(max98095_exit);
2391
2392MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2393MODULE_AUTHOR("Peter Hsiang");
2394MODULE_LICENSE("GPL");