Linux Audio

Check our new training course

Loading...
   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 <sound/core.h>
  19#include <sound/pcm.h>
  20#include <sound/pcm_params.h>
  21#include <sound/soc.h>
  22#include <sound/initval.h>
  23#include <sound/tlv.h>
  24#include <linux/slab.h>
  25#include <asm/div64.h>
  26#include <sound/max98095.h>
  27#include <sound/jack.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	struct max98095_pdata *pdata;
  44	unsigned int sysclk;
  45	struct max98095_cdata dai[3];
  46	const char **eq_texts;
  47	const char **bq_texts;
  48	struct soc_enum eq_enum;
  49	struct soc_enum bq_enum;
  50	int eq_textcnt;
  51	int bq_textcnt;
  52	u8 lin_state;
  53	unsigned int mic1pre;
  54	unsigned int mic2pre;
  55	struct snd_soc_jack *headphone_jack;
  56	struct snd_soc_jack *mic_jack;
  57};
  58
  59static const u8 max98095_reg_def[M98095_REG_CNT] = {
  60	0x00, /* 00 */
  61	0x00, /* 01 */
  62	0x00, /* 02 */
  63	0x00, /* 03 */
  64	0x00, /* 04 */
  65	0x00, /* 05 */
  66	0x00, /* 06 */
  67	0x00, /* 07 */
  68	0x00, /* 08 */
  69	0x00, /* 09 */
  70	0x00, /* 0A */
  71	0x00, /* 0B */
  72	0x00, /* 0C */
  73	0x00, /* 0D */
  74	0x00, /* 0E */
  75	0x00, /* 0F */
  76	0x00, /* 10 */
  77	0x00, /* 11 */
  78	0x00, /* 12 */
  79	0x00, /* 13 */
  80	0x00, /* 14 */
  81	0x00, /* 15 */
  82	0x00, /* 16 */
  83	0x00, /* 17 */
  84	0x00, /* 18 */
  85	0x00, /* 19 */
  86	0x00, /* 1A */
  87	0x00, /* 1B */
  88	0x00, /* 1C */
  89	0x00, /* 1D */
  90	0x00, /* 1E */
  91	0x00, /* 1F */
  92	0x00, /* 20 */
  93	0x00, /* 21 */
  94	0x00, /* 22 */
  95	0x00, /* 23 */
  96	0x00, /* 24 */
  97	0x00, /* 25 */
  98	0x00, /* 26 */
  99	0x00, /* 27 */
 100	0x00, /* 28 */
 101	0x00, /* 29 */
 102	0x00, /* 2A */
 103	0x00, /* 2B */
 104	0x00, /* 2C */
 105	0x00, /* 2D */
 106	0x00, /* 2E */
 107	0x00, /* 2F */
 108	0x00, /* 30 */
 109	0x00, /* 31 */
 110	0x00, /* 32 */
 111	0x00, /* 33 */
 112	0x00, /* 34 */
 113	0x00, /* 35 */
 114	0x00, /* 36 */
 115	0x00, /* 37 */
 116	0x00, /* 38 */
 117	0x00, /* 39 */
 118	0x00, /* 3A */
 119	0x00, /* 3B */
 120	0x00, /* 3C */
 121	0x00, /* 3D */
 122	0x00, /* 3E */
 123	0x00, /* 3F */
 124	0x00, /* 40 */
 125	0x00, /* 41 */
 126	0x00, /* 42 */
 127	0x00, /* 43 */
 128	0x00, /* 44 */
 129	0x00, /* 45 */
 130	0x00, /* 46 */
 131	0x00, /* 47 */
 132	0x00, /* 48 */
 133	0x00, /* 49 */
 134	0x00, /* 4A */
 135	0x00, /* 4B */
 136	0x00, /* 4C */
 137	0x00, /* 4D */
 138	0x00, /* 4E */
 139	0x00, /* 4F */
 140	0x00, /* 50 */
 141	0x00, /* 51 */
 142	0x00, /* 52 */
 143	0x00, /* 53 */
 144	0x00, /* 54 */
 145	0x00, /* 55 */
 146	0x00, /* 56 */
 147	0x00, /* 57 */
 148	0x00, /* 58 */
 149	0x00, /* 59 */
 150	0x00, /* 5A */
 151	0x00, /* 5B */
 152	0x00, /* 5C */
 153	0x00, /* 5D */
 154	0x00, /* 5E */
 155	0x00, /* 5F */
 156	0x00, /* 60 */
 157	0x00, /* 61 */
 158	0x00, /* 62 */
 159	0x00, /* 63 */
 160	0x00, /* 64 */
 161	0x00, /* 65 */
 162	0x00, /* 66 */
 163	0x00, /* 67 */
 164	0x00, /* 68 */
 165	0x00, /* 69 */
 166	0x00, /* 6A */
 167	0x00, /* 6B */
 168	0x00, /* 6C */
 169	0x00, /* 6D */
 170	0x00, /* 6E */
 171	0x00, /* 6F */
 172	0x00, /* 70 */
 173	0x00, /* 71 */
 174	0x00, /* 72 */
 175	0x00, /* 73 */
 176	0x00, /* 74 */
 177	0x00, /* 75 */
 178	0x00, /* 76 */
 179	0x00, /* 77 */
 180	0x00, /* 78 */
 181	0x00, /* 79 */
 182	0x00, /* 7A */
 183	0x00, /* 7B */
 184	0x00, /* 7C */
 185	0x00, /* 7D */
 186	0x00, /* 7E */
 187	0x00, /* 7F */
 188	0x00, /* 80 */
 189	0x00, /* 81 */
 190	0x00, /* 82 */
 191	0x00, /* 83 */
 192	0x00, /* 84 */
 193	0x00, /* 85 */
 194	0x00, /* 86 */
 195	0x00, /* 87 */
 196	0x00, /* 88 */
 197	0x00, /* 89 */
 198	0x00, /* 8A */
 199	0x00, /* 8B */
 200	0x00, /* 8C */
 201	0x00, /* 8D */
 202	0x00, /* 8E */
 203	0x00, /* 8F */
 204	0x00, /* 90 */
 205	0x00, /* 91 */
 206	0x30, /* 92 */
 207	0xF0, /* 93 */
 208	0x00, /* 94 */
 209	0x00, /* 95 */
 210	0x3F, /* 96 */
 211	0x00, /* 97 */
 212	0x00, /* 98 */
 213	0x00, /* 99 */
 214	0x00, /* 9A */
 215	0x00, /* 9B */
 216	0x00, /* 9C */
 217	0x00, /* 9D */
 218	0x00, /* 9E */
 219	0x00, /* 9F */
 220	0x00, /* A0 */
 221	0x00, /* A1 */
 222	0x00, /* A2 */
 223	0x00, /* A3 */
 224	0x00, /* A4 */
 225	0x00, /* A5 */
 226	0x00, /* A6 */
 227	0x00, /* A7 */
 228	0x00, /* A8 */
 229	0x00, /* A9 */
 230	0x00, /* AA */
 231	0x00, /* AB */
 232	0x00, /* AC */
 233	0x00, /* AD */
 234	0x00, /* AE */
 235	0x00, /* AF */
 236	0x00, /* B0 */
 237	0x00, /* B1 */
 238	0x00, /* B2 */
 239	0x00, /* B3 */
 240	0x00, /* B4 */
 241	0x00, /* B5 */
 242	0x00, /* B6 */
 243	0x00, /* B7 */
 244	0x00, /* B8 */
 245	0x00, /* B9 */
 246	0x00, /* BA */
 247	0x00, /* BB */
 248	0x00, /* BC */
 249	0x00, /* BD */
 250	0x00, /* BE */
 251	0x00, /* BF */
 252	0x00, /* C0 */
 253	0x00, /* C1 */
 254	0x00, /* C2 */
 255	0x00, /* C3 */
 256	0x00, /* C4 */
 257	0x00, /* C5 */
 258	0x00, /* C6 */
 259	0x00, /* C7 */
 260	0x00, /* C8 */
 261	0x00, /* C9 */
 262	0x00, /* CA */
 263	0x00, /* CB */
 264	0x00, /* CC */
 265	0x00, /* CD */
 266	0x00, /* CE */
 267	0x00, /* CF */
 268	0x00, /* D0 */
 269	0x00, /* D1 */
 270	0x00, /* D2 */
 271	0x00, /* D3 */
 272	0x00, /* D4 */
 273	0x00, /* D5 */
 274	0x00, /* D6 */
 275	0x00, /* D7 */
 276	0x00, /* D8 */
 277	0x00, /* D9 */
 278	0x00, /* DA */
 279	0x00, /* DB */
 280	0x00, /* DC */
 281	0x00, /* DD */
 282	0x00, /* DE */
 283	0x00, /* DF */
 284	0x00, /* E0 */
 285	0x00, /* E1 */
 286	0x00, /* E2 */
 287	0x00, /* E3 */
 288	0x00, /* E4 */
 289	0x00, /* E5 */
 290	0x00, /* E6 */
 291	0x00, /* E7 */
 292	0x00, /* E8 */
 293	0x00, /* E9 */
 294	0x00, /* EA */
 295	0x00, /* EB */
 296	0x00, /* EC */
 297	0x00, /* ED */
 298	0x00, /* EE */
 299	0x00, /* EF */
 300	0x00, /* F0 */
 301	0x00, /* F1 */
 302	0x00, /* F2 */
 303	0x00, /* F3 */
 304	0x00, /* F4 */
 305	0x00, /* F5 */
 306	0x00, /* F6 */
 307	0x00, /* F7 */
 308	0x00, /* F8 */
 309	0x00, /* F9 */
 310	0x00, /* FA */
 311	0x00, /* FB */
 312	0x00, /* FC */
 313	0x00, /* FD */
 314	0x00, /* FE */
 315	0x00, /* FF */
 316};
 317
 318static struct {
 319	int readable;
 320	int writable;
 321} max98095_access[M98095_REG_CNT] = {
 322	{ 0x00, 0x00 }, /* 00 */
 323	{ 0xFF, 0x00 }, /* 01 */
 324	{ 0xFF, 0x00 }, /* 02 */
 325	{ 0xFF, 0x00 }, /* 03 */
 326	{ 0xFF, 0x00 }, /* 04 */
 327	{ 0xFF, 0x00 }, /* 05 */
 328	{ 0xFF, 0x00 }, /* 06 */
 329	{ 0xFF, 0x00 }, /* 07 */
 330	{ 0xFF, 0x00 }, /* 08 */
 331	{ 0xFF, 0x00 }, /* 09 */
 332	{ 0xFF, 0x00 }, /* 0A */
 333	{ 0xFF, 0x00 }, /* 0B */
 334	{ 0xFF, 0x00 }, /* 0C */
 335	{ 0xFF, 0x00 }, /* 0D */
 336	{ 0xFF, 0x00 }, /* 0E */
 337	{ 0xFF, 0x9F }, /* 0F */
 338	{ 0xFF, 0xFF }, /* 10 */
 339	{ 0xFF, 0xFF }, /* 11 */
 340	{ 0xFF, 0xFF }, /* 12 */
 341	{ 0xFF, 0xFF }, /* 13 */
 342	{ 0xFF, 0xFF }, /* 14 */
 343	{ 0xFF, 0xFF }, /* 15 */
 344	{ 0xFF, 0xFF }, /* 16 */
 345	{ 0xFF, 0xFF }, /* 17 */
 346	{ 0xFF, 0xFF }, /* 18 */
 347	{ 0xFF, 0xFF }, /* 19 */
 348	{ 0xFF, 0xFF }, /* 1A */
 349	{ 0xFF, 0xFF }, /* 1B */
 350	{ 0xFF, 0xFF }, /* 1C */
 351	{ 0xFF, 0xFF }, /* 1D */
 352	{ 0xFF, 0x77 }, /* 1E */
 353	{ 0xFF, 0x77 }, /* 1F */
 354	{ 0xFF, 0x77 }, /* 20 */
 355	{ 0xFF, 0x77 }, /* 21 */
 356	{ 0xFF, 0x77 }, /* 22 */
 357	{ 0xFF, 0x77 }, /* 23 */
 358	{ 0xFF, 0xFF }, /* 24 */
 359	{ 0xFF, 0x7F }, /* 25 */
 360	{ 0xFF, 0x31 }, /* 26 */
 361	{ 0xFF, 0xFF }, /* 27 */
 362	{ 0xFF, 0xFF }, /* 28 */
 363	{ 0xFF, 0xFF }, /* 29 */
 364	{ 0xFF, 0xF7 }, /* 2A */
 365	{ 0xFF, 0x2F }, /* 2B */
 366	{ 0xFF, 0xEF }, /* 2C */
 367	{ 0xFF, 0xFF }, /* 2D */
 368	{ 0xFF, 0xFF }, /* 2E */
 369	{ 0xFF, 0xFF }, /* 2F */
 370	{ 0xFF, 0xFF }, /* 30 */
 371	{ 0xFF, 0xFF }, /* 31 */
 372	{ 0xFF, 0xFF }, /* 32 */
 373	{ 0xFF, 0xFF }, /* 33 */
 374	{ 0xFF, 0xF7 }, /* 34 */
 375	{ 0xFF, 0x2F }, /* 35 */
 376	{ 0xFF, 0xCF }, /* 36 */
 377	{ 0xFF, 0xFF }, /* 37 */
 378	{ 0xFF, 0xFF }, /* 38 */
 379	{ 0xFF, 0xFF }, /* 39 */
 380	{ 0xFF, 0xFF }, /* 3A */
 381	{ 0xFF, 0xFF }, /* 3B */
 382	{ 0xFF, 0xFF }, /* 3C */
 383	{ 0xFF, 0xFF }, /* 3D */
 384	{ 0xFF, 0xF7 }, /* 3E */
 385	{ 0xFF, 0x2F }, /* 3F */
 386	{ 0xFF, 0xCF }, /* 40 */
 387	{ 0xFF, 0xFF }, /* 41 */
 388	{ 0xFF, 0x77 }, /* 42 */
 389	{ 0xFF, 0xFF }, /* 43 */
 390	{ 0xFF, 0xFF }, /* 44 */
 391	{ 0xFF, 0xFF }, /* 45 */
 392	{ 0xFF, 0xFF }, /* 46 */
 393	{ 0xFF, 0xFF }, /* 47 */
 394	{ 0xFF, 0xFF }, /* 48 */
 395	{ 0xFF, 0x0F }, /* 49 */
 396	{ 0xFF, 0xFF }, /* 4A */
 397	{ 0xFF, 0xFF }, /* 4B */
 398	{ 0xFF, 0x3F }, /* 4C */
 399	{ 0xFF, 0x3F }, /* 4D */
 400	{ 0xFF, 0x3F }, /* 4E */
 401	{ 0xFF, 0xFF }, /* 4F */
 402	{ 0xFF, 0x7F }, /* 50 */
 403	{ 0xFF, 0x7F }, /* 51 */
 404	{ 0xFF, 0x0F }, /* 52 */
 405	{ 0xFF, 0x3F }, /* 53 */
 406	{ 0xFF, 0x3F }, /* 54 */
 407	{ 0xFF, 0x3F }, /* 55 */
 408	{ 0xFF, 0xFF }, /* 56 */
 409	{ 0xFF, 0xFF }, /* 57 */
 410	{ 0xFF, 0xBF }, /* 58 */
 411	{ 0xFF, 0x1F }, /* 59 */
 412	{ 0xFF, 0xBF }, /* 5A */
 413	{ 0xFF, 0x1F }, /* 5B */
 414	{ 0xFF, 0xBF }, /* 5C */
 415	{ 0xFF, 0x3F }, /* 5D */
 416	{ 0xFF, 0x3F }, /* 5E */
 417	{ 0xFF, 0x7F }, /* 5F */
 418	{ 0xFF, 0x7F }, /* 60 */
 419	{ 0xFF, 0x47 }, /* 61 */
 420	{ 0xFF, 0x9F }, /* 62 */
 421	{ 0xFF, 0x9F }, /* 63 */
 422	{ 0xFF, 0x9F }, /* 64 */
 423	{ 0xFF, 0x9F }, /* 65 */
 424	{ 0xFF, 0x9F }, /* 66 */
 425	{ 0xFF, 0xBF }, /* 67 */
 426	{ 0xFF, 0xBF }, /* 68 */
 427	{ 0xFF, 0xFF }, /* 69 */
 428	{ 0xFF, 0xFF }, /* 6A */
 429	{ 0xFF, 0x7F }, /* 6B */
 430	{ 0xFF, 0xF7 }, /* 6C */
 431	{ 0xFF, 0xFF }, /* 6D */
 432	{ 0xFF, 0xFF }, /* 6E */
 433	{ 0xFF, 0x1F }, /* 6F */
 434	{ 0xFF, 0xF7 }, /* 70 */
 435	{ 0xFF, 0xFF }, /* 71 */
 436	{ 0xFF, 0xFF }, /* 72 */
 437	{ 0xFF, 0x1F }, /* 73 */
 438	{ 0xFF, 0xF7 }, /* 74 */
 439	{ 0xFF, 0xFF }, /* 75 */
 440	{ 0xFF, 0xFF }, /* 76 */
 441	{ 0xFF, 0x1F }, /* 77 */
 442	{ 0xFF, 0xF7 }, /* 78 */
 443	{ 0xFF, 0xFF }, /* 79 */
 444	{ 0xFF, 0xFF }, /* 7A */
 445	{ 0xFF, 0x1F }, /* 7B */
 446	{ 0xFF, 0xF7 }, /* 7C */
 447	{ 0xFF, 0xFF }, /* 7D */
 448	{ 0xFF, 0xFF }, /* 7E */
 449	{ 0xFF, 0x1F }, /* 7F */
 450	{ 0xFF, 0xF7 }, /* 80 */
 451	{ 0xFF, 0xFF }, /* 81 */
 452	{ 0xFF, 0xFF }, /* 82 */
 453	{ 0xFF, 0x1F }, /* 83 */
 454	{ 0xFF, 0x7F }, /* 84 */
 455	{ 0xFF, 0x0F }, /* 85 */
 456	{ 0xFF, 0xD8 }, /* 86 */
 457	{ 0xFF, 0xFF }, /* 87 */
 458	{ 0xFF, 0xEF }, /* 88 */
 459	{ 0xFF, 0xFE }, /* 89 */
 460	{ 0xFF, 0xFE }, /* 8A */
 461	{ 0xFF, 0xFF }, /* 8B */
 462	{ 0xFF, 0xFF }, /* 8C */
 463	{ 0xFF, 0x3F }, /* 8D */
 464	{ 0xFF, 0xFF }, /* 8E */
 465	{ 0xFF, 0x3F }, /* 8F */
 466	{ 0xFF, 0x8F }, /* 90 */
 467	{ 0xFF, 0xFF }, /* 91 */
 468	{ 0xFF, 0x3F }, /* 92 */
 469	{ 0xFF, 0xFF }, /* 93 */
 470	{ 0xFF, 0xFF }, /* 94 */
 471	{ 0xFF, 0x0F }, /* 95 */
 472	{ 0xFF, 0x3F }, /* 96 */
 473	{ 0xFF, 0x8C }, /* 97 */
 474	{ 0x00, 0x00 }, /* 98 */
 475	{ 0x00, 0x00 }, /* 99 */
 476	{ 0x00, 0x00 }, /* 9A */
 477	{ 0x00, 0x00 }, /* 9B */
 478	{ 0x00, 0x00 }, /* 9C */
 479	{ 0x00, 0x00 }, /* 9D */
 480	{ 0x00, 0x00 }, /* 9E */
 481	{ 0x00, 0x00 }, /* 9F */
 482	{ 0x00, 0x00 }, /* A0 */
 483	{ 0x00, 0x00 }, /* A1 */
 484	{ 0x00, 0x00 }, /* A2 */
 485	{ 0x00, 0x00 }, /* A3 */
 486	{ 0x00, 0x00 }, /* A4 */
 487	{ 0x00, 0x00 }, /* A5 */
 488	{ 0x00, 0x00 }, /* A6 */
 489	{ 0x00, 0x00 }, /* A7 */
 490	{ 0x00, 0x00 }, /* A8 */
 491	{ 0x00, 0x00 }, /* A9 */
 492	{ 0x00, 0x00 }, /* AA */
 493	{ 0x00, 0x00 }, /* AB */
 494	{ 0x00, 0x00 }, /* AC */
 495	{ 0x00, 0x00 }, /* AD */
 496	{ 0x00, 0x00 }, /* AE */
 497	{ 0x00, 0x00 }, /* AF */
 498	{ 0x00, 0x00 }, /* B0 */
 499	{ 0x00, 0x00 }, /* B1 */
 500	{ 0x00, 0x00 }, /* B2 */
 501	{ 0x00, 0x00 }, /* B3 */
 502	{ 0x00, 0x00 }, /* B4 */
 503	{ 0x00, 0x00 }, /* B5 */
 504	{ 0x00, 0x00 }, /* B6 */
 505	{ 0x00, 0x00 }, /* B7 */
 506	{ 0x00, 0x00 }, /* B8 */
 507	{ 0x00, 0x00 }, /* B9 */
 508	{ 0x00, 0x00 }, /* BA */
 509	{ 0x00, 0x00 }, /* BB */
 510	{ 0x00, 0x00 }, /* BC */
 511	{ 0x00, 0x00 }, /* BD */
 512	{ 0x00, 0x00 }, /* BE */
 513	{ 0x00, 0x00 }, /* BF */
 514	{ 0x00, 0x00 }, /* C0 */
 515	{ 0x00, 0x00 }, /* C1 */
 516	{ 0x00, 0x00 }, /* C2 */
 517	{ 0x00, 0x00 }, /* C3 */
 518	{ 0x00, 0x00 }, /* C4 */
 519	{ 0x00, 0x00 }, /* C5 */
 520	{ 0x00, 0x00 }, /* C6 */
 521	{ 0x00, 0x00 }, /* C7 */
 522	{ 0x00, 0x00 }, /* C8 */
 523	{ 0x00, 0x00 }, /* C9 */
 524	{ 0x00, 0x00 }, /* CA */
 525	{ 0x00, 0x00 }, /* CB */
 526	{ 0x00, 0x00 }, /* CC */
 527	{ 0x00, 0x00 }, /* CD */
 528	{ 0x00, 0x00 }, /* CE */
 529	{ 0x00, 0x00 }, /* CF */
 530	{ 0x00, 0x00 }, /* D0 */
 531	{ 0x00, 0x00 }, /* D1 */
 532	{ 0x00, 0x00 }, /* D2 */
 533	{ 0x00, 0x00 }, /* D3 */
 534	{ 0x00, 0x00 }, /* D4 */
 535	{ 0x00, 0x00 }, /* D5 */
 536	{ 0x00, 0x00 }, /* D6 */
 537	{ 0x00, 0x00 }, /* D7 */
 538	{ 0x00, 0x00 }, /* D8 */
 539	{ 0x00, 0x00 }, /* D9 */
 540	{ 0x00, 0x00 }, /* DA */
 541	{ 0x00, 0x00 }, /* DB */
 542	{ 0x00, 0x00 }, /* DC */
 543	{ 0x00, 0x00 }, /* DD */
 544	{ 0x00, 0x00 }, /* DE */
 545	{ 0x00, 0x00 }, /* DF */
 546	{ 0x00, 0x00 }, /* E0 */
 547	{ 0x00, 0x00 }, /* E1 */
 548	{ 0x00, 0x00 }, /* E2 */
 549	{ 0x00, 0x00 }, /* E3 */
 550	{ 0x00, 0x00 }, /* E4 */
 551	{ 0x00, 0x00 }, /* E5 */
 552	{ 0x00, 0x00 }, /* E6 */
 553	{ 0x00, 0x00 }, /* E7 */
 554	{ 0x00, 0x00 }, /* E8 */
 555	{ 0x00, 0x00 }, /* E9 */
 556	{ 0x00, 0x00 }, /* EA */
 557	{ 0x00, 0x00 }, /* EB */
 558	{ 0x00, 0x00 }, /* EC */
 559	{ 0x00, 0x00 }, /* ED */
 560	{ 0x00, 0x00 }, /* EE */
 561	{ 0x00, 0x00 }, /* EF */
 562	{ 0x00, 0x00 }, /* F0 */
 563	{ 0x00, 0x00 }, /* F1 */
 564	{ 0x00, 0x00 }, /* F2 */
 565	{ 0x00, 0x00 }, /* F3 */
 566	{ 0x00, 0x00 }, /* F4 */
 567	{ 0x00, 0x00 }, /* F5 */
 568	{ 0x00, 0x00 }, /* F6 */
 569	{ 0x00, 0x00 }, /* F7 */
 570	{ 0x00, 0x00 }, /* F8 */
 571	{ 0x00, 0x00 }, /* F9 */
 572	{ 0x00, 0x00 }, /* FA */
 573	{ 0x00, 0x00 }, /* FB */
 574	{ 0x00, 0x00 }, /* FC */
 575	{ 0x00, 0x00 }, /* FD */
 576	{ 0x00, 0x00 }, /* FE */
 577	{ 0xFF, 0x00 }, /* FF */
 578};
 579
 580static int max98095_readable(struct snd_soc_codec *codec, unsigned int reg)
 581{
 582	if (reg >= M98095_REG_CNT)
 583		return 0;
 584	return max98095_access[reg].readable != 0;
 585}
 586
 587static int max98095_volatile(struct snd_soc_codec *codec, unsigned int reg)
 588{
 589	if (reg > M98095_REG_MAX_CACHED)
 590		return 1;
 591
 592	switch (reg) {
 593	case M98095_000_HOST_DATA:
 594	case M98095_001_HOST_INT_STS:
 595	case M98095_002_HOST_RSP_STS:
 596	case M98095_003_HOST_CMD_STS:
 597	case M98095_004_CODEC_STS:
 598	case M98095_005_DAI1_ALC_STS:
 599	case M98095_006_DAI2_ALC_STS:
 600	case M98095_007_JACK_AUTO_STS:
 601	case M98095_008_JACK_MANUAL_STS:
 602	case M98095_009_JACK_VBAT_STS:
 603	case M98095_00A_ACC_ADC_STS:
 604	case M98095_00B_MIC_NG_AGC_STS:
 605	case M98095_00C_SPK_L_VOLT_STS:
 606	case M98095_00D_SPK_R_VOLT_STS:
 607	case M98095_00E_TEMP_SENSOR_STS:
 608		return 1;
 609	}
 610
 611	return 0;
 612}
 613
 614/*
 615 * Filter coefficients are in a separate register segment
 616 * and they share the address space of the normal registers.
 617 * The coefficient registers do not need or share the cache.
 618 */
 619static int max98095_hw_write(struct snd_soc_codec *codec, unsigned int reg,
 620			     unsigned int value)
 621{
 622	int ret;
 623
 624	codec->cache_bypass = 1;
 625	ret = snd_soc_write(codec, reg, value);
 626	codec->cache_bypass = 0;
 627
 628	return ret ? -EIO : 0;
 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_codec_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 const 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 const 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 const 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_codec_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 const char *bq_mode_name[] = {"Biquad1 Mode", "Biquad2 Mode"};
1996
1997static int max98095_get_bq_channel(struct snd_soc_codec *codec,
1998				   const char *name)
1999{
2000	int i;
2001
2002	for (i = 0; i < ARRAY_SIZE(bq_mode_name); i++)
2003		if (strcmp(name, bq_mode_name[i]) == 0)
2004			return i;
2005
2006	/* Shouldn't happen */
2007	dev_err(codec->dev, "Bad biquad channel name '%s'\n", name);
2008	return -EINVAL;
2009}
2010
2011static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
2012				 struct snd_ctl_elem_value *ucontrol)
2013{
2014	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2015	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2016	struct max98095_pdata *pdata = max98095->pdata;
2017	int channel = max98095_get_bq_channel(codec, kcontrol->id.name);
2018	struct max98095_cdata *cdata;
2019	int sel = ucontrol->value.integer.value[0];
2020	struct max98095_biquad_cfg *coef_set;
2021	int fs, best, best_val, i;
2022	int regmask, regsave;
2023
2024	if (channel < 0)
2025		return channel;
2026
2027	if (!pdata || !max98095->bq_textcnt)
2028		return 0;
2029
2030	if (sel >= pdata->bq_cfgcnt)
2031		return -EINVAL;
2032
2033	cdata = &max98095->dai[channel];
2034	cdata->bq_sel = sel;
2035	fs = cdata->rate;
2036
2037	/* Find the selected configuration with nearest sample rate */
2038	best = 0;
2039	best_val = INT_MAX;
2040	for (i = 0; i < pdata->bq_cfgcnt; i++) {
2041		if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
2042			abs(pdata->bq_cfg[i].rate - fs) < best_val) {
2043			best = i;
2044			best_val = abs(pdata->bq_cfg[i].rate - fs);
2045		}
2046	}
2047
2048	dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
2049		pdata->bq_cfg[best].name,
2050		pdata->bq_cfg[best].rate, fs);
2051
2052	coef_set = &pdata->bq_cfg[best];
2053
2054	regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
2055
2056	/* Disable filter while configuring, and save current on/off state */
2057	regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
2058	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
2059
2060	mutex_lock(&codec->mutex);
2061	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
2062	m98095_biquad_band(codec, channel, 0, coef_set->band1);
2063	m98095_biquad_band(codec, channel, 1, coef_set->band2);
2064	snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
2065	mutex_unlock(&codec->mutex);
2066
2067	/* Restore the original on/off state */
2068	snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
2069	return 0;
2070}
2071
2072static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
2073				 struct snd_ctl_elem_value *ucontrol)
2074{
2075	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2076	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2077	int channel = max98095_get_bq_channel(codec, kcontrol->id.name);
2078	struct max98095_cdata *cdata;
2079
2080	if (channel < 0)
2081		return channel;
2082
2083	cdata = &max98095->dai[channel];
2084	ucontrol->value.enumerated.item[0] = cdata->bq_sel;
2085
2086	return 0;
2087}
2088
2089static void max98095_handle_bq_pdata(struct snd_soc_codec *codec)
2090{
2091	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2092	struct max98095_pdata *pdata = max98095->pdata;
2093	struct max98095_biquad_cfg *cfg;
2094	unsigned int cfgcnt;
2095	int i, j;
2096	const char **t;
2097	int ret;
2098
2099	struct snd_kcontrol_new controls[] = {
2100		SOC_ENUM_EXT((char *)bq_mode_name[0],
2101			max98095->bq_enum,
2102			max98095_get_bq_enum,
2103			max98095_put_bq_enum),
2104		SOC_ENUM_EXT((char *)bq_mode_name[1],
2105			max98095->bq_enum,
2106			max98095_get_bq_enum,
2107			max98095_put_bq_enum),
2108	};
2109	BUILD_BUG_ON(ARRAY_SIZE(controls) != ARRAY_SIZE(bq_mode_name));
2110
2111	cfg = pdata->bq_cfg;
2112	cfgcnt = pdata->bq_cfgcnt;
2113
2114	/* Setup an array of texts for the biquad enum.
2115	 * This is based on Mark Brown's equalizer driver code.
2116	 */
2117	max98095->bq_textcnt = 0;
2118	max98095->bq_texts = NULL;
2119	for (i = 0; i < cfgcnt; i++) {
2120		for (j = 0; j < max98095->bq_textcnt; j++) {
2121			if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
2122				break;
2123		}
2124
2125		if (j != max98095->bq_textcnt)
2126			continue;
2127
2128		/* Expand the array */
2129		t = krealloc(max98095->bq_texts,
2130			     sizeof(char *) * (max98095->bq_textcnt + 1),
2131			     GFP_KERNEL);
2132		if (t == NULL)
2133			continue;
2134
2135		/* Store the new entry */
2136		t[max98095->bq_textcnt] = cfg[i].name;
2137		max98095->bq_textcnt++;
2138		max98095->bq_texts = t;
2139	}
2140
2141	/* Now point the soc_enum to .texts array items */
2142	max98095->bq_enum.texts = max98095->bq_texts;
2143	max98095->bq_enum.max = max98095->bq_textcnt;
2144
2145	ret = snd_soc_add_codec_controls(codec, controls, ARRAY_SIZE(controls));
2146	if (ret != 0)
2147		dev_err(codec->dev, "Failed to add Biquad control: %d\n", ret);
2148}
2149
2150static void max98095_handle_pdata(struct snd_soc_codec *codec)
2151{
2152	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2153	struct max98095_pdata *pdata = max98095->pdata;
2154	u8 regval = 0;
2155
2156	if (!pdata) {
2157		dev_dbg(codec->dev, "No platform data\n");
2158		return;
2159	}
2160
2161	/* Configure mic for analog/digital mic mode */
2162	if (pdata->digmic_left_mode)
2163		regval |= M98095_DIGMIC_L;
2164
2165	if (pdata->digmic_right_mode)
2166		regval |= M98095_DIGMIC_R;
2167
2168	snd_soc_write(codec, M98095_087_CFG_MIC, regval);
2169
2170	/* Configure equalizers */
2171	if (pdata->eq_cfgcnt)
2172		max98095_handle_eq_pdata(codec);
2173
2174	/* Configure bi-quad filters */
2175	if (pdata->bq_cfgcnt)
2176		max98095_handle_bq_pdata(codec);
2177}
2178
2179static irqreturn_t max98095_report_jack(int irq, void *data)
2180{
2181	struct snd_soc_codec *codec = data;
2182	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2183	unsigned int value;
2184	int hp_report = 0;
2185	int mic_report = 0;
2186
2187	/* Read the Jack Status Register */
2188	value = snd_soc_read(codec, M98095_007_JACK_AUTO_STS);
2189
2190	/* If ddone is not set, then detection isn't finished yet */
2191	if ((value & M98095_DDONE) == 0)
2192		return IRQ_NONE;
2193
2194	/* if hp, check its bit, and if set, clear it */
2195	if ((value & M98095_HP_IN || value & M98095_LO_IN) &&
2196		max98095->headphone_jack)
2197		hp_report |= SND_JACK_HEADPHONE;
2198
2199	/* if mic, check its bit, and if set, clear it */
2200	if ((value & M98095_MIC_IN) && max98095->mic_jack)
2201		mic_report |= SND_JACK_MICROPHONE;
2202
2203	if (max98095->headphone_jack == max98095->mic_jack) {
2204		snd_soc_jack_report(max98095->headphone_jack,
2205					hp_report | mic_report,
2206					SND_JACK_HEADSET);
2207	} else {
2208		if (max98095->headphone_jack)
2209			snd_soc_jack_report(max98095->headphone_jack,
2210					hp_report, SND_JACK_HEADPHONE);
2211		if (max98095->mic_jack)
2212			snd_soc_jack_report(max98095->mic_jack,
2213					mic_report, SND_JACK_MICROPHONE);
2214	}
2215
2216	return IRQ_HANDLED;
2217}
2218
2219int max98095_jack_detect_enable(struct snd_soc_codec *codec)
2220{
2221	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2222	int ret = 0;
2223	int detect_enable = M98095_JDEN;
2224	unsigned int slew = M98095_DEFAULT_SLEW_DELAY;
2225
2226	if (max98095->pdata->jack_detect_pin5en)
2227		detect_enable |= M98095_PIN5EN;
2228
2229	if (max98095->pdata->jack_detect_delay)
2230		slew = max98095->pdata->jack_detect_delay;
2231
2232	ret = snd_soc_write(codec, M98095_08E_JACK_DC_SLEW, slew);
2233	if (ret < 0) {
2234		dev_err(codec->dev, "Failed to cfg auto detect %d\n", ret);
2235		return ret;
2236	}
2237
2238	/* configure auto detection to be enabled */
2239	ret = snd_soc_write(codec, M98095_089_JACK_DET_AUTO, detect_enable);
2240	if (ret < 0) {
2241		dev_err(codec->dev, "Failed to cfg auto detect %d\n", ret);
2242		return ret;
2243	}
2244
2245	return ret;
2246}
2247
2248int max98095_jack_detect_disable(struct snd_soc_codec *codec)
2249{
2250	int ret = 0;
2251
2252	/* configure auto detection to be disabled */
2253	ret = snd_soc_write(codec, M98095_089_JACK_DET_AUTO, 0x0);
2254	if (ret < 0) {
2255		dev_err(codec->dev, "Failed to cfg auto detect %d\n", ret);
2256		return ret;
2257	}
2258
2259	return ret;
2260}
2261
2262int max98095_jack_detect(struct snd_soc_codec *codec,
2263	struct snd_soc_jack *hp_jack, struct snd_soc_jack *mic_jack)
2264{
2265	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2266	struct i2c_client *client = to_i2c_client(codec->dev);
2267	int ret = 0;
2268
2269	max98095->headphone_jack = hp_jack;
2270	max98095->mic_jack = mic_jack;
2271
2272	/* only progress if we have at least 1 jack pointer */
2273	if (!hp_jack && !mic_jack)
2274		return -EINVAL;
2275
2276	max98095_jack_detect_enable(codec);
2277
2278	/* enable interrupts for headphone jack detection */
2279	ret = snd_soc_update_bits(codec, M98095_013_JACK_INT_EN,
2280		M98095_IDDONE, M98095_IDDONE);
2281	if (ret < 0) {
2282		dev_err(codec->dev, "Failed to cfg jack irqs %d\n", ret);
2283		return ret;
2284	}
2285
2286	max98095_report_jack(client->irq, codec);
2287	return 0;
2288}
2289
2290#ifdef CONFIG_PM
2291static int max98095_suspend(struct snd_soc_codec *codec)
2292{
2293	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2294
2295	if (max98095->headphone_jack || max98095->mic_jack)
2296		max98095_jack_detect_disable(codec);
2297
2298	max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2299
2300	return 0;
2301}
2302
2303static int max98095_resume(struct snd_soc_codec *codec)
2304{
2305	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2306	struct i2c_client *client = to_i2c_client(codec->dev);
2307
2308	max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2309
2310	if (max98095->headphone_jack || max98095->mic_jack) {
2311		max98095_jack_detect_enable(codec);
2312		max98095_report_jack(client->irq, codec);
2313	}
2314
2315	return 0;
2316}
2317#else
2318#define max98095_suspend NULL
2319#define max98095_resume NULL
2320#endif
2321
2322static int max98095_reset(struct snd_soc_codec *codec)
2323{
2324	int i, ret;
2325
2326	/* Gracefully reset the DSP core and the codec hardware
2327	 * in a proper sequence */
2328	ret = snd_soc_write(codec, M98095_00F_HOST_CFG, 0);
2329	if (ret < 0) {
2330		dev_err(codec->dev, "Failed to reset DSP: %d\n", ret);
2331		return ret;
2332	}
2333
2334	ret = snd_soc_write(codec, M98095_097_PWR_SYS, 0);
2335	if (ret < 0) {
2336		dev_err(codec->dev, "Failed to reset codec: %d\n", ret);
2337		return ret;
2338	}
2339
2340	/* Reset to hardware default for registers, as there is not
2341	 * a soft reset hardware control register */
2342	for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
2343		ret = snd_soc_write(codec, i, max98095_reg_def[i]);
2344		if (ret < 0) {
2345			dev_err(codec->dev, "Failed to reset: %d\n", ret);
2346			return ret;
2347		}
2348	}
2349
2350	return ret;
2351}
2352
2353static int max98095_probe(struct snd_soc_codec *codec)
2354{
2355	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2356	struct max98095_cdata *cdata;
2357	struct i2c_client *client;
2358	int ret = 0;
2359
2360	ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
2361	if (ret != 0) {
2362		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
2363		return ret;
2364	}
2365
2366	/* reset the codec, the DSP core, and disable all interrupts */
2367	max98095_reset(codec);
2368
2369	client = to_i2c_client(codec->dev);
2370
2371	/* initialize private data */
2372
2373	max98095->sysclk = (unsigned)-1;
2374	max98095->eq_textcnt = 0;
2375	max98095->bq_textcnt = 0;
2376
2377	cdata = &max98095->dai[0];
2378	cdata->rate = (unsigned)-1;
2379	cdata->fmt  = (unsigned)-1;
2380	cdata->eq_sel = 0;
2381	cdata->bq_sel = 0;
2382
2383	cdata = &max98095->dai[1];
2384	cdata->rate = (unsigned)-1;
2385	cdata->fmt  = (unsigned)-1;
2386	cdata->eq_sel = 0;
2387	cdata->bq_sel = 0;
2388
2389	cdata = &max98095->dai[2];
2390	cdata->rate = (unsigned)-1;
2391	cdata->fmt  = (unsigned)-1;
2392	cdata->eq_sel = 0;
2393	cdata->bq_sel = 0;
2394
2395	max98095->lin_state = 0;
2396	max98095->mic1pre = 0;
2397	max98095->mic2pre = 0;
2398
2399	if (client->irq) {
2400		/* register an audio interrupt */
2401		ret = request_threaded_irq(client->irq, NULL,
2402			max98095_report_jack,
2403			IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
2404			"max98095", codec);
2405		if (ret) {
2406			dev_err(codec->dev, "Failed to request IRQ: %d\n", ret);
2407			goto err_access;
2408		}
2409	}
2410
2411	ret = snd_soc_read(codec, M98095_0FF_REV_ID);
2412	if (ret < 0) {
2413		dev_err(codec->dev, "Failure reading hardware revision: %d\n",
2414			ret);
2415		goto err_irq;
2416	}
2417	dev_info(codec->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
2418
2419	snd_soc_write(codec, M98095_097_PWR_SYS, M98095_PWRSV);
2420
2421	/* initialize registers cache to hardware default */
2422	max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2423
2424	snd_soc_write(codec, M98095_048_MIX_DAC_LR,
2425		M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2426
2427	snd_soc_write(codec, M98095_049_MIX_DAC_M,
2428		M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2429
2430	snd_soc_write(codec, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2431	snd_soc_write(codec, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2432	snd_soc_write(codec, M98095_04E_CFG_HP, M98095_HPNORMAL);
2433
2434	snd_soc_write(codec, M98095_02C_DAI1_IOCFG,
2435		M98095_S1NORMAL|M98095_SDATA);
2436
2437	snd_soc_write(codec, M98095_036_DAI2_IOCFG,
2438		M98095_S2NORMAL|M98095_SDATA);
2439
2440	snd_soc_write(codec, M98095_040_DAI3_IOCFG,
2441		M98095_S3NORMAL|M98095_SDATA);
2442
2443	max98095_handle_pdata(codec);
2444
2445	/* take the codec out of the shut down */
2446	snd_soc_update_bits(codec, M98095_097_PWR_SYS, M98095_SHDNRUN,
2447		M98095_SHDNRUN);
2448
2449	max98095_add_widgets(codec);
2450
2451	return 0;
2452
2453err_irq:
2454	if (client->irq)
2455		free_irq(client->irq, codec);
2456err_access:
2457	return ret;
2458}
2459
2460static int max98095_remove(struct snd_soc_codec *codec)
2461{
2462	struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2463	struct i2c_client *client = to_i2c_client(codec->dev);
2464
2465	max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2466
2467	if (max98095->headphone_jack || max98095->mic_jack)
2468		max98095_jack_detect_disable(codec);
2469
2470	if (client->irq)
2471		free_irq(client->irq, codec);
2472
2473	return 0;
2474}
2475
2476static struct snd_soc_codec_driver soc_codec_dev_max98095 = {
2477	.probe   = max98095_probe,
2478	.remove  = max98095_remove,
2479	.suspend = max98095_suspend,
2480	.resume  = max98095_resume,
2481	.set_bias_level = max98095_set_bias_level,
2482	.reg_cache_size = ARRAY_SIZE(max98095_reg_def),
2483	.reg_word_size = sizeof(u8),
2484	.reg_cache_default = max98095_reg_def,
2485	.readable_register = max98095_readable,
2486	.volatile_register = max98095_volatile,
2487	.dapm_widgets	  = max98095_dapm_widgets,
2488	.num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
2489	.dapm_routes     = max98095_audio_map,
2490	.num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
2491};
2492
2493static int max98095_i2c_probe(struct i2c_client *i2c,
2494			     const struct i2c_device_id *id)
2495{
2496	struct max98095_priv *max98095;
2497	int ret;
2498
2499	max98095 = devm_kzalloc(&i2c->dev, sizeof(struct max98095_priv),
2500				GFP_KERNEL);
2501	if (max98095 == NULL)
2502		return -ENOMEM;
2503
2504	max98095->devtype = id->driver_data;
2505	i2c_set_clientdata(i2c, max98095);
2506	max98095->pdata = i2c->dev.platform_data;
2507
2508	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_max98095,
2509				     max98095_dai, ARRAY_SIZE(max98095_dai));
2510	return ret;
2511}
2512
2513static int __devexit max98095_i2c_remove(struct i2c_client *client)
2514{
2515	snd_soc_unregister_codec(&client->dev);
2516	return 0;
2517}
2518
2519static const struct i2c_device_id max98095_i2c_id[] = {
2520	{ "max98095", MAX98095 },
2521	{ }
2522};
2523MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
2524
2525static struct i2c_driver max98095_i2c_driver = {
2526	.driver = {
2527		.name = "max98095",
2528		.owner = THIS_MODULE,
2529	},
2530	.probe  = max98095_i2c_probe,
2531	.remove = __devexit_p(max98095_i2c_remove),
2532	.id_table = max98095_i2c_id,
2533};
2534
2535static int __init max98095_init(void)
2536{
2537	int ret;
2538
2539	ret = i2c_add_driver(&max98095_i2c_driver);
2540	if (ret)
2541		pr_err("Failed to register max98095 I2C driver: %d\n", ret);
2542
2543	return ret;
2544}
2545module_init(max98095_init);
2546
2547static void __exit max98095_exit(void)
2548{
2549	i2c_del_driver(&max98095_i2c_driver);
2550}
2551module_exit(max98095_exit);
2552
2553MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2554MODULE_AUTHOR("Peter Hsiang");
2555MODULE_LICENSE("GPL");