linux/sound/soc/codecs/da7219.c
<<
>>
Prefs
   1/*
   2 * da7219.c - DA7219 ALSA SoC Codec Driver
   3 *
   4 * Copyright (c) 2015 Dialog Semiconductor
   5 *
   6 * Author: Adam Thomson <Adam.Thomson.Opensource@diasemi.com>
   7 *
   8 * This program is free software; you can redistribute  it and/or modify it
   9 * under  the terms of  the GNU General  Public License as published by the
  10 * Free Software Foundation;  either version 2 of the  License, or (at your
  11 * option) any later version.
  12 */
  13
  14#include <linux/acpi.h>
  15#include <linux/clk.h>
  16#include <linux/i2c.h>
  17#include <linux/of_device.h>
  18#include <linux/property.h>
  19#include <linux/regmap.h>
  20#include <linux/slab.h>
  21#include <linux/pm.h>
  22#include <linux/module.h>
  23#include <linux/delay.h>
  24#include <linux/regulator/consumer.h>
  25#include <sound/pcm.h>
  26#include <sound/pcm_params.h>
  27#include <sound/soc.h>
  28#include <sound/soc-dapm.h>
  29#include <sound/initval.h>
  30#include <sound/tlv.h>
  31#include <asm/div64.h>
  32
  33#include <sound/da7219.h>
  34#include "da7219.h"
  35#include "da7219-aad.h"
  36
  37
  38/*
  39 * TLVs and Enums
  40 */
  41
  42/* Input TLVs */
  43static const DECLARE_TLV_DB_SCALE(da7219_mic_gain_tlv, -600, 600, 0);
  44static const DECLARE_TLV_DB_SCALE(da7219_mixin_gain_tlv, -450, 150, 0);
  45static const DECLARE_TLV_DB_SCALE(da7219_adc_dig_gain_tlv, -8325, 75, 0);
  46static const DECLARE_TLV_DB_SCALE(da7219_alc_threshold_tlv, -9450, 150, 0);
  47static const DECLARE_TLV_DB_SCALE(da7219_alc_gain_tlv, 0, 600, 0);
  48static const DECLARE_TLV_DB_SCALE(da7219_alc_ana_gain_tlv, 0, 600, 0);
  49static const DECLARE_TLV_DB_SCALE(da7219_sidetone_gain_tlv, -4200, 300, 0);
  50static const DECLARE_TLV_DB_SCALE(da7219_tonegen_gain_tlv, -4500, 300, 0);
  51
  52/* Output TLVs */
  53static const DECLARE_TLV_DB_SCALE(da7219_dac_eq_band_tlv, -1050, 150, 0);
  54
  55static const DECLARE_TLV_DB_RANGE(da7219_dac_dig_gain_tlv,
  56        0x0, 0x07, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 1),
  57        /* -77.25dB to 12dB */
  58        0x08, 0x7f, TLV_DB_SCALE_ITEM(-7725, 75, 0)
  59);
  60
  61static const DECLARE_TLV_DB_SCALE(da7219_dac_ng_threshold_tlv, -10200, 600, 0);
  62static const DECLARE_TLV_DB_SCALE(da7219_hp_gain_tlv, -5700, 100, 0);
  63
  64/* Input Enums */
  65static const char * const da7219_alc_attack_rate_txt[] = {
  66        "7.33/fs", "14.66/fs", "29.32/fs", "58.64/fs", "117.3/fs", "234.6/fs",
  67        "469.1/fs", "938.2/fs", "1876/fs", "3753/fs", "7506/fs", "15012/fs",
  68        "30024/fs"
  69};
  70
  71static const struct soc_enum da7219_alc_attack_rate =
  72        SOC_ENUM_SINGLE(DA7219_ALC_CTRL2, DA7219_ALC_ATTACK_SHIFT,
  73                        DA7219_ALC_ATTACK_MAX, da7219_alc_attack_rate_txt);
  74
  75static const char * const da7219_alc_release_rate_txt[] = {
  76        "28.66/fs", "57.33/fs", "114.6/fs", "229.3/fs", "458.6/fs", "917.1/fs",
  77        "1834/fs", "3668/fs", "7337/fs", "14674/fs", "29348/fs"
  78};
  79
  80static const struct soc_enum da7219_alc_release_rate =
  81        SOC_ENUM_SINGLE(DA7219_ALC_CTRL2, DA7219_ALC_RELEASE_SHIFT,
  82                        DA7219_ALC_RELEASE_MAX, da7219_alc_release_rate_txt);
  83
  84static const char * const da7219_alc_hold_time_txt[] = {
  85        "62/fs", "124/fs", "248/fs", "496/fs", "992/fs", "1984/fs", "3968/fs",
  86        "7936/fs", "15872/fs", "31744/fs", "63488/fs", "126976/fs",
  87        "253952/fs", "507904/fs", "1015808/fs", "2031616/fs"
  88};
  89
  90static const struct soc_enum da7219_alc_hold_time =
  91        SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_HOLD_SHIFT,
  92                        DA7219_ALC_HOLD_MAX, da7219_alc_hold_time_txt);
  93
  94static const char * const da7219_alc_env_rate_txt[] = {
  95        "1/4", "1/16", "1/256", "1/65536"
  96};
  97
  98static const struct soc_enum da7219_alc_env_attack_rate =
  99        SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_INTEG_ATTACK_SHIFT,
 100                        DA7219_ALC_INTEG_MAX, da7219_alc_env_rate_txt);
 101
 102static const struct soc_enum da7219_alc_env_release_rate =
 103        SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_INTEG_RELEASE_SHIFT,
 104                        DA7219_ALC_INTEG_MAX, da7219_alc_env_rate_txt);
 105
 106static const char * const da7219_alc_anticlip_step_txt[] = {
 107        "0.034dB/fs", "0.068dB/fs", "0.136dB/fs", "0.272dB/fs"
 108};
 109
 110static const struct soc_enum da7219_alc_anticlip_step =
 111        SOC_ENUM_SINGLE(DA7219_ALC_ANTICLIP_CTRL,
 112                        DA7219_ALC_ANTICLIP_STEP_SHIFT,
 113                        DA7219_ALC_ANTICLIP_STEP_MAX,
 114                        da7219_alc_anticlip_step_txt);
 115
 116/* Input/Output Enums */
 117static const char * const da7219_gain_ramp_rate_txt[] = {
 118        "Nominal Rate * 8", "Nominal Rate", "Nominal Rate / 8",
 119        "Nominal Rate / 16"
 120};
 121
 122static const struct soc_enum da7219_gain_ramp_rate =
 123        SOC_ENUM_SINGLE(DA7219_GAIN_RAMP_CTRL, DA7219_GAIN_RAMP_RATE_SHIFT,
 124                        DA7219_GAIN_RAMP_RATE_MAX, da7219_gain_ramp_rate_txt);
 125
 126static const char * const da7219_hpf_mode_txt[] = {
 127        "Disabled", "Audio", "Voice"
 128};
 129
 130static const unsigned int da7219_hpf_mode_val[] = {
 131        DA7219_HPF_DISABLED, DA7219_HPF_AUDIO_EN, DA7219_HPF_VOICE_EN,
 132};
 133
 134static const struct soc_enum da7219_adc_hpf_mode =
 135        SOC_VALUE_ENUM_SINGLE(DA7219_ADC_FILTERS1, DA7219_HPF_MODE_SHIFT,
 136                              DA7219_HPF_MODE_MASK, DA7219_HPF_MODE_MAX,
 137                              da7219_hpf_mode_txt, da7219_hpf_mode_val);
 138
 139static const struct soc_enum da7219_dac_hpf_mode =
 140        SOC_VALUE_ENUM_SINGLE(DA7219_DAC_FILTERS1, DA7219_HPF_MODE_SHIFT,
 141                              DA7219_HPF_MODE_MASK, DA7219_HPF_MODE_MAX,
 142                              da7219_hpf_mode_txt, da7219_hpf_mode_val);
 143
 144static const char * const da7219_audio_hpf_corner_txt[] = {
 145        "2Hz", "4Hz", "8Hz", "16Hz"
 146};
 147
 148static const struct soc_enum da7219_adc_audio_hpf_corner =
 149        SOC_ENUM_SINGLE(DA7219_ADC_FILTERS1,
 150                        DA7219_ADC_AUDIO_HPF_CORNER_SHIFT,
 151                        DA7219_AUDIO_HPF_CORNER_MAX,
 152                        da7219_audio_hpf_corner_txt);
 153
 154static const struct soc_enum da7219_dac_audio_hpf_corner =
 155        SOC_ENUM_SINGLE(DA7219_DAC_FILTERS1,
 156                        DA7219_DAC_AUDIO_HPF_CORNER_SHIFT,
 157                        DA7219_AUDIO_HPF_CORNER_MAX,
 158                        da7219_audio_hpf_corner_txt);
 159
 160static const char * const da7219_voice_hpf_corner_txt[] = {
 161        "2.5Hz", "25Hz", "50Hz", "100Hz", "150Hz", "200Hz", "300Hz", "400Hz"
 162};
 163
 164static const struct soc_enum da7219_adc_voice_hpf_corner =
 165        SOC_ENUM_SINGLE(DA7219_ADC_FILTERS1,
 166                        DA7219_ADC_VOICE_HPF_CORNER_SHIFT,
 167                        DA7219_VOICE_HPF_CORNER_MAX,
 168                        da7219_voice_hpf_corner_txt);
 169
 170static const struct soc_enum da7219_dac_voice_hpf_corner =
 171        SOC_ENUM_SINGLE(DA7219_DAC_FILTERS1,
 172                        DA7219_DAC_VOICE_HPF_CORNER_SHIFT,
 173                        DA7219_VOICE_HPF_CORNER_MAX,
 174                        da7219_voice_hpf_corner_txt);
 175
 176static const char * const da7219_tonegen_dtmf_key_txt[] = {
 177        "0", "1", "2", "3", "4", "5", "6", "7", "8", "9", "A", "B", "C", "D",
 178        "*", "#"
 179};
 180
 181static const struct soc_enum da7219_tonegen_dtmf_key =
 182        SOC_ENUM_SINGLE(DA7219_TONE_GEN_CFG1, DA7219_DTMF_REG_SHIFT,
 183                        DA7219_DTMF_REG_MAX, da7219_tonegen_dtmf_key_txt);
 184
 185static const char * const da7219_tonegen_swg_sel_txt[] = {
 186        "Sum", "SWG1", "SWG2", "SWG1_1-Cos"
 187};
 188
 189static const struct soc_enum da7219_tonegen_swg_sel =
 190        SOC_ENUM_SINGLE(DA7219_TONE_GEN_CFG2, DA7219_SWG_SEL_SHIFT,
 191                        DA7219_SWG_SEL_MAX, da7219_tonegen_swg_sel_txt);
 192
 193/* Output Enums */
 194static const char * const da7219_dac_softmute_rate_txt[] = {
 195        "1 Sample", "2 Samples", "4 Samples", "8 Samples", "16 Samples",
 196        "32 Samples", "64 Samples"
 197};
 198
 199static const struct soc_enum da7219_dac_softmute_rate =
 200        SOC_ENUM_SINGLE(DA7219_DAC_FILTERS5, DA7219_DAC_SOFTMUTE_RATE_SHIFT,
 201                        DA7219_DAC_SOFTMUTE_RATE_MAX,
 202                        da7219_dac_softmute_rate_txt);
 203
 204static const char * const da7219_dac_ng_setup_time_txt[] = {
 205        "256 Samples", "512 Samples", "1024 Samples", "2048 Samples"
 206};
 207
 208static const struct soc_enum da7219_dac_ng_setup_time =
 209        SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
 210                        DA7219_DAC_NG_SETUP_TIME_SHIFT,
 211                        DA7219_DAC_NG_SETUP_TIME_MAX,
 212                        da7219_dac_ng_setup_time_txt);
 213
 214static const char * const da7219_dac_ng_rampup_txt[] = {
 215        "0.22ms/dB", "0.0138ms/dB"
 216};
 217
 218static const struct soc_enum da7219_dac_ng_rampup_rate =
 219        SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
 220                        DA7219_DAC_NG_RAMPUP_RATE_SHIFT,
 221                        DA7219_DAC_NG_RAMP_RATE_MAX,
 222                        da7219_dac_ng_rampup_txt);
 223
 224static const char * const da7219_dac_ng_rampdown_txt[] = {
 225        "0.88ms/dB", "14.08ms/dB"
 226};
 227
 228static const struct soc_enum da7219_dac_ng_rampdown_rate =
 229        SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
 230                        DA7219_DAC_NG_RAMPDN_RATE_SHIFT,
 231                        DA7219_DAC_NG_RAMP_RATE_MAX,
 232                        da7219_dac_ng_rampdown_txt);
 233
 234
 235static const char * const da7219_cp_track_mode_txt[] = {
 236        "Largest Volume", "DAC Volume", "Signal Magnitude"
 237};
 238
 239static const unsigned int da7219_cp_track_mode_val[] = {
 240        DA7219_CP_MCHANGE_LARGEST_VOL, DA7219_CP_MCHANGE_DAC_VOL,
 241        DA7219_CP_MCHANGE_SIG_MAG
 242};
 243
 244static const struct soc_enum da7219_cp_track_mode =
 245        SOC_VALUE_ENUM_SINGLE(DA7219_CP_CTRL, DA7219_CP_MCHANGE_SHIFT,
 246                              DA7219_CP_MCHANGE_REL_MASK, DA7219_CP_MCHANGE_MAX,
 247                              da7219_cp_track_mode_txt,
 248                              da7219_cp_track_mode_val);
 249
 250
 251/*
 252 * Control Functions
 253 */
 254
 255/* Locked Kcontrol calls */
 256static int da7219_volsw_locked_get(struct snd_kcontrol *kcontrol,
 257                                   struct snd_ctl_elem_value *ucontrol)
 258{
 259        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 260        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 261        int ret;
 262
 263        mutex_lock(&da7219->ctrl_lock);
 264        ret = snd_soc_get_volsw(kcontrol, ucontrol);
 265        mutex_unlock(&da7219->ctrl_lock);
 266
 267        return ret;
 268}
 269
 270static int da7219_volsw_locked_put(struct snd_kcontrol *kcontrol,
 271                                   struct snd_ctl_elem_value *ucontrol)
 272{
 273        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 274        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 275        int ret;
 276
 277        mutex_lock(&da7219->ctrl_lock);
 278        ret = snd_soc_put_volsw(kcontrol, ucontrol);
 279        mutex_unlock(&da7219->ctrl_lock);
 280
 281        return ret;
 282}
 283
 284static int da7219_enum_locked_get(struct snd_kcontrol *kcontrol,
 285                                struct snd_ctl_elem_value *ucontrol)
 286{
 287        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 288        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 289        int ret;
 290
 291        mutex_lock(&da7219->ctrl_lock);
 292        ret = snd_soc_get_enum_double(kcontrol, ucontrol);
 293        mutex_unlock(&da7219->ctrl_lock);
 294
 295        return ret;
 296}
 297
 298static int da7219_enum_locked_put(struct snd_kcontrol *kcontrol,
 299                                struct snd_ctl_elem_value *ucontrol)
 300{
 301        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 302        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 303        int ret;
 304
 305        mutex_lock(&da7219->ctrl_lock);
 306        ret = snd_soc_put_enum_double(kcontrol, ucontrol);
 307        mutex_unlock(&da7219->ctrl_lock);
 308
 309        return ret;
 310}
 311
 312/* ALC */
 313static void da7219_alc_calib(struct snd_soc_codec *codec)
 314{
 315        u8 mic_ctrl, mixin_ctrl, adc_ctrl, calib_ctrl;
 316
 317        /* Save current state of mic control register */
 318        mic_ctrl = snd_soc_read(codec, DA7219_MIC_1_CTRL);
 319
 320        /* Save current state of input mixer control register */
 321        mixin_ctrl = snd_soc_read(codec, DA7219_MIXIN_L_CTRL);
 322
 323        /* Save current state of input ADC control register */
 324        adc_ctrl = snd_soc_read(codec, DA7219_ADC_L_CTRL);
 325
 326        /* Enable then Mute MIC PGAs */
 327        snd_soc_update_bits(codec, DA7219_MIC_1_CTRL, DA7219_MIC_1_AMP_EN_MASK,
 328                            DA7219_MIC_1_AMP_EN_MASK);
 329        snd_soc_update_bits(codec, DA7219_MIC_1_CTRL,
 330                            DA7219_MIC_1_AMP_MUTE_EN_MASK,
 331                            DA7219_MIC_1_AMP_MUTE_EN_MASK);
 332
 333        /* Enable input mixers unmuted */
 334        snd_soc_update_bits(codec, DA7219_MIXIN_L_CTRL,
 335                            DA7219_MIXIN_L_AMP_EN_MASK |
 336                            DA7219_MIXIN_L_AMP_MUTE_EN_MASK,
 337                            DA7219_MIXIN_L_AMP_EN_MASK);
 338
 339        /* Enable input filters unmuted */
 340        snd_soc_update_bits(codec, DA7219_ADC_L_CTRL,
 341                            DA7219_ADC_L_MUTE_EN_MASK | DA7219_ADC_L_EN_MASK,
 342                            DA7219_ADC_L_EN_MASK);
 343
 344        /* Perform auto calibration */
 345        snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
 346                            DA7219_ALC_AUTO_CALIB_EN_MASK,
 347                            DA7219_ALC_AUTO_CALIB_EN_MASK);
 348        do {
 349                calib_ctrl = snd_soc_read(codec, DA7219_ALC_CTRL1);
 350        } while (calib_ctrl & DA7219_ALC_AUTO_CALIB_EN_MASK);
 351
 352        /* If auto calibration fails, disable DC offset, hybrid ALC */
 353        if (calib_ctrl & DA7219_ALC_CALIB_OVERFLOW_MASK) {
 354                dev_warn(codec->dev,
 355                         "ALC auto calibration failed with overflow\n");
 356                snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
 357                                    DA7219_ALC_OFFSET_EN_MASK |
 358                                    DA7219_ALC_SYNC_MODE_MASK, 0);
 359        } else {
 360                /* Enable DC offset cancellation, hybrid mode */
 361                snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
 362                                    DA7219_ALC_OFFSET_EN_MASK |
 363                                    DA7219_ALC_SYNC_MODE_MASK,
 364                                    DA7219_ALC_OFFSET_EN_MASK |
 365                                    DA7219_ALC_SYNC_MODE_MASK);
 366        }
 367
 368        /* Restore input filter control register to original state */
 369        snd_soc_write(codec, DA7219_ADC_L_CTRL, adc_ctrl);
 370
 371        /* Restore input mixer control registers to original state */
 372        snd_soc_write(codec, DA7219_MIXIN_L_CTRL, mixin_ctrl);
 373
 374        /* Restore MIC control registers to original states */
 375        snd_soc_write(codec, DA7219_MIC_1_CTRL, mic_ctrl);
 376}
 377
 378static int da7219_mixin_gain_put(struct snd_kcontrol *kcontrol,
 379                                 struct snd_ctl_elem_value *ucontrol)
 380{
 381        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 382        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 383        int ret;
 384
 385        ret = snd_soc_put_volsw(kcontrol, ucontrol);
 386
 387        /*
 388         * If ALC in operation and value of control has been updated,
 389         * make sure calibrated offsets are updated.
 390         */
 391        if ((ret == 1) && (da7219->alc_en))
 392                da7219_alc_calib(codec);
 393
 394        return ret;
 395}
 396
 397static int da7219_alc_sw_put(struct snd_kcontrol *kcontrol,
 398                             struct snd_ctl_elem_value *ucontrol)
 399{
 400        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 401        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 402
 403
 404        /* Force ALC offset calibration if enabling ALC */
 405        if ((ucontrol->value.integer.value[0]) && (!da7219->alc_en)) {
 406                da7219_alc_calib(codec);
 407                da7219->alc_en = true;
 408        } else {
 409                da7219->alc_en = false;
 410        }
 411
 412        return snd_soc_put_volsw(kcontrol, ucontrol);
 413}
 414
 415/* ToneGen */
 416static int da7219_tonegen_freq_get(struct snd_kcontrol *kcontrol,
 417                                   struct snd_ctl_elem_value *ucontrol)
 418{
 419        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 420        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 421        struct soc_mixer_control *mixer_ctrl =
 422                (struct soc_mixer_control *) kcontrol->private_value;
 423        unsigned int reg = mixer_ctrl->reg;
 424        u16 val;
 425        int ret;
 426
 427        mutex_lock(&da7219->ctrl_lock);
 428        ret = regmap_raw_read(da7219->regmap, reg, &val, sizeof(val));
 429        mutex_unlock(&da7219->ctrl_lock);
 430
 431        if (ret)
 432                return ret;
 433
 434        /*
 435         * Frequency value spans two 8-bit registers, lower then upper byte.
 436         * Therefore we need to convert to host endianness here.
 437         */
 438        ucontrol->value.integer.value[0] = le16_to_cpu(val);
 439
 440        return 0;
 441}
 442
 443static int da7219_tonegen_freq_put(struct snd_kcontrol *kcontrol,
 444                                   struct snd_ctl_elem_value *ucontrol)
 445{
 446        struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
 447        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 448        struct soc_mixer_control *mixer_ctrl =
 449                (struct soc_mixer_control *) kcontrol->private_value;
 450        unsigned int reg = mixer_ctrl->reg;
 451        u16 val;
 452        int ret;
 453
 454        /*
 455         * Frequency value spans two 8-bit registers, lower then upper byte.
 456         * Therefore we need to convert to little endian here to align with
 457         * HW registers.
 458         */
 459        val = cpu_to_le16(ucontrol->value.integer.value[0]);
 460
 461        mutex_lock(&da7219->ctrl_lock);
 462        ret = regmap_raw_write(da7219->regmap, reg, &val, sizeof(val));
 463        mutex_unlock(&da7219->ctrl_lock);
 464
 465        return ret;
 466}
 467
 468
 469/*
 470 * KControls
 471 */
 472
 473static const struct snd_kcontrol_new da7219_snd_controls[] = {
 474        /* Mics */
 475        SOC_SINGLE_TLV("Mic Volume", DA7219_MIC_1_GAIN,
 476                       DA7219_MIC_1_AMP_GAIN_SHIFT, DA7219_MIC_1_AMP_GAIN_MAX,
 477                       DA7219_NO_INVERT, da7219_mic_gain_tlv),
 478        SOC_SINGLE("Mic Switch", DA7219_MIC_1_CTRL,
 479                   DA7219_MIC_1_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 480                   DA7219_INVERT),
 481
 482        /* Mixer Input */
 483        SOC_SINGLE_EXT_TLV("Mixin Volume", DA7219_MIXIN_L_GAIN,
 484                           DA7219_MIXIN_L_AMP_GAIN_SHIFT,
 485                           DA7219_MIXIN_L_AMP_GAIN_MAX, DA7219_NO_INVERT,
 486                           snd_soc_get_volsw, da7219_mixin_gain_put,
 487                           da7219_mixin_gain_tlv),
 488        SOC_SINGLE("Mixin Switch", DA7219_MIXIN_L_CTRL,
 489                   DA7219_MIXIN_L_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 490                   DA7219_INVERT),
 491        SOC_SINGLE("Mixin Gain Ramp Switch", DA7219_MIXIN_L_CTRL,
 492                   DA7219_MIXIN_L_AMP_RAMP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 493                   DA7219_NO_INVERT),
 494        SOC_SINGLE("Mixin ZC Gain Switch", DA7219_MIXIN_L_CTRL,
 495                   DA7219_MIXIN_L_AMP_ZC_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 496                   DA7219_NO_INVERT),
 497
 498        /* ADC */
 499        SOC_SINGLE_TLV("Capture Digital Volume", DA7219_ADC_L_GAIN,
 500                       DA7219_ADC_L_DIGITAL_GAIN_SHIFT,
 501                       DA7219_ADC_L_DIGITAL_GAIN_MAX, DA7219_NO_INVERT,
 502                       da7219_adc_dig_gain_tlv),
 503        SOC_SINGLE("Capture Digital Switch", DA7219_ADC_L_CTRL,
 504                   DA7219_ADC_L_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 505                   DA7219_INVERT),
 506        SOC_SINGLE("Capture Digital Gain Ramp Switch", DA7219_ADC_L_CTRL,
 507                   DA7219_ADC_L_RAMP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 508                   DA7219_NO_INVERT),
 509
 510        /* ALC */
 511        SOC_ENUM("ALC Attack Rate", da7219_alc_attack_rate),
 512        SOC_ENUM("ALC Release Rate", da7219_alc_release_rate),
 513        SOC_ENUM("ALC Hold Time", da7219_alc_hold_time),
 514        SOC_ENUM("ALC Envelope Attack Rate", da7219_alc_env_attack_rate),
 515        SOC_ENUM("ALC Envelope Release Rate", da7219_alc_env_release_rate),
 516        SOC_SINGLE_TLV("ALC Noise Threshold", DA7219_ALC_NOISE,
 517                       DA7219_ALC_NOISE_SHIFT, DA7219_ALC_THRESHOLD_MAX,
 518                       DA7219_INVERT, da7219_alc_threshold_tlv),
 519        SOC_SINGLE_TLV("ALC Min Threshold", DA7219_ALC_TARGET_MIN,
 520                       DA7219_ALC_THRESHOLD_MIN_SHIFT, DA7219_ALC_THRESHOLD_MAX,
 521                       DA7219_INVERT, da7219_alc_threshold_tlv),
 522        SOC_SINGLE_TLV("ALC Max Threshold", DA7219_ALC_TARGET_MAX,
 523                       DA7219_ALC_THRESHOLD_MAX_SHIFT, DA7219_ALC_THRESHOLD_MAX,
 524                       DA7219_INVERT, da7219_alc_threshold_tlv),
 525        SOC_SINGLE_TLV("ALC Max Attenuation", DA7219_ALC_GAIN_LIMITS,
 526                       DA7219_ALC_ATTEN_MAX_SHIFT, DA7219_ALC_ATTEN_GAIN_MAX,
 527                       DA7219_NO_INVERT, da7219_alc_gain_tlv),
 528        SOC_SINGLE_TLV("ALC Max Volume", DA7219_ALC_GAIN_LIMITS,
 529                       DA7219_ALC_GAIN_MAX_SHIFT, DA7219_ALC_ATTEN_GAIN_MAX,
 530                       DA7219_NO_INVERT, da7219_alc_gain_tlv),
 531        SOC_SINGLE_RANGE_TLV("ALC Min Analog Volume", DA7219_ALC_ANA_GAIN_LIMITS,
 532                             DA7219_ALC_ANA_GAIN_MIN_SHIFT,
 533                             DA7219_ALC_ANA_GAIN_MIN, DA7219_ALC_ANA_GAIN_MAX,
 534                             DA7219_NO_INVERT, da7219_alc_ana_gain_tlv),
 535        SOC_SINGLE_RANGE_TLV("ALC Max Analog Volume", DA7219_ALC_ANA_GAIN_LIMITS,
 536                             DA7219_ALC_ANA_GAIN_MAX_SHIFT,
 537                             DA7219_ALC_ANA_GAIN_MIN, DA7219_ALC_ANA_GAIN_MAX,
 538                             DA7219_NO_INVERT, da7219_alc_ana_gain_tlv),
 539        SOC_ENUM("ALC Anticlip Step", da7219_alc_anticlip_step),
 540        SOC_SINGLE("ALC Anticlip Switch", DA7219_ALC_ANTICLIP_CTRL,
 541                   DA7219_ALC_ANTIPCLIP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 542                   DA7219_NO_INVERT),
 543        SOC_SINGLE_EXT("ALC Switch", DA7219_ALC_CTRL1, DA7219_ALC_EN_SHIFT,
 544                       DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT,
 545                       snd_soc_get_volsw, da7219_alc_sw_put),
 546
 547        /* Input High-Pass Filters */
 548        SOC_ENUM("ADC HPF Mode", da7219_adc_hpf_mode),
 549        SOC_ENUM("ADC HPF Corner Audio", da7219_adc_audio_hpf_corner),
 550        SOC_ENUM("ADC HPF Corner Voice", da7219_adc_voice_hpf_corner),
 551
 552        /* Sidetone Filter */
 553        SOC_SINGLE_TLV("Sidetone Volume", DA7219_SIDETONE_GAIN,
 554                       DA7219_SIDETONE_GAIN_SHIFT, DA7219_SIDETONE_GAIN_MAX,
 555                       DA7219_NO_INVERT, da7219_sidetone_gain_tlv),
 556        SOC_SINGLE("Sidetone Switch", DA7219_SIDETONE_CTRL,
 557                   DA7219_SIDETONE_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 558                   DA7219_INVERT),
 559
 560        /* Tone Generator */
 561        SOC_SINGLE_EXT_TLV("ToneGen Volume", DA7219_TONE_GEN_CFG2,
 562                           DA7219_TONE_GEN_GAIN_SHIFT, DA7219_TONE_GEN_GAIN_MAX,
 563                           DA7219_NO_INVERT, da7219_volsw_locked_get,
 564                           da7219_volsw_locked_put, da7219_tonegen_gain_tlv),
 565        SOC_ENUM_EXT("ToneGen DTMF Key", da7219_tonegen_dtmf_key,
 566                     da7219_enum_locked_get, da7219_enum_locked_put),
 567        SOC_SINGLE_EXT("ToneGen DTMF Switch", DA7219_TONE_GEN_CFG1,
 568                       DA7219_DTMF_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 569                       DA7219_NO_INVERT, da7219_volsw_locked_get,
 570                       da7219_volsw_locked_put),
 571        SOC_ENUM_EXT("ToneGen Sinewave Gen Type", da7219_tonegen_swg_sel,
 572                     da7219_enum_locked_get, da7219_enum_locked_put),
 573        SOC_SINGLE_EXT("ToneGen Sinewave1 Freq", DA7219_TONE_GEN_FREQ1_L,
 574                       DA7219_FREQ1_L_SHIFT, DA7219_FREQ_MAX, DA7219_NO_INVERT,
 575                       da7219_tonegen_freq_get, da7219_tonegen_freq_put),
 576        SOC_SINGLE_EXT("ToneGen Sinewave2 Freq", DA7219_TONE_GEN_FREQ2_L,
 577                       DA7219_FREQ2_L_SHIFT, DA7219_FREQ_MAX, DA7219_NO_INVERT,
 578                       da7219_tonegen_freq_get, da7219_tonegen_freq_put),
 579        SOC_SINGLE_EXT("ToneGen On Time", DA7219_TONE_GEN_ON_PER,
 580                       DA7219_BEEP_ON_PER_SHIFT, DA7219_BEEP_ON_OFF_MAX,
 581                       DA7219_NO_INVERT, da7219_volsw_locked_get,
 582                       da7219_volsw_locked_put),
 583        SOC_SINGLE("ToneGen Off Time", DA7219_TONE_GEN_OFF_PER,
 584                   DA7219_BEEP_OFF_PER_SHIFT, DA7219_BEEP_ON_OFF_MAX,
 585                   DA7219_NO_INVERT),
 586
 587        /* Gain ramping */
 588        SOC_ENUM("Gain Ramp Rate", da7219_gain_ramp_rate),
 589
 590        /* DAC High-Pass Filter */
 591        SOC_ENUM_EXT("DAC HPF Mode", da7219_dac_hpf_mode,
 592                     da7219_enum_locked_get, da7219_enum_locked_put),
 593        SOC_ENUM("DAC HPF Corner Audio", da7219_dac_audio_hpf_corner),
 594        SOC_ENUM("DAC HPF Corner Voice", da7219_dac_voice_hpf_corner),
 595
 596        /* DAC 5-Band Equaliser */
 597        SOC_SINGLE_TLV("DAC EQ Band1 Volume", DA7219_DAC_FILTERS2,
 598                       DA7219_DAC_EQ_BAND1_SHIFT, DA7219_DAC_EQ_BAND_MAX,
 599                       DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
 600        SOC_SINGLE_TLV("DAC EQ Band2 Volume", DA7219_DAC_FILTERS2,
 601                       DA7219_DAC_EQ_BAND2_SHIFT, DA7219_DAC_EQ_BAND_MAX,
 602                       DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
 603        SOC_SINGLE_TLV("DAC EQ Band3 Volume", DA7219_DAC_FILTERS3,
 604                       DA7219_DAC_EQ_BAND3_SHIFT, DA7219_DAC_EQ_BAND_MAX,
 605                       DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
 606        SOC_SINGLE_TLV("DAC EQ Band4 Volume", DA7219_DAC_FILTERS3,
 607                       DA7219_DAC_EQ_BAND4_SHIFT, DA7219_DAC_EQ_BAND_MAX,
 608                       DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
 609        SOC_SINGLE_TLV("DAC EQ Band5 Volume", DA7219_DAC_FILTERS4,
 610                       DA7219_DAC_EQ_BAND5_SHIFT, DA7219_DAC_EQ_BAND_MAX,
 611                       DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
 612        SOC_SINGLE_EXT("DAC EQ Switch", DA7219_DAC_FILTERS4,
 613                       DA7219_DAC_EQ_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 614                       DA7219_NO_INVERT, da7219_volsw_locked_get,
 615                       da7219_volsw_locked_put),
 616
 617        /* DAC Softmute */
 618        SOC_ENUM("DAC Soft Mute Rate", da7219_dac_softmute_rate),
 619        SOC_SINGLE_EXT("DAC Soft Mute Switch", DA7219_DAC_FILTERS5,
 620                       DA7219_DAC_SOFTMUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 621                       DA7219_NO_INVERT, da7219_volsw_locked_get,
 622                       da7219_volsw_locked_put),
 623
 624        /* DAC Noise Gate */
 625        SOC_ENUM("DAC NG Setup Time", da7219_dac_ng_setup_time),
 626        SOC_ENUM("DAC NG Rampup Rate", da7219_dac_ng_rampup_rate),
 627        SOC_ENUM("DAC NG Rampdown Rate", da7219_dac_ng_rampdown_rate),
 628        SOC_SINGLE_TLV("DAC NG Off Threshold", DA7219_DAC_NG_OFF_THRESH,
 629                       DA7219_DAC_NG_OFF_THRESHOLD_SHIFT,
 630                       DA7219_DAC_NG_THRESHOLD_MAX, DA7219_NO_INVERT,
 631                       da7219_dac_ng_threshold_tlv),
 632        SOC_SINGLE_TLV("DAC NG On Threshold", DA7219_DAC_NG_ON_THRESH,
 633                       DA7219_DAC_NG_ON_THRESHOLD_SHIFT,
 634                       DA7219_DAC_NG_THRESHOLD_MAX, DA7219_NO_INVERT,
 635                       da7219_dac_ng_threshold_tlv),
 636        SOC_SINGLE("DAC NG Switch", DA7219_DAC_NG_CTRL, DA7219_DAC_NG_EN_SHIFT,
 637                   DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 638
 639        /* DACs */
 640        SOC_DOUBLE_R_EXT_TLV("Playback Digital Volume", DA7219_DAC_L_GAIN,
 641                             DA7219_DAC_R_GAIN, DA7219_DAC_L_DIGITAL_GAIN_SHIFT,
 642                             DA7219_DAC_DIGITAL_GAIN_MAX, DA7219_NO_INVERT,
 643                             da7219_volsw_locked_get, da7219_volsw_locked_put,
 644                             da7219_dac_dig_gain_tlv),
 645        SOC_DOUBLE_R_EXT("Playback Digital Switch", DA7219_DAC_L_CTRL,
 646                         DA7219_DAC_R_CTRL, DA7219_DAC_L_MUTE_EN_SHIFT,
 647                         DA7219_SWITCH_EN_MAX, DA7219_INVERT,
 648                         da7219_volsw_locked_get, da7219_volsw_locked_put),
 649        SOC_DOUBLE_R("Playback Digital Gain Ramp Switch", DA7219_DAC_L_CTRL,
 650                     DA7219_DAC_R_CTRL, DA7219_DAC_L_RAMP_EN_SHIFT,
 651                     DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 652
 653        /* CP */
 654        SOC_ENUM("Charge Pump Track Mode", da7219_cp_track_mode),
 655        SOC_SINGLE("Charge Pump Threshold", DA7219_CP_VOL_THRESHOLD1,
 656                   DA7219_CP_THRESH_VDD2_SHIFT, DA7219_CP_THRESH_VDD2_MAX,
 657                   DA7219_NO_INVERT),
 658
 659        /* Headphones */
 660        SOC_DOUBLE_R_EXT_TLV("Headphone Volume", DA7219_HP_L_GAIN,
 661                             DA7219_HP_R_GAIN, DA7219_HP_L_AMP_GAIN_SHIFT,
 662                             DA7219_HP_AMP_GAIN_MAX, DA7219_NO_INVERT,
 663                             da7219_volsw_locked_get, da7219_volsw_locked_put,
 664                             da7219_hp_gain_tlv),
 665        SOC_DOUBLE_R_EXT("Headphone Switch", DA7219_HP_L_CTRL, DA7219_HP_R_CTRL,
 666                         DA7219_HP_L_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
 667                         DA7219_INVERT, da7219_volsw_locked_get,
 668                         da7219_volsw_locked_put),
 669        SOC_DOUBLE_R("Headphone Gain Ramp Switch", DA7219_HP_L_CTRL,
 670                     DA7219_HP_R_CTRL, DA7219_HP_L_AMP_RAMP_EN_SHIFT,
 671                     DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 672        SOC_DOUBLE_R("Headphone ZC Gain Switch", DA7219_HP_L_CTRL,
 673                     DA7219_HP_R_CTRL, DA7219_HP_L_AMP_ZC_EN_SHIFT,
 674                     DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 675};
 676
 677
 678/*
 679 * DAPM Mux Controls
 680 */
 681
 682static const char * const da7219_out_sel_txt[] = {
 683        "ADC", "Tone Generator", "DAIL", "DAIR"
 684};
 685
 686static const struct soc_enum da7219_out_dail_sel =
 687        SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAI,
 688                        DA7219_DAI_L_SRC_SHIFT,
 689                        DA7219_OUT_SRC_MAX,
 690                        da7219_out_sel_txt);
 691
 692static const struct snd_kcontrol_new da7219_out_dail_sel_mux =
 693        SOC_DAPM_ENUM("Out DAIL Mux", da7219_out_dail_sel);
 694
 695static const struct soc_enum da7219_out_dair_sel =
 696        SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAI,
 697                        DA7219_DAI_R_SRC_SHIFT,
 698                        DA7219_OUT_SRC_MAX,
 699                        da7219_out_sel_txt);
 700
 701static const struct snd_kcontrol_new da7219_out_dair_sel_mux =
 702        SOC_DAPM_ENUM("Out DAIR Mux", da7219_out_dair_sel);
 703
 704static const struct soc_enum da7219_out_dacl_sel =
 705        SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAC,
 706                        DA7219_DAC_L_SRC_SHIFT,
 707                        DA7219_OUT_SRC_MAX,
 708                        da7219_out_sel_txt);
 709
 710static const struct snd_kcontrol_new da7219_out_dacl_sel_mux =
 711        SOC_DAPM_ENUM("Out DACL Mux", da7219_out_dacl_sel);
 712
 713static const struct soc_enum da7219_out_dacr_sel =
 714        SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAC,
 715                        DA7219_DAC_R_SRC_SHIFT,
 716                        DA7219_OUT_SRC_MAX,
 717                        da7219_out_sel_txt);
 718
 719static const struct snd_kcontrol_new da7219_out_dacr_sel_mux =
 720        SOC_DAPM_ENUM("Out DACR Mux", da7219_out_dacr_sel);
 721
 722
 723/*
 724 * DAPM Mixer Controls
 725 */
 726
 727static const struct snd_kcontrol_new da7219_mixin_controls[] = {
 728        SOC_DAPM_SINGLE("Mic Switch", DA7219_MIXIN_L_SELECT,
 729                        DA7219_MIXIN_L_MIX_SELECT_SHIFT,
 730                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 731};
 732
 733static const struct snd_kcontrol_new da7219_mixout_l_controls[] = {
 734        SOC_DAPM_SINGLE("DACL Switch", DA7219_MIXOUT_L_SELECT,
 735                        DA7219_MIXOUT_L_MIX_SELECT_SHIFT,
 736                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 737};
 738
 739static const struct snd_kcontrol_new da7219_mixout_r_controls[] = {
 740        SOC_DAPM_SINGLE("DACR Switch", DA7219_MIXOUT_R_SELECT,
 741                        DA7219_MIXOUT_R_MIX_SELECT_SHIFT,
 742                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
 743};
 744
 745#define DA7219_DMIX_ST_CTRLS(reg)                                       \
 746        SOC_DAPM_SINGLE("Out FilterL Switch", reg,                      \
 747                        DA7219_DMIX_ST_SRC_OUTFILT1L_SHIFT,             \
 748                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),        \
 749        SOC_DAPM_SINGLE("Out FilterR Switch", reg,                      \
 750                        DA7219_DMIX_ST_SRC_OUTFILT1R_SHIFT,             \
 751                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),        \
 752        SOC_DAPM_SINGLE("Sidetone Switch", reg,                         \
 753                        DA7219_DMIX_ST_SRC_SIDETONE_SHIFT,              \
 754                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT)         \
 755
 756static const struct snd_kcontrol_new da7219_st_out_filtl_mix_controls[] = {
 757        DA7219_DMIX_ST_CTRLS(DA7219_DROUTING_ST_OUTFILT_1L),
 758};
 759
 760static const struct snd_kcontrol_new da7219_st_out_filtr_mix_controls[] = {
 761        DA7219_DMIX_ST_CTRLS(DA7219_DROUTING_ST_OUTFILT_1R),
 762};
 763
 764
 765/*
 766 * DAPM Events
 767 */
 768
 769static int da7219_dai_event(struct snd_soc_dapm_widget *w,
 770                            struct snd_kcontrol *kcontrol, int event)
 771{
 772        struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
 773        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 774        u8 pll_ctrl, pll_status;
 775        int i = 0;
 776        bool srm_lock = false;
 777
 778        switch (event) {
 779        case SND_SOC_DAPM_PRE_PMU:
 780                if (da7219->master)
 781                        /* Enable DAI clks for master mode */
 782                        snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
 783                                            DA7219_DAI_CLK_EN_MASK,
 784                                            DA7219_DAI_CLK_EN_MASK);
 785
 786                /* PC synchronised to DAI */
 787                snd_soc_update_bits(codec, DA7219_PC_COUNT,
 788                                    DA7219_PC_FREERUN_MASK, 0);
 789
 790                /* Slave mode, if SRM not enabled no need for status checks */
 791                pll_ctrl = snd_soc_read(codec, DA7219_PLL_CTRL);
 792                if ((pll_ctrl & DA7219_PLL_MODE_MASK) != DA7219_PLL_MODE_SRM)
 793                        return 0;
 794
 795                /* Check SRM has locked */
 796                do {
 797                        pll_status = snd_soc_read(codec, DA7219_PLL_SRM_STS);
 798                        if (pll_status & DA7219_PLL_SRM_STS_SRM_LOCK) {
 799                                srm_lock = true;
 800                        } else {
 801                                ++i;
 802                                msleep(50);
 803                        }
 804                } while ((i < DA7219_SRM_CHECK_RETRIES) & (!srm_lock));
 805
 806                if (!srm_lock)
 807                        dev_warn(codec->dev, "SRM failed to lock\n");
 808
 809                return 0;
 810        case SND_SOC_DAPM_POST_PMD:
 811                /* PC free-running */
 812                snd_soc_update_bits(codec, DA7219_PC_COUNT,
 813                                    DA7219_PC_FREERUN_MASK,
 814                                    DA7219_PC_FREERUN_MASK);
 815
 816                /* Disable DAI clks if in master mode */
 817                if (da7219->master)
 818                        snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
 819                                            DA7219_DAI_CLK_EN_MASK, 0);
 820                return 0;
 821        default:
 822                return -EINVAL;
 823        }
 824}
 825
 826static int da7219_settling_event(struct snd_soc_dapm_widget *w,
 827                                 struct snd_kcontrol *kcontrol, int event)
 828{
 829        switch (event) {
 830        case SND_SOC_DAPM_POST_PMU:
 831        case SND_SOC_DAPM_POST_PMD:
 832                msleep(DA7219_SETTLING_DELAY);
 833                break;
 834        default:
 835                break;
 836        }
 837
 838        return 0;
 839}
 840
 841static int da7219_mixout_event(struct snd_soc_dapm_widget *w,
 842                               struct snd_kcontrol *kcontrol, int event)
 843{
 844        struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
 845        u8 hp_ctrl, min_gain_mask;
 846
 847        switch (w->reg) {
 848        case DA7219_MIXOUT_L_CTRL:
 849                hp_ctrl = DA7219_HP_L_CTRL;
 850                min_gain_mask = DA7219_HP_L_AMP_MIN_GAIN_EN_MASK;
 851                break;
 852        case DA7219_MIXOUT_R_CTRL:
 853                hp_ctrl = DA7219_HP_R_CTRL;
 854                min_gain_mask = DA7219_HP_R_AMP_MIN_GAIN_EN_MASK;
 855                break;
 856        default:
 857                return -EINVAL;
 858        }
 859
 860        switch (event) {
 861        case SND_SOC_DAPM_PRE_PMD:
 862                /* Enable minimum gain on HP to avoid pops */
 863                snd_soc_update_bits(codec, hp_ctrl, min_gain_mask,
 864                                    min_gain_mask);
 865
 866                msleep(DA7219_MIN_GAIN_DELAY);
 867
 868                break;
 869        case SND_SOC_DAPM_POST_PMU:
 870                /* Remove minimum gain on HP */
 871                snd_soc_update_bits(codec, hp_ctrl, min_gain_mask, 0);
 872
 873                break;
 874        }
 875
 876        return 0;
 877}
 878
 879static int da7219_gain_ramp_event(struct snd_soc_dapm_widget *w,
 880                                  struct snd_kcontrol *kcontrol, int event)
 881{
 882        struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
 883        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
 884
 885        switch (event) {
 886        case SND_SOC_DAPM_PRE_PMU:
 887        case SND_SOC_DAPM_PRE_PMD:
 888                /* Ensure nominal gain ramping for DAPM sequence */
 889                da7219->gain_ramp_ctrl =
 890                        snd_soc_read(codec, DA7219_GAIN_RAMP_CTRL);
 891                snd_soc_write(codec, DA7219_GAIN_RAMP_CTRL,
 892                              DA7219_GAIN_RAMP_RATE_NOMINAL);
 893                break;
 894        case SND_SOC_DAPM_POST_PMU:
 895        case SND_SOC_DAPM_POST_PMD:
 896                /* Restore previous gain ramp settings */
 897                snd_soc_write(codec, DA7219_GAIN_RAMP_CTRL,
 898                              da7219->gain_ramp_ctrl);
 899                break;
 900        }
 901
 902        return 0;
 903}
 904
 905
 906/*
 907 * DAPM Widgets
 908 */
 909
 910static const struct snd_soc_dapm_widget da7219_dapm_widgets[] = {
 911        /* Input Supplies */
 912        SND_SOC_DAPM_SUPPLY("Mic Bias", DA7219_MICBIAS_CTRL,
 913                            DA7219_MICBIAS1_EN_SHIFT, DA7219_NO_INVERT,
 914                            NULL, 0),
 915
 916        /* Inputs */
 917        SND_SOC_DAPM_INPUT("MIC"),
 918
 919        /* Input PGAs */
 920        SND_SOC_DAPM_PGA("Mic PGA", DA7219_MIC_1_CTRL,
 921                         DA7219_MIC_1_AMP_EN_SHIFT, DA7219_NO_INVERT,
 922                         NULL, 0),
 923        SND_SOC_DAPM_PGA("Mixin PGA", DA7219_MIXIN_L_CTRL,
 924                         DA7219_MIXIN_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
 925                         NULL, 0),
 926
 927        /* Input Filters */
 928        SND_SOC_DAPM_ADC("ADC", NULL, DA7219_ADC_L_CTRL, DA7219_ADC_L_EN_SHIFT,
 929                         DA7219_NO_INVERT),
 930
 931        /* Tone Generator */
 932        SND_SOC_DAPM_SIGGEN("TONE"),
 933        SND_SOC_DAPM_PGA("Tone Generator", DA7219_TONE_GEN_CFG1,
 934                         DA7219_START_STOPN_SHIFT, DA7219_NO_INVERT, NULL, 0),
 935
 936        /* Sidetone Input */
 937        SND_SOC_DAPM_ADC("Sidetone Filter", NULL, DA7219_SIDETONE_CTRL,
 938                         DA7219_SIDETONE_EN_SHIFT, DA7219_NO_INVERT),
 939
 940        /* Input Mixer Supply */
 941        SND_SOC_DAPM_SUPPLY("Mixer In Supply", DA7219_MIXIN_L_CTRL,
 942                            DA7219_MIXIN_L_MIX_EN_SHIFT, DA7219_NO_INVERT,
 943                            NULL, 0),
 944
 945        /* Input Mixer */
 946        SND_SOC_DAPM_MIXER("Mixer In", SND_SOC_NOPM, 0, 0,
 947                           da7219_mixin_controls,
 948                           ARRAY_SIZE(da7219_mixin_controls)),
 949
 950        /* Input Muxes */
 951        SND_SOC_DAPM_MUX("Out DAIL Mux", SND_SOC_NOPM, 0, 0,
 952                         &da7219_out_dail_sel_mux),
 953        SND_SOC_DAPM_MUX("Out DAIR Mux", SND_SOC_NOPM, 0, 0,
 954                         &da7219_out_dair_sel_mux),
 955
 956        /* DAI Supply */
 957        SND_SOC_DAPM_SUPPLY("DAI", DA7219_DAI_CTRL, DA7219_DAI_EN_SHIFT,
 958                            DA7219_NO_INVERT, da7219_dai_event,
 959                            SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
 960
 961        /* DAI */
 962        SND_SOC_DAPM_AIF_OUT("DAIOUT", "Capture", 0, DA7219_DAI_TDM_CTRL,
 963                             DA7219_DAI_OE_SHIFT, DA7219_NO_INVERT),
 964        SND_SOC_DAPM_AIF_IN("DAIIN", "Playback", 0, SND_SOC_NOPM, 0, 0),
 965
 966        /* Output Muxes */
 967        SND_SOC_DAPM_MUX("Out DACL Mux", SND_SOC_NOPM, 0, 0,
 968                         &da7219_out_dacl_sel_mux),
 969        SND_SOC_DAPM_MUX("Out DACR Mux", SND_SOC_NOPM, 0, 0,
 970                         &da7219_out_dacr_sel_mux),
 971
 972        /* Output Mixers */
 973        SND_SOC_DAPM_MIXER("Mixer Out FilterL", SND_SOC_NOPM, 0, 0,
 974                           da7219_mixout_l_controls,
 975                           ARRAY_SIZE(da7219_mixout_l_controls)),
 976        SND_SOC_DAPM_MIXER("Mixer Out FilterR", SND_SOC_NOPM, 0, 0,
 977                           da7219_mixout_r_controls,
 978                           ARRAY_SIZE(da7219_mixout_r_controls)),
 979
 980        /* Sidetone Mixers */
 981        SND_SOC_DAPM_MIXER("ST Mixer Out FilterL", SND_SOC_NOPM, 0, 0,
 982                           da7219_st_out_filtl_mix_controls,
 983                           ARRAY_SIZE(da7219_st_out_filtl_mix_controls)),
 984        SND_SOC_DAPM_MIXER("ST Mixer Out FilterR", SND_SOC_NOPM, 0,
 985                           0, da7219_st_out_filtr_mix_controls,
 986                           ARRAY_SIZE(da7219_st_out_filtr_mix_controls)),
 987
 988        /* DACs */
 989        SND_SOC_DAPM_DAC_E("DACL", NULL, DA7219_DAC_L_CTRL,
 990                           DA7219_DAC_L_EN_SHIFT, DA7219_NO_INVERT,
 991                           da7219_settling_event,
 992                           SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 993        SND_SOC_DAPM_DAC_E("DACR", NULL, DA7219_DAC_R_CTRL,
 994                           DA7219_DAC_R_EN_SHIFT, DA7219_NO_INVERT,
 995                           da7219_settling_event,
 996                           SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
 997
 998        /* Output PGAs */
 999        SND_SOC_DAPM_PGA_E("Mixout Left PGA", DA7219_MIXOUT_L_CTRL,
1000                           DA7219_MIXOUT_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
1001                           NULL, 0, da7219_mixout_event,
1002                           SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1003        SND_SOC_DAPM_PGA_E("Mixout Right PGA", DA7219_MIXOUT_R_CTRL,
1004                           DA7219_MIXOUT_R_AMP_EN_SHIFT, DA7219_NO_INVERT,
1005                           NULL, 0, da7219_mixout_event,
1006                           SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1007        SND_SOC_DAPM_SUPPLY_S("Headphone Left PGA", 1, DA7219_HP_L_CTRL,
1008                              DA7219_HP_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
1009                              da7219_settling_event,
1010                              SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1011        SND_SOC_DAPM_SUPPLY_S("Headphone Right PGA", 1, DA7219_HP_R_CTRL,
1012                              DA7219_HP_R_AMP_EN_SHIFT, DA7219_NO_INVERT,
1013                              da7219_settling_event,
1014                              SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1015
1016        /* Output Supplies */
1017        SND_SOC_DAPM_SUPPLY_S("Charge Pump", 0, DA7219_CP_CTRL,
1018                              DA7219_CP_EN_SHIFT, DA7219_NO_INVERT,
1019                              da7219_settling_event,
1020                              SND_SOC_DAPM_POST_PMU),
1021
1022        /* Outputs */
1023        SND_SOC_DAPM_OUTPUT("HPL"),
1024        SND_SOC_DAPM_OUTPUT("HPR"),
1025
1026        /* Pre/Post Power */
1027        SND_SOC_DAPM_PRE("Pre Power Gain Ramp", da7219_gain_ramp_event),
1028        SND_SOC_DAPM_POST("Post Power Gain Ramp", da7219_gain_ramp_event),
1029};
1030
1031
1032/*
1033 * DAPM Mux Routes
1034 */
1035
1036#define DA7219_OUT_DAI_MUX_ROUTES(name)                 \
1037        {name, "ADC", "Mixer In"},                      \
1038        {name, "Tone Generator", "Tone Generator"},     \
1039        {name, "DAIL", "DAIOUT"},                       \
1040        {name, "DAIR", "DAIOUT"}
1041
1042#define DA7219_OUT_DAC_MUX_ROUTES(name)                 \
1043        {name, "ADC", "Mixer In"},                      \
1044        {name, "Tone Generator", "Tone Generator"},             \
1045        {name, "DAIL", "DAIIN"},                        \
1046        {name, "DAIR", "DAIIN"}
1047
1048/*
1049 * DAPM Mixer Routes
1050 */
1051
1052#define DA7219_DMIX_ST_ROUTES(name)                             \
1053        {name, "Out FilterL Switch", "Mixer Out FilterL"},      \
1054        {name, "Out FilterR Switch", "Mixer Out FilterR"},      \
1055        {name, "Sidetone Switch", "Sidetone Filter"}
1056
1057
1058/*
1059 * DAPM audio route definition
1060 */
1061
1062static const struct snd_soc_dapm_route da7219_audio_map[] = {
1063        /* Input paths */
1064        {"MIC", NULL, "Mic Bias"},
1065        {"Mic PGA", NULL, "MIC"},
1066        {"Mixin PGA", NULL, "Mic PGA"},
1067        {"ADC", NULL, "Mixin PGA"},
1068
1069        {"Mixer In", NULL, "Mixer In Supply"},
1070        {"Mixer In", "Mic Switch", "ADC"},
1071
1072        {"Sidetone Filter", NULL, "Mixer In"},
1073
1074        {"Tone Generator", NULL, "TONE"},
1075
1076        DA7219_OUT_DAI_MUX_ROUTES("Out DAIL Mux"),
1077        DA7219_OUT_DAI_MUX_ROUTES("Out DAIR Mux"),
1078
1079        {"DAIOUT", NULL, "Out DAIL Mux"},
1080        {"DAIOUT", NULL, "Out DAIR Mux"},
1081        {"DAIOUT", NULL, "DAI"},
1082
1083        /* Output paths */
1084        {"DAIIN", NULL, "DAI"},
1085
1086        DA7219_OUT_DAC_MUX_ROUTES("Out DACL Mux"),
1087        DA7219_OUT_DAC_MUX_ROUTES("Out DACR Mux"),
1088
1089        {"Mixer Out FilterL", "DACL Switch", "Out DACL Mux"},
1090        {"Mixer Out FilterR", "DACR Switch", "Out DACR Mux"},
1091
1092        DA7219_DMIX_ST_ROUTES("ST Mixer Out FilterL"),
1093        DA7219_DMIX_ST_ROUTES("ST Mixer Out FilterR"),
1094
1095        {"DACL", NULL, "ST Mixer Out FilterL"},
1096        {"DACR", NULL, "ST Mixer Out FilterR"},
1097
1098        {"Mixout Left PGA", NULL, "DACL"},
1099        {"Mixout Right PGA", NULL, "DACR"},
1100
1101        {"HPL", NULL, "Mixout Left PGA"},
1102        {"HPR", NULL, "Mixout Right PGA"},
1103
1104        {"HPL", NULL, "Headphone Left PGA"},
1105        {"HPR", NULL, "Headphone Right PGA"},
1106
1107        {"HPL", NULL, "Charge Pump"},
1108        {"HPR", NULL, "Charge Pump"},
1109};
1110
1111
1112/*
1113 * DAI operations
1114 */
1115
1116static int da7219_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1117                                 int clk_id, unsigned int freq, int dir)
1118{
1119        struct snd_soc_codec *codec = codec_dai->codec;
1120        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1121        int ret = 0;
1122
1123        if ((da7219->clk_src == clk_id) && (da7219->mclk_rate == freq))
1124                return 0;
1125
1126        if ((freq < 2000000) || (freq > 54000000)) {
1127                dev_err(codec_dai->dev, "Unsupported MCLK value %d\n",
1128                        freq);
1129                return -EINVAL;
1130        }
1131
1132        mutex_lock(&da7219->pll_lock);
1133
1134        switch (clk_id) {
1135        case DA7219_CLKSRC_MCLK_SQR:
1136                snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1137                                    DA7219_PLL_MCLK_SQR_EN_MASK,
1138                                    DA7219_PLL_MCLK_SQR_EN_MASK);
1139                break;
1140        case DA7219_CLKSRC_MCLK:
1141                snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1142                                    DA7219_PLL_MCLK_SQR_EN_MASK, 0);
1143                break;
1144        default:
1145                dev_err(codec_dai->dev, "Unknown clock source %d\n", clk_id);
1146                mutex_unlock(&da7219->pll_lock);
1147                return -EINVAL;
1148        }
1149
1150        da7219->clk_src = clk_id;
1151
1152        if (da7219->mclk) {
1153                freq = clk_round_rate(da7219->mclk, freq);
1154                ret = clk_set_rate(da7219->mclk, freq);
1155                if (ret) {
1156                        dev_err(codec_dai->dev, "Failed to set clock rate %d\n",
1157                                freq);
1158                        mutex_unlock(&da7219->pll_lock);
1159                        return ret;
1160                }
1161        }
1162
1163        da7219->mclk_rate = freq;
1164
1165        mutex_unlock(&da7219->pll_lock);
1166
1167        return 0;
1168}
1169
1170int da7219_set_pll(struct snd_soc_codec *codec, int source, unsigned int fout)
1171{
1172        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1173
1174        u8 pll_ctrl, indiv_bits, indiv;
1175        u8 pll_frac_top, pll_frac_bot, pll_integer;
1176        u32 freq_ref;
1177        u64 frac_div;
1178
1179        /* Verify 2MHz - 54MHz MCLK provided, and set input divider */
1180        if (da7219->mclk_rate < 2000000) {
1181                dev_err(codec->dev, "PLL input clock %d below valid range\n",
1182                        da7219->mclk_rate);
1183                return -EINVAL;
1184        } else if (da7219->mclk_rate <= 4500000) {
1185                indiv_bits = DA7219_PLL_INDIV_2_TO_4_5_MHZ;
1186                indiv = DA7219_PLL_INDIV_2_TO_4_5_MHZ_VAL;
1187        } else if (da7219->mclk_rate <= 9000000) {
1188                indiv_bits = DA7219_PLL_INDIV_4_5_TO_9_MHZ;
1189                indiv = DA7219_PLL_INDIV_4_5_TO_9_MHZ_VAL;
1190        } else if (da7219->mclk_rate <= 18000000) {
1191                indiv_bits = DA7219_PLL_INDIV_9_TO_18_MHZ;
1192                indiv = DA7219_PLL_INDIV_9_TO_18_MHZ_VAL;
1193        } else if (da7219->mclk_rate <= 36000000) {
1194                indiv_bits = DA7219_PLL_INDIV_18_TO_36_MHZ;
1195                indiv = DA7219_PLL_INDIV_18_TO_36_MHZ_VAL;
1196        } else if (da7219->mclk_rate <= 54000000) {
1197                indiv_bits = DA7219_PLL_INDIV_36_TO_54_MHZ;
1198                indiv = DA7219_PLL_INDIV_36_TO_54_MHZ_VAL;
1199        } else {
1200                dev_err(codec->dev, "PLL input clock %d above valid range\n",
1201                        da7219->mclk_rate);
1202                return -EINVAL;
1203        }
1204        freq_ref = (da7219->mclk_rate / indiv);
1205        pll_ctrl = indiv_bits;
1206
1207        /* Configure PLL */
1208        switch (source) {
1209        case DA7219_SYSCLK_MCLK:
1210                pll_ctrl |= DA7219_PLL_MODE_BYPASS;
1211                snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1212                                    DA7219_PLL_INDIV_MASK |
1213                                    DA7219_PLL_MODE_MASK, pll_ctrl);
1214                return 0;
1215        case DA7219_SYSCLK_PLL:
1216                pll_ctrl |= DA7219_PLL_MODE_NORMAL;
1217                break;
1218        case DA7219_SYSCLK_PLL_SRM:
1219                pll_ctrl |= DA7219_PLL_MODE_SRM;
1220                break;
1221        default:
1222                dev_err(codec->dev, "Invalid PLL config\n");
1223                return -EINVAL;
1224        }
1225
1226        /* Calculate dividers for PLL */
1227        pll_integer = fout / freq_ref;
1228        frac_div = (u64)(fout % freq_ref) * 8192ULL;
1229        do_div(frac_div, freq_ref);
1230        pll_frac_top = (frac_div >> DA7219_BYTE_SHIFT) & DA7219_BYTE_MASK;
1231        pll_frac_bot = (frac_div) & DA7219_BYTE_MASK;
1232
1233        /* Write PLL config & dividers */
1234        snd_soc_write(codec, DA7219_PLL_FRAC_TOP, pll_frac_top);
1235        snd_soc_write(codec, DA7219_PLL_FRAC_BOT, pll_frac_bot);
1236        snd_soc_write(codec, DA7219_PLL_INTEGER, pll_integer);
1237        snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1238                            DA7219_PLL_INDIV_MASK | DA7219_PLL_MODE_MASK,
1239                            pll_ctrl);
1240
1241        return 0;
1242}
1243
1244static int da7219_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
1245                              int source, unsigned int fref, unsigned int fout)
1246{
1247        struct snd_soc_codec *codec = codec_dai->codec;
1248        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1249        int ret;
1250
1251        mutex_lock(&da7219->pll_lock);
1252        ret = da7219_set_pll(codec, source, fout);
1253        mutex_unlock(&da7219->pll_lock);
1254
1255        return ret;
1256}
1257
1258static int da7219_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
1259{
1260        struct snd_soc_codec *codec = codec_dai->codec;
1261        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1262        u8 dai_clk_mode = 0, dai_ctrl = 0;
1263
1264        switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1265        case SND_SOC_DAIFMT_CBM_CFM:
1266                da7219->master = true;
1267                break;
1268        case SND_SOC_DAIFMT_CBS_CFS:
1269                da7219->master = false;
1270                break;
1271        default:
1272                return -EINVAL;
1273        }
1274
1275        switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1276        case SND_SOC_DAIFMT_I2S:
1277        case SND_SOC_DAIFMT_LEFT_J:
1278        case SND_SOC_DAIFMT_RIGHT_J:
1279                switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1280                case SND_SOC_DAIFMT_NB_NF:
1281                        break;
1282                case SND_SOC_DAIFMT_NB_IF:
1283                        dai_clk_mode |= DA7219_DAI_WCLK_POL_INV;
1284                        break;
1285                case SND_SOC_DAIFMT_IB_NF:
1286                        dai_clk_mode |= DA7219_DAI_CLK_POL_INV;
1287                        break;
1288                case SND_SOC_DAIFMT_IB_IF:
1289                        dai_clk_mode |= DA7219_DAI_WCLK_POL_INV |
1290                                        DA7219_DAI_CLK_POL_INV;
1291                        break;
1292                default:
1293                        return -EINVAL;
1294                }
1295                break;
1296        case SND_SOC_DAIFMT_DSP_B:
1297                switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1298                case SND_SOC_DAIFMT_NB_NF:
1299                        dai_clk_mode |= DA7219_DAI_CLK_POL_INV;
1300                        break;
1301                case SND_SOC_DAIFMT_NB_IF:
1302                        dai_clk_mode |= DA7219_DAI_WCLK_POL_INV |
1303                                        DA7219_DAI_CLK_POL_INV;
1304                        break;
1305                case SND_SOC_DAIFMT_IB_NF:
1306                        break;
1307                case SND_SOC_DAIFMT_IB_IF:
1308                        dai_clk_mode |= DA7219_DAI_WCLK_POL_INV;
1309                        break;
1310                default:
1311                        return -EINVAL;
1312                }
1313                break;
1314        default:
1315                return -EINVAL;
1316        }
1317
1318        switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1319        case SND_SOC_DAIFMT_I2S:
1320                dai_ctrl |= DA7219_DAI_FORMAT_I2S;
1321                break;
1322        case SND_SOC_DAIFMT_LEFT_J:
1323                dai_ctrl |= DA7219_DAI_FORMAT_LEFT_J;
1324                break;
1325        case SND_SOC_DAIFMT_RIGHT_J:
1326                dai_ctrl |= DA7219_DAI_FORMAT_RIGHT_J;
1327                break;
1328        case SND_SOC_DAIFMT_DSP_B:
1329                dai_ctrl |= DA7219_DAI_FORMAT_DSP;
1330                break;
1331        default:
1332                return -EINVAL;
1333        }
1334
1335        /* By default 64 BCLKs per WCLK is supported */
1336        dai_clk_mode |= DA7219_DAI_BCLKS_PER_WCLK_64;
1337
1338        snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1339                            DA7219_DAI_BCLKS_PER_WCLK_MASK |
1340                            DA7219_DAI_CLK_POL_MASK | DA7219_DAI_WCLK_POL_MASK,
1341                            dai_clk_mode);
1342        snd_soc_update_bits(codec, DA7219_DAI_CTRL, DA7219_DAI_FORMAT_MASK,
1343                            dai_ctrl);
1344
1345        return 0;
1346}
1347
1348static int da7219_set_dai_tdm_slot(struct snd_soc_dai *dai,
1349                                   unsigned int tx_mask, unsigned int rx_mask,
1350                                   int slots, int slot_width)
1351{
1352        struct snd_soc_codec *codec = dai->codec;
1353        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1354        u8 dai_bclks_per_wclk;
1355        u16 offset;
1356        u32 frame_size;
1357
1358        /* No channels enabled so disable TDM, revert to 64-bit frames */
1359        if (!tx_mask) {
1360                snd_soc_update_bits(codec, DA7219_DAI_TDM_CTRL,
1361                                    DA7219_DAI_TDM_CH_EN_MASK |
1362                                    DA7219_DAI_TDM_MODE_EN_MASK, 0);
1363                snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1364                                    DA7219_DAI_BCLKS_PER_WCLK_MASK,
1365                                    DA7219_DAI_BCLKS_PER_WCLK_64);
1366                return 0;
1367        }
1368
1369        /* Check we have valid slots */
1370        if (fls(tx_mask) > DA7219_DAI_TDM_MAX_SLOTS) {
1371                dev_err(codec->dev, "Invalid number of slots, max = %d\n",
1372                        DA7219_DAI_TDM_MAX_SLOTS);
1373                return -EINVAL;
1374        }
1375
1376        /* Check we have a valid offset given */
1377        if (rx_mask > DA7219_DAI_OFFSET_MAX) {
1378                dev_err(codec->dev, "Invalid slot offset, max = %d\n",
1379                        DA7219_DAI_OFFSET_MAX);
1380                return -EINVAL;
1381        }
1382
1383        /* Calculate & validate frame size based on slot info provided. */
1384        frame_size = slots * slot_width;
1385        switch (frame_size) {
1386        case 32:
1387                dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_32;
1388                break;
1389        case 64:
1390                dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_64;
1391                break;
1392        case 128:
1393                dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_128;
1394                break;
1395        case 256:
1396                dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_256;
1397                break;
1398        default:
1399                dev_err(codec->dev, "Invalid frame size %d\n", frame_size);
1400                return -EINVAL;
1401        }
1402
1403        snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1404                            DA7219_DAI_BCLKS_PER_WCLK_MASK,
1405                            dai_bclks_per_wclk);
1406
1407        offset = cpu_to_le16(rx_mask);
1408        regmap_bulk_write(da7219->regmap, DA7219_DAI_OFFSET_LOWER,
1409                          &offset, sizeof(offset));
1410
1411        snd_soc_update_bits(codec, DA7219_DAI_TDM_CTRL,
1412                            DA7219_DAI_TDM_CH_EN_MASK |
1413                            DA7219_DAI_TDM_MODE_EN_MASK,
1414                            (tx_mask << DA7219_DAI_TDM_CH_EN_SHIFT) |
1415                            DA7219_DAI_TDM_MODE_EN_MASK);
1416
1417        return 0;
1418}
1419
1420static int da7219_hw_params(struct snd_pcm_substream *substream,
1421                            struct snd_pcm_hw_params *params,
1422                            struct snd_soc_dai *dai)
1423{
1424        struct snd_soc_codec *codec = dai->codec;
1425        u8 dai_ctrl = 0, fs;
1426        unsigned int channels;
1427
1428        switch (params_width(params)) {
1429        case 16:
1430                dai_ctrl |= DA7219_DAI_WORD_LENGTH_S16_LE;
1431                break;
1432        case 20:
1433                dai_ctrl |= DA7219_DAI_WORD_LENGTH_S20_LE;
1434                break;
1435        case 24:
1436                dai_ctrl |= DA7219_DAI_WORD_LENGTH_S24_LE;
1437                break;
1438        case 32:
1439                dai_ctrl |= DA7219_DAI_WORD_LENGTH_S32_LE;
1440                break;
1441        default:
1442                return -EINVAL;
1443        }
1444
1445        channels = params_channels(params);
1446        if ((channels < 1) || (channels > DA7219_DAI_CH_NUM_MAX)) {
1447                dev_err(codec->dev,
1448                        "Invalid number of channels, only 1 to %d supported\n",
1449                        DA7219_DAI_CH_NUM_MAX);
1450                return -EINVAL;
1451        }
1452        dai_ctrl |= channels << DA7219_DAI_CH_NUM_SHIFT;
1453
1454        switch (params_rate(params)) {
1455        case 8000:
1456                fs = DA7219_SR_8000;
1457                break;
1458        case 11025:
1459                fs = DA7219_SR_11025;
1460                break;
1461        case 12000:
1462                fs = DA7219_SR_12000;
1463                break;
1464        case 16000:
1465                fs = DA7219_SR_16000;
1466                break;
1467        case 22050:
1468                fs = DA7219_SR_22050;
1469                break;
1470        case 24000:
1471                fs = DA7219_SR_24000;
1472                break;
1473        case 32000:
1474                fs = DA7219_SR_32000;
1475                break;
1476        case 44100:
1477                fs = DA7219_SR_44100;
1478                break;
1479        case 48000:
1480                fs = DA7219_SR_48000;
1481                break;
1482        case 88200:
1483                fs = DA7219_SR_88200;
1484                break;
1485        case 96000:
1486                fs = DA7219_SR_96000;
1487                break;
1488        default:
1489                return -EINVAL;
1490        }
1491
1492        snd_soc_update_bits(codec, DA7219_DAI_CTRL,
1493                            DA7219_DAI_WORD_LENGTH_MASK |
1494                            DA7219_DAI_CH_NUM_MASK,
1495                            dai_ctrl);
1496        snd_soc_write(codec, DA7219_SR, fs);
1497
1498        return 0;
1499}
1500
1501static const struct snd_soc_dai_ops da7219_dai_ops = {
1502        .hw_params      = da7219_hw_params,
1503        .set_sysclk     = da7219_set_dai_sysclk,
1504        .set_pll        = da7219_set_dai_pll,
1505        .set_fmt        = da7219_set_dai_fmt,
1506        .set_tdm_slot   = da7219_set_dai_tdm_slot,
1507};
1508
1509#define DA7219_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
1510                        SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
1511
1512static struct snd_soc_dai_driver da7219_dai = {
1513        .name = "da7219-hifi",
1514        .playback = {
1515                .stream_name = "Playback",
1516                .channels_min = 1,
1517                .channels_max = DA7219_DAI_CH_NUM_MAX,
1518                .rates = SNDRV_PCM_RATE_8000_96000,
1519                .formats = DA7219_FORMATS,
1520        },
1521        .capture = {
1522                .stream_name = "Capture",
1523                .channels_min = 1,
1524                .channels_max = DA7219_DAI_CH_NUM_MAX,
1525                .rates = SNDRV_PCM_RATE_8000_96000,
1526                .formats = DA7219_FORMATS,
1527        },
1528        .ops = &da7219_dai_ops,
1529        .symmetric_rates = 1,
1530        .symmetric_channels = 1,
1531        .symmetric_samplebits = 1,
1532};
1533
1534
1535/*
1536 * DT/ACPI
1537 */
1538
1539static const struct of_device_id da7219_of_match[] = {
1540        { .compatible = "dlg,da7219", },
1541        { }
1542};
1543MODULE_DEVICE_TABLE(of, da7219_of_match);
1544
1545static const struct acpi_device_id da7219_acpi_match[] = {
1546        { .id = "DLGS7219", },
1547        { }
1548};
1549MODULE_DEVICE_TABLE(acpi, da7219_acpi_match);
1550
1551static enum da7219_micbias_voltage
1552        da7219_fw_micbias_lvl(struct device *dev, u32 val)
1553{
1554        switch (val) {
1555        case 1600:
1556                return DA7219_MICBIAS_1_6V;
1557        case 1800:
1558                return DA7219_MICBIAS_1_8V;
1559        case 2000:
1560                return DA7219_MICBIAS_2_0V;
1561        case 2200:
1562                return DA7219_MICBIAS_2_2V;
1563        case 2400:
1564                return DA7219_MICBIAS_2_4V;
1565        case 2600:
1566                return DA7219_MICBIAS_2_6V;
1567        default:
1568                dev_warn(dev, "Invalid micbias level");
1569                return DA7219_MICBIAS_2_2V;
1570        }
1571}
1572
1573static enum da7219_mic_amp_in_sel
1574        da7219_fw_mic_amp_in_sel(struct device *dev, const char *str)
1575{
1576        if (!strcmp(str, "diff")) {
1577                return DA7219_MIC_AMP_IN_SEL_DIFF;
1578        } else if (!strcmp(str, "se_p")) {
1579                return DA7219_MIC_AMP_IN_SEL_SE_P;
1580        } else if (!strcmp(str, "se_n")) {
1581                return DA7219_MIC_AMP_IN_SEL_SE_N;
1582        } else {
1583                dev_warn(dev, "Invalid mic input type selection");
1584                return DA7219_MIC_AMP_IN_SEL_DIFF;
1585        }
1586}
1587
1588static struct da7219_pdata *da7219_fw_to_pdata(struct snd_soc_codec *codec)
1589{
1590        struct device *dev = codec->dev;
1591        struct da7219_pdata *pdata;
1592        const char *of_str;
1593        u32 of_val32;
1594
1595        pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
1596        if (!pdata)
1597                return NULL;
1598
1599        pdata->wakeup_source = device_property_read_bool(dev, "wakeup-source");
1600
1601        if (device_property_read_u32(dev, "dlg,micbias-lvl", &of_val32) >= 0)
1602                pdata->micbias_lvl = da7219_fw_micbias_lvl(dev, of_val32);
1603        else
1604                pdata->micbias_lvl = DA7219_MICBIAS_2_2V;
1605
1606        if (!device_property_read_string(dev, "dlg,mic-amp-in-sel", &of_str))
1607                pdata->mic_amp_in_sel = da7219_fw_mic_amp_in_sel(dev, of_str);
1608        else
1609                pdata->mic_amp_in_sel = DA7219_MIC_AMP_IN_SEL_DIFF;
1610
1611        return pdata;
1612}
1613
1614
1615/*
1616 * Codec driver functions
1617 */
1618
1619static int da7219_set_bias_level(struct snd_soc_codec *codec,
1620                                 enum snd_soc_bias_level level)
1621{
1622        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1623        int ret;
1624
1625        switch (level) {
1626        case SND_SOC_BIAS_ON:
1627                break;
1628        case SND_SOC_BIAS_PREPARE:
1629                /* Enable MCLK for transition to ON state */
1630                if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_STANDBY) {
1631                        if (da7219->mclk) {
1632                                ret = clk_prepare_enable(da7219->mclk);
1633                                if (ret) {
1634                                        dev_err(codec->dev,
1635                                                "Failed to enable mclk\n");
1636                                        return ret;
1637                                }
1638                        }
1639                }
1640
1641                break;
1642        case SND_SOC_BIAS_STANDBY:
1643                if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF)
1644                        /* Master bias */
1645                        snd_soc_update_bits(codec, DA7219_REFERENCES,
1646                                            DA7219_BIAS_EN_MASK,
1647                                            DA7219_BIAS_EN_MASK);
1648
1649                if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_PREPARE) {
1650                        /* Remove MCLK */
1651                        if (da7219->mclk)
1652                                clk_disable_unprepare(da7219->mclk);
1653                }
1654                break;
1655        case SND_SOC_BIAS_OFF:
1656                /* Only disable master bias if we're not a wake-up source */
1657                if (!da7219->wakeup_source)
1658                        snd_soc_update_bits(codec, DA7219_REFERENCES,
1659                                            DA7219_BIAS_EN_MASK, 0);
1660
1661                break;
1662        }
1663
1664        return 0;
1665}
1666
1667static const char *da7219_supply_names[DA7219_NUM_SUPPLIES] = {
1668        [DA7219_SUPPLY_VDD] = "VDD",
1669        [DA7219_SUPPLY_VDDMIC] = "VDDMIC",
1670        [DA7219_SUPPLY_VDDIO] = "VDDIO",
1671};
1672
1673static int da7219_handle_supplies(struct snd_soc_codec *codec)
1674{
1675        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1676        struct regulator *vddio;
1677        u8 io_voltage_lvl = DA7219_IO_VOLTAGE_LEVEL_2_5V_3_6V;
1678        int i, ret;
1679
1680        /* Get required supplies */
1681        for (i = 0; i < DA7219_NUM_SUPPLIES; ++i)
1682                da7219->supplies[i].supply = da7219_supply_names[i];
1683
1684        ret = devm_regulator_bulk_get(codec->dev, DA7219_NUM_SUPPLIES,
1685                                      da7219->supplies);
1686        if (ret) {
1687                dev_err(codec->dev, "Failed to get supplies");
1688                return ret;
1689        }
1690
1691        /* Determine VDDIO voltage provided */
1692        vddio = da7219->supplies[DA7219_SUPPLY_VDDIO].consumer;
1693        ret = regulator_get_voltage(vddio);
1694        if (ret < 1200000)
1695                dev_warn(codec->dev, "Invalid VDDIO voltage\n");
1696        else if (ret < 2800000)
1697                io_voltage_lvl = DA7219_IO_VOLTAGE_LEVEL_1_2V_2_8V;
1698
1699        /* Enable main supplies */
1700        ret = regulator_bulk_enable(DA7219_NUM_SUPPLIES, da7219->supplies);
1701        if (ret) {
1702                dev_err(codec->dev, "Failed to enable supplies");
1703                return ret;
1704        }
1705
1706        /* Ensure device in active mode */
1707        snd_soc_write(codec, DA7219_SYSTEM_ACTIVE, DA7219_SYSTEM_ACTIVE_MASK);
1708
1709        /* Update IO voltage level range */
1710        snd_soc_write(codec, DA7219_IO_CTRL, io_voltage_lvl);
1711
1712        return 0;
1713}
1714
1715static void da7219_handle_pdata(struct snd_soc_codec *codec)
1716{
1717        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1718        struct da7219_pdata *pdata = da7219->pdata;
1719
1720        if (pdata) {
1721                u8 micbias_lvl = 0;
1722
1723                da7219->wakeup_source = pdata->wakeup_source;
1724
1725                /* Mic Bias voltages */
1726                switch (pdata->micbias_lvl) {
1727                case DA7219_MICBIAS_1_6V:
1728                case DA7219_MICBIAS_1_8V:
1729                case DA7219_MICBIAS_2_0V:
1730                case DA7219_MICBIAS_2_2V:
1731                case DA7219_MICBIAS_2_4V:
1732                case DA7219_MICBIAS_2_6V:
1733                        micbias_lvl |= (pdata->micbias_lvl <<
1734                                        DA7219_MICBIAS1_LEVEL_SHIFT);
1735                        break;
1736                }
1737
1738                snd_soc_write(codec, DA7219_MICBIAS_CTRL, micbias_lvl);
1739
1740                /* Mic */
1741                switch (pdata->mic_amp_in_sel) {
1742                case DA7219_MIC_AMP_IN_SEL_DIFF:
1743                case DA7219_MIC_AMP_IN_SEL_SE_P:
1744                case DA7219_MIC_AMP_IN_SEL_SE_N:
1745                        snd_soc_write(codec, DA7219_MIC_1_SELECT,
1746                                      pdata->mic_amp_in_sel);
1747                        break;
1748                }
1749        }
1750}
1751
1752static struct reg_sequence da7219_rev_aa_patch[] = {
1753        { DA7219_REFERENCES, 0x08 },
1754};
1755
1756static int da7219_probe(struct snd_soc_codec *codec)
1757{
1758        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1759        unsigned int rev;
1760        int ret;
1761
1762        mutex_init(&da7219->ctrl_lock);
1763        mutex_init(&da7219->pll_lock);
1764
1765        /* Regulator configuration */
1766        ret = da7219_handle_supplies(codec);
1767        if (ret)
1768                return ret;
1769
1770        ret = regmap_read(da7219->regmap, DA7219_CHIP_REVISION, &rev);
1771        if (ret) {
1772                dev_err(codec->dev, "Failed to read chip revision: %d\n", ret);
1773                goto err_disable_reg;
1774        }
1775
1776        switch (rev & DA7219_CHIP_MINOR_MASK) {
1777        case 0:
1778                ret = regmap_register_patch(da7219->regmap, da7219_rev_aa_patch,
1779                                            ARRAY_SIZE(da7219_rev_aa_patch));
1780                if (ret) {
1781                        dev_err(codec->dev, "Failed to register AA patch: %d\n",
1782                                ret);
1783                        goto err_disable_reg;
1784                }
1785                break;
1786        default:
1787                break;
1788        }
1789
1790        /* Handle DT/ACPI/Platform data */
1791        da7219->pdata = dev_get_platdata(codec->dev);
1792        if (!da7219->pdata)
1793                da7219->pdata = da7219_fw_to_pdata(codec);
1794
1795        da7219_handle_pdata(codec);
1796
1797        /* Check if MCLK provided */
1798        da7219->mclk = devm_clk_get(codec->dev, "mclk");
1799        if (IS_ERR(da7219->mclk)) {
1800                if (PTR_ERR(da7219->mclk) != -ENOENT) {
1801                        ret = PTR_ERR(da7219->mclk);
1802                        goto err_disable_reg;
1803                } else {
1804                        da7219->mclk = NULL;
1805                }
1806        }
1807
1808        /* Default PC counter to free-running */
1809        snd_soc_update_bits(codec, DA7219_PC_COUNT, DA7219_PC_FREERUN_MASK,
1810                            DA7219_PC_FREERUN_MASK);
1811
1812        /* Default gain ramping */
1813        snd_soc_update_bits(codec, DA7219_MIXIN_L_CTRL,
1814                            DA7219_MIXIN_L_AMP_RAMP_EN_MASK,
1815                            DA7219_MIXIN_L_AMP_RAMP_EN_MASK);
1816        snd_soc_update_bits(codec, DA7219_ADC_L_CTRL, DA7219_ADC_L_RAMP_EN_MASK,
1817                            DA7219_ADC_L_RAMP_EN_MASK);
1818        snd_soc_update_bits(codec, DA7219_DAC_L_CTRL, DA7219_DAC_L_RAMP_EN_MASK,
1819                            DA7219_DAC_L_RAMP_EN_MASK);
1820        snd_soc_update_bits(codec, DA7219_DAC_R_CTRL, DA7219_DAC_R_RAMP_EN_MASK,
1821                            DA7219_DAC_R_RAMP_EN_MASK);
1822        snd_soc_update_bits(codec, DA7219_HP_L_CTRL,
1823                            DA7219_HP_L_AMP_RAMP_EN_MASK,
1824                            DA7219_HP_L_AMP_RAMP_EN_MASK);
1825        snd_soc_update_bits(codec, DA7219_HP_R_CTRL,
1826                            DA7219_HP_R_AMP_RAMP_EN_MASK,
1827                            DA7219_HP_R_AMP_RAMP_EN_MASK);
1828
1829        /* Default minimum gain on HP to avoid pops during DAPM sequencing */
1830        snd_soc_update_bits(codec, DA7219_HP_L_CTRL,
1831                            DA7219_HP_L_AMP_MIN_GAIN_EN_MASK,
1832                            DA7219_HP_L_AMP_MIN_GAIN_EN_MASK);
1833        snd_soc_update_bits(codec, DA7219_HP_R_CTRL,
1834                            DA7219_HP_R_AMP_MIN_GAIN_EN_MASK,
1835                            DA7219_HP_R_AMP_MIN_GAIN_EN_MASK);
1836
1837        /* Default infinite tone gen, start/stop by Kcontrol */
1838        snd_soc_write(codec, DA7219_TONE_GEN_CYCLES, DA7219_BEEP_CYCLES_MASK);
1839
1840        /* Initialise AAD block */
1841        ret = da7219_aad_init(codec);
1842        if (ret)
1843                goto err_disable_reg;
1844
1845        return 0;
1846
1847err_disable_reg:
1848        regulator_bulk_disable(DA7219_NUM_SUPPLIES, da7219->supplies);
1849
1850        return ret;
1851}
1852
1853static int da7219_remove(struct snd_soc_codec *codec)
1854{
1855        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1856
1857        da7219_aad_exit(codec);
1858
1859        /* Supplies */
1860        return regulator_bulk_disable(DA7219_NUM_SUPPLIES, da7219->supplies);
1861}
1862
1863#ifdef CONFIG_PM
1864static int da7219_suspend(struct snd_soc_codec *codec)
1865{
1866        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1867
1868        /* Suspend AAD if we're not a wake-up source */
1869        if (!da7219->wakeup_source)
1870                da7219_aad_suspend(codec);
1871
1872        snd_soc_codec_force_bias_level(codec, SND_SOC_BIAS_OFF);
1873
1874        return 0;
1875}
1876
1877static int da7219_resume(struct snd_soc_codec *codec)
1878{
1879        struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1880
1881        snd_soc_codec_force_bias_level(codec, SND_SOC_BIAS_STANDBY);
1882
1883        /* Resume AAD if previously suspended */
1884        if (!da7219->wakeup_source)
1885                da7219_aad_resume(codec);
1886
1887        return 0;
1888}
1889#else
1890#define da7219_suspend NULL
1891#define da7219_resume NULL
1892#endif
1893
1894static const struct snd_soc_codec_driver soc_codec_dev_da7219 = {
1895        .probe                  = da7219_probe,
1896        .remove                 = da7219_remove,
1897        .suspend                = da7219_suspend,
1898        .resume                 = da7219_resume,
1899        .set_bias_level         = da7219_set_bias_level,
1900
1901        .component_driver = {
1902                .controls               = da7219_snd_controls,
1903                .num_controls           = ARRAY_SIZE(da7219_snd_controls),
1904                .dapm_widgets           = da7219_dapm_widgets,
1905                .num_dapm_widgets       = ARRAY_SIZE(da7219_dapm_widgets),
1906                .dapm_routes            = da7219_audio_map,
1907                .num_dapm_routes        = ARRAY_SIZE(da7219_audio_map),
1908        },
1909};
1910
1911
1912/*
1913 * Regmap configs
1914 */
1915
1916static struct reg_default da7219_reg_defaults[] = {
1917        { DA7219_MIC_1_SELECT, 0x00 },
1918        { DA7219_CIF_TIMEOUT_CTRL, 0x01 },
1919        { DA7219_SR_24_48, 0x00 },
1920        { DA7219_SR, 0x0A },
1921        { DA7219_CIF_I2C_ADDR_CFG, 0x02 },
1922        { DA7219_PLL_CTRL, 0x10 },
1923        { DA7219_PLL_FRAC_TOP, 0x00 },
1924        { DA7219_PLL_FRAC_BOT, 0x00 },
1925        { DA7219_PLL_INTEGER, 0x20 },
1926        { DA7219_DIG_ROUTING_DAI, 0x10 },
1927        { DA7219_DAI_CLK_MODE, 0x01 },
1928        { DA7219_DAI_CTRL, 0x28 },
1929        { DA7219_DAI_TDM_CTRL, 0x40 },
1930        { DA7219_DIG_ROUTING_DAC, 0x32 },
1931        { DA7219_DAI_OFFSET_LOWER, 0x00 },
1932        { DA7219_DAI_OFFSET_UPPER, 0x00 },
1933        { DA7219_REFERENCES, 0x08 },
1934        { DA7219_MIXIN_L_SELECT, 0x00 },
1935        { DA7219_MIXIN_L_GAIN, 0x03 },
1936        { DA7219_ADC_L_GAIN, 0x6F },
1937        { DA7219_ADC_FILTERS1, 0x80 },
1938        { DA7219_MIC_1_GAIN, 0x01 },
1939        { DA7219_SIDETONE_CTRL, 0x40 },
1940        { DA7219_SIDETONE_GAIN, 0x0E },
1941        { DA7219_DROUTING_ST_OUTFILT_1L, 0x01 },
1942        { DA7219_DROUTING_ST_OUTFILT_1R, 0x02 },
1943        { DA7219_DAC_FILTERS5, 0x00 },
1944        { DA7219_DAC_FILTERS2, 0x88 },
1945        { DA7219_DAC_FILTERS3, 0x88 },
1946        { DA7219_DAC_FILTERS4, 0x08 },
1947        { DA7219_DAC_FILTERS1, 0x80 },
1948        { DA7219_DAC_L_GAIN, 0x6F },
1949        { DA7219_DAC_R_GAIN, 0x6F },
1950        { DA7219_CP_CTRL, 0x20 },
1951        { DA7219_HP_L_GAIN, 0x39 },
1952        { DA7219_HP_R_GAIN, 0x39 },
1953        { DA7219_MIXOUT_L_SELECT, 0x00 },
1954        { DA7219_MIXOUT_R_SELECT, 0x00 },
1955        { DA7219_MICBIAS_CTRL, 0x03 },
1956        { DA7219_MIC_1_CTRL, 0x40 },
1957        { DA7219_MIXIN_L_CTRL, 0x40 },
1958        { DA7219_ADC_L_CTRL, 0x40 },
1959        { DA7219_DAC_L_CTRL, 0x40 },
1960        { DA7219_DAC_R_CTRL, 0x40 },
1961        { DA7219_HP_L_CTRL, 0x40 },
1962        { DA7219_HP_R_CTRL, 0x40 },
1963        { DA7219_MIXOUT_L_CTRL, 0x10 },
1964        { DA7219_MIXOUT_R_CTRL, 0x10 },
1965        { DA7219_CHIP_ID1, 0x23 },
1966        { DA7219_CHIP_ID2, 0x93 },
1967        { DA7219_IO_CTRL, 0x00 },
1968        { DA7219_GAIN_RAMP_CTRL, 0x00 },
1969        { DA7219_PC_COUNT, 0x02 },
1970        { DA7219_CP_VOL_THRESHOLD1, 0x0E },
1971        { DA7219_DIG_CTRL, 0x00 },
1972        { DA7219_ALC_CTRL2, 0x00 },
1973        { DA7219_ALC_CTRL3, 0x00 },
1974        { DA7219_ALC_NOISE, 0x3F },
1975        { DA7219_ALC_TARGET_MIN, 0x3F },
1976        { DA7219_ALC_TARGET_MAX, 0x00 },
1977        { DA7219_ALC_GAIN_LIMITS, 0xFF },
1978        { DA7219_ALC_ANA_GAIN_LIMITS, 0x71 },
1979        { DA7219_ALC_ANTICLIP_CTRL, 0x00 },
1980        { DA7219_ALC_ANTICLIP_LEVEL, 0x00 },
1981        { DA7219_DAC_NG_SETUP_TIME, 0x00 },
1982        { DA7219_DAC_NG_OFF_THRESH, 0x00 },
1983        { DA7219_DAC_NG_ON_THRESH, 0x00 },
1984        { DA7219_DAC_NG_CTRL, 0x00 },
1985        { DA7219_TONE_GEN_CFG1, 0x00 },
1986        { DA7219_TONE_GEN_CFG2, 0x00 },
1987        { DA7219_TONE_GEN_CYCLES, 0x00 },
1988        { DA7219_TONE_GEN_FREQ1_L, 0x55 },
1989        { DA7219_TONE_GEN_FREQ1_U, 0x15 },
1990        { DA7219_TONE_GEN_FREQ2_L, 0x00 },
1991        { DA7219_TONE_GEN_FREQ2_U, 0x40 },
1992        { DA7219_TONE_GEN_ON_PER, 0x02 },
1993        { DA7219_TONE_GEN_OFF_PER, 0x01 },
1994        { DA7219_ACCDET_IRQ_MASK_A, 0x00 },
1995        { DA7219_ACCDET_IRQ_MASK_B, 0x00 },
1996        { DA7219_ACCDET_CONFIG_1, 0xD6 },
1997        { DA7219_ACCDET_CONFIG_2, 0x34 },
1998        { DA7219_ACCDET_CONFIG_3, 0x0A },
1999        { DA7219_ACCDET_CONFIG_4, 0x16 },
2000        { DA7219_ACCDET_CONFIG_5, 0x21 },
2001        { DA7219_ACCDET_CONFIG_6, 0x3E },
2002        { DA7219_ACCDET_CONFIG_7, 0x01 },
2003        { DA7219_SYSTEM_ACTIVE, 0x00 },
2004};
2005
2006static bool da7219_volatile_register(struct device *dev, unsigned int reg)
2007{
2008        switch (reg) {
2009        case DA7219_MIC_1_GAIN_STATUS:
2010        case DA7219_MIXIN_L_GAIN_STATUS:
2011        case DA7219_ADC_L_GAIN_STATUS:
2012        case DA7219_DAC_L_GAIN_STATUS:
2013        case DA7219_DAC_R_GAIN_STATUS:
2014        case DA7219_HP_L_GAIN_STATUS:
2015        case DA7219_HP_R_GAIN_STATUS:
2016        case DA7219_CIF_CTRL:
2017        case DA7219_PLL_SRM_STS:
2018        case DA7219_ALC_CTRL1:
2019        case DA7219_SYSTEM_MODES_INPUT:
2020        case DA7219_SYSTEM_MODES_OUTPUT:
2021        case DA7219_ALC_OFFSET_AUTO_M_L:
2022        case DA7219_ALC_OFFSET_AUTO_U_L:
2023        case DA7219_TONE_GEN_CFG1:
2024        case DA7219_ACCDET_STATUS_A:
2025        case DA7219_ACCDET_STATUS_B:
2026        case DA7219_ACCDET_IRQ_EVENT_A:
2027        case DA7219_ACCDET_IRQ_EVENT_B:
2028        case DA7219_ACCDET_CONFIG_8:
2029        case DA7219_SYSTEM_STATUS:
2030                return 1;
2031        default:
2032                return 0;
2033        }
2034}
2035
2036static const struct regmap_config da7219_regmap_config = {
2037        .reg_bits = 8,
2038        .val_bits = 8,
2039
2040        .max_register = DA7219_SYSTEM_ACTIVE,
2041        .reg_defaults = da7219_reg_defaults,
2042        .num_reg_defaults = ARRAY_SIZE(da7219_reg_defaults),
2043        .volatile_reg = da7219_volatile_register,
2044        .cache_type = REGCACHE_RBTREE,
2045};
2046
2047
2048/*
2049 * I2C layer
2050 */
2051
2052static int da7219_i2c_probe(struct i2c_client *i2c,
2053                            const struct i2c_device_id *id)
2054{
2055        struct da7219_priv *da7219;
2056        unsigned int system_active, system_status;
2057        int i, ret;
2058
2059        da7219 = devm_kzalloc(&i2c->dev, sizeof(struct da7219_priv),
2060                              GFP_KERNEL);
2061        if (!da7219)
2062                return -ENOMEM;
2063
2064        i2c_set_clientdata(i2c, da7219);
2065
2066        da7219->regmap = devm_regmap_init_i2c(i2c, &da7219_regmap_config);
2067        if (IS_ERR(da7219->regmap)) {
2068                ret = PTR_ERR(da7219->regmap);
2069                dev_err(&i2c->dev, "regmap_init() failed: %d\n", ret);
2070                return ret;
2071        }
2072
2073        regcache_cache_bypass(da7219->regmap, true);
2074
2075        /* Disable audio paths if still active from previous start */
2076        regmap_read(da7219->regmap, DA7219_SYSTEM_ACTIVE, &system_active);
2077        if (system_active) {
2078                regmap_write(da7219->regmap, DA7219_GAIN_RAMP_CTRL,
2079                             DA7219_GAIN_RAMP_RATE_NOMINAL);
2080                regmap_write(da7219->regmap, DA7219_SYSTEM_MODES_INPUT, 0x00);
2081                regmap_write(da7219->regmap, DA7219_SYSTEM_MODES_OUTPUT, 0x01);
2082
2083                for (i = 0; i < DA7219_SYS_STAT_CHECK_RETRIES; ++i) {
2084                        regmap_read(da7219->regmap, DA7219_SYSTEM_STATUS,
2085                                    &system_status);
2086                        if (!system_status)
2087                                break;
2088
2089                        msleep(DA7219_SYS_STAT_CHECK_DELAY);
2090                }
2091        }
2092
2093        /* Soft reset codec */
2094        regmap_write_bits(da7219->regmap, DA7219_ACCDET_CONFIG_1,
2095                          DA7219_ACCDET_EN_MASK, 0);
2096        regmap_write_bits(da7219->regmap, DA7219_CIF_CTRL,
2097                          DA7219_CIF_REG_SOFT_RESET_MASK,
2098                          DA7219_CIF_REG_SOFT_RESET_MASK);
2099        regmap_write_bits(da7219->regmap, DA7219_SYSTEM_ACTIVE,
2100                          DA7219_SYSTEM_ACTIVE_MASK, 0);
2101
2102        regcache_cache_bypass(da7219->regmap, false);
2103
2104        ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_da7219,
2105                                     &da7219_dai, 1);
2106        if (ret < 0) {
2107                dev_err(&i2c->dev, "Failed to register da7219 codec: %d\n",
2108                        ret);
2109        }
2110        return ret;
2111}
2112
2113static int da7219_i2c_remove(struct i2c_client *client)
2114{
2115        snd_soc_unregister_codec(&client->dev);
2116        return 0;
2117}
2118
2119static const struct i2c_device_id da7219_i2c_id[] = {
2120        { "da7219", },
2121        { }
2122};
2123MODULE_DEVICE_TABLE(i2c, da7219_i2c_id);
2124
2125static struct i2c_driver da7219_i2c_driver = {
2126        .driver = {
2127                .name = "da7219",
2128                .of_match_table = of_match_ptr(da7219_of_match),
2129                .acpi_match_table = ACPI_PTR(da7219_acpi_match),
2130        },
2131        .probe          = da7219_i2c_probe,
2132        .remove         = da7219_i2c_remove,
2133        .id_table       = da7219_i2c_id,
2134};
2135
2136module_i2c_driver(da7219_i2c_driver);
2137
2138MODULE_DESCRIPTION("ASoC DA7219 Codec Driver");
2139MODULE_AUTHOR("Adam Thomson <Adam.Thomson.Opensource@diasemi.com>");
2140MODULE_LICENSE("GPL");
2141