LXR linux/sound/soc/codecs/max98095.c

   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
2219static int 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
2248static int 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}
2289EXPORT_SYMBOL_GPL(max98095_jack_detect);
2290
2291#ifdef CONFIG_PM
2292static int max98095_suspend(struct snd_soc_codec *codec)
2293{
2294        struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2295
2296        if (max98095->headphone_jack || max98095->mic_jack)
2297                max98095_jack_detect_disable(codec);
2298
2299        max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2300
2301        return 0;
2302}
2303
2304static int max98095_resume(struct snd_soc_codec *codec)
2305{
2306        struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2307        struct i2c_client *client = to_i2c_client(codec->dev);
2308
2309        max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2310
2311        if (max98095->headphone_jack || max98095->mic_jack) {
2312                max98095_jack_detect_enable(codec);
2313                max98095_report_jack(client->irq, codec);
2314        }
2315
2316        return 0;
2317}
2318#else
2319#define max98095_suspend NULL
2320#define max98095_resume NULL
2321#endif
2322
2323static int max98095_reset(struct snd_soc_codec *codec)
2324{
2325        int i, ret;
2326
2327        /* Gracefully reset the DSP core and the codec hardware
2328         * in a proper sequence */
2329        ret = snd_soc_write(codec, M98095_00F_HOST_CFG, 0);
2330        if (ret < 0) {
2331                dev_err(codec->dev, "Failed to reset DSP: %d\n", ret);
2332                return ret;
2333        }
2334
2335        ret = snd_soc_write(codec, M98095_097_PWR_SYS, 0);
2336        if (ret < 0) {
2337                dev_err(codec->dev, "Failed to reset codec: %d\n", ret);
2338                return ret;
2339        }
2340
2341        /* Reset to hardware default for registers, as there is not
2342         * a soft reset hardware control register */
2343        for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
2344                ret = snd_soc_write(codec, i, max98095_reg_def[i]);
2345                if (ret < 0) {
2346                        dev_err(codec->dev, "Failed to reset: %d\n", ret);
2347                        return ret;
2348                }
2349        }
2350
2351        return ret;
2352}
2353
2354static int max98095_probe(struct snd_soc_codec *codec)
2355{
2356        struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2357        struct max98095_cdata *cdata;
2358        struct i2c_client *client;
2359        int ret = 0;
2360
2361        ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
2362        if (ret != 0) {
2363                dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
2364                return ret;
2365        }
2366
2367        /* reset the codec, the DSP core, and disable all interrupts */
2368        max98095_reset(codec);
2369
2370        client = to_i2c_client(codec->dev);
2371
2372        /* initialize private data */
2373
2374        max98095->sysclk = (unsigned)-1;
2375        max98095->eq_textcnt = 0;
2376        max98095->bq_textcnt = 0;
2377
2378        cdata = &max98095->dai[0];
2379        cdata->rate = (unsigned)-1;
2380        cdata->fmt  = (unsigned)-1;
2381        cdata->eq_sel = 0;
2382        cdata->bq_sel = 0;
2383
2384        cdata = &max98095->dai[1];
2385        cdata->rate = (unsigned)-1;
2386        cdata->fmt  = (unsigned)-1;
2387        cdata->eq_sel = 0;
2388        cdata->bq_sel = 0;
2389
2390        cdata = &max98095->dai[2];
2391        cdata->rate = (unsigned)-1;
2392        cdata->fmt  = (unsigned)-1;
2393        cdata->eq_sel = 0;
2394        cdata->bq_sel = 0;
2395
2396        max98095->lin_state = 0;
2397        max98095->mic1pre = 0;
2398        max98095->mic2pre = 0;
2399
2400        if (client->irq) {
2401                /* register an audio interrupt */
2402                ret = request_threaded_irq(client->irq, NULL,
2403                        max98095_report_jack,
2404                        IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
2405                        "max98095", codec);
2406                if (ret) {
2407                        dev_err(codec->dev, "Failed to request IRQ: %d\n", ret);
2408                        goto err_access;
2409                }
2410        }
2411
2412        ret = snd_soc_read(codec, M98095_0FF_REV_ID);
2413        if (ret < 0) {
2414                dev_err(codec->dev, "Failure reading hardware revision: %d\n",
2415                        ret);
2416                goto err_irq;
2417        }
2418        dev_info(codec->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
2419
2420        snd_soc_write(codec, M98095_097_PWR_SYS, M98095_PWRSV);
2421
2422        /* initialize registers cache to hardware default */
2423        max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2424
2425        snd_soc_write(codec, M98095_048_MIX_DAC_LR,
2426                M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2427
2428        snd_soc_write(codec, M98095_049_MIX_DAC_M,
2429                M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2430
2431        snd_soc_write(codec, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2432        snd_soc_write(codec, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2433        snd_soc_write(codec, M98095_04E_CFG_HP, M98095_HPNORMAL);
2434
2435        snd_soc_write(codec, M98095_02C_DAI1_IOCFG,
2436                M98095_S1NORMAL|M98095_SDATA);
2437
2438        snd_soc_write(codec, M98095_036_DAI2_IOCFG,
2439                M98095_S2NORMAL|M98095_SDATA);
2440
2441        snd_soc_write(codec, M98095_040_DAI3_IOCFG,
2442                M98095_S3NORMAL|M98095_SDATA);
2443
2444        max98095_handle_pdata(codec);
2445
2446        /* take the codec out of the shut down */
2447        snd_soc_update_bits(codec, M98095_097_PWR_SYS, M98095_SHDNRUN,
2448                M98095_SHDNRUN);
2449
2450        max98095_add_widgets(codec);
2451
2452        return 0;
2453
2454err_irq:
2455        if (client->irq)
2456                free_irq(client->irq, codec);
2457err_access:
2458        return ret;
2459}
2460
2461static int max98095_remove(struct snd_soc_codec *codec)
2462{
2463        struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2464        struct i2c_client *client = to_i2c_client(codec->dev);
2465
2466        max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2467
2468        if (max98095->headphone_jack || max98095->mic_jack)
2469                max98095_jack_detect_disable(codec);
2470
2471        if (client->irq)
2472                free_irq(client->irq, codec);
2473
2474        return 0;
2475}
2476
2477static struct snd_soc_codec_driver soc_codec_dev_max98095 = {
2478        .probe   = max98095_probe,
2479        .remove  = max98095_remove,
2480        .suspend = max98095_suspend,
2481        .resume  = max98095_resume,
2482        .set_bias_level = max98095_set_bias_level,
2483        .reg_cache_size = ARRAY_SIZE(max98095_reg_def),
2484        .reg_word_size = sizeof(u8),
2485        .reg_cache_default = max98095_reg_def,
2486        .readable_register = max98095_readable,
2487        .volatile_register = max98095_volatile,
2488        .dapm_widgets     = max98095_dapm_widgets,
2489        .num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
2490        .dapm_routes     = max98095_audio_map,
2491        .num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
2492};
2493
2494static int max98095_i2c_probe(struct i2c_client *i2c,
2495                             const struct i2c_device_id *id)
2496{
2497        struct max98095_priv *max98095;
2498        int ret;
2499
2500        max98095 = devm_kzalloc(&i2c->dev, sizeof(struct max98095_priv),
2501                                GFP_KERNEL);
2502        if (max98095 == NULL)
2503                return -ENOMEM;
2504
2505        max98095->devtype = id->driver_data;
2506        i2c_set_clientdata(i2c, max98095);
2507        max98095->pdata = i2c->dev.platform_data;
2508
2509        ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_max98095,
2510                                     max98095_dai, ARRAY_SIZE(max98095_dai));
2511        return ret;
2512}
2513
2514static int __devexit max98095_i2c_remove(struct i2c_client *client)
2515{
2516        snd_soc_unregister_codec(&client->dev);
2517        return 0;
2518}
2519
2520static const struct i2c_device_id max98095_i2c_id[] = {
2521        { "max98095", MAX98095 },
2522        { }
2523};
2524MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
2525
2526static struct i2c_driver max98095_i2c_driver = {
2527        .driver = {
2528                .name = "max98095",
2529                .owner = THIS_MODULE,
2530        },
2531        .probe  = max98095_i2c_probe,
2532        .remove = __devexit_p(max98095_i2c_remove),
2533        .id_table = max98095_i2c_id,
2534};
2535
2536static int __init max98095_init(void)
2537{
2538        int ret;
2539
2540        ret = i2c_add_driver(&max98095_i2c_driver);
2541        if (ret)
2542                pr_err("Failed to register max98095 I2C driver: %d\n", ret);
2543
2544        return ret;
2545}
2546module_init(max98095_init);
2547
2548static void __exit max98095_exit(void)
2549{
2550        i2c_del_driver(&max98095_i2c_driver);
2551}
2552module_exit(max98095_exit);
2553
2554MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2555MODULE_AUTHOR("Peter Hsiang");
2556MODULE_LICENSE("GPL");
2557