Linux Audio

Check our new training course

Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Nuvoton NAU8825 audio codec driver
   4 *
   5 * Copyright 2015 Google Chromium project.
   6 *  Author: Anatol Pomozov <anatol@chromium.org>
   7 * Copyright 2015 Nuvoton Technology Corp.
   8 *  Co-author: Meng-Huang Kuo <mhkuo@nuvoton.com>
   9 */
  10
  11#include <linux/module.h>
  12#include <linux/delay.h>
  13#include <linux/init.h>
  14#include <linux/int_log.h>
  15#include <linux/i2c.h>
  16#include <linux/regmap.h>
  17#include <linux/slab.h>
  18#include <linux/clk.h>
  19#include <linux/acpi.h>
  20#include <linux/math64.h>
  21#include <linux/semaphore.h>
  22
  23#include <sound/initval.h>
  24#include <sound/tlv.h>
  25#include <sound/core.h>
  26#include <sound/pcm.h>
  27#include <sound/pcm_params.h>
  28#include <sound/soc.h>
  29#include <sound/jack.h>
  30
  31
  32#include "nau8825.h"
  33
  34
  35#define NUVOTON_CODEC_DAI "nau8825-hifi"
  36
  37#define NAU_FREF_MAX 13500000
  38#define NAU_FVCO_MAX 124000000
  39#define NAU_FVCO_MIN 90000000
  40
  41/* cross talk suppression detection */
 
  42#define GAIN_AUGMENT 22500
  43#define SIDETONE_BASE 207000
  44
  45/* the maximum frequency of CLK_ADC and CLK_DAC */
  46#define CLK_DA_AD_MAX 6144000
  47
  48static int nau8825_configure_sysclk(struct nau8825 *nau8825,
  49		int clk_id, unsigned int freq);
  50static bool nau8825_is_jack_inserted(struct regmap *regmap);
  51
  52struct nau8825_fll {
  53	int mclk_src;
  54	int ratio;
  55	int fll_frac;
  56	int fll_frac_num;
  57	int fll_int;
  58	int clk_ref_div;
  59};
  60
  61struct nau8825_fll_attr {
  62	unsigned int param;
  63	unsigned int val;
  64};
  65
  66/* scaling for mclk from sysclk_src output */
  67static const struct nau8825_fll_attr mclk_src_scaling[] = {
  68	{ 1, 0x0 },
  69	{ 2, 0x2 },
  70	{ 4, 0x3 },
  71	{ 8, 0x4 },
  72	{ 16, 0x5 },
  73	{ 32, 0x6 },
  74	{ 3, 0x7 },
  75	{ 6, 0xa },
  76	{ 12, 0xb },
  77	{ 24, 0xc },
  78	{ 48, 0xd },
  79	{ 96, 0xe },
  80	{ 5, 0xf },
  81};
  82
  83/* ratio for input clk freq */
  84static const struct nau8825_fll_attr fll_ratio[] = {
  85	{ 512000, 0x01 },
  86	{ 256000, 0x02 },
  87	{ 128000, 0x04 },
  88	{ 64000, 0x08 },
  89	{ 32000, 0x10 },
  90	{ 8000, 0x20 },
  91	{ 4000, 0x40 },
  92};
  93
  94static const struct nau8825_fll_attr fll_pre_scalar[] = {
  95	{ 1, 0x0 },
  96	{ 2, 0x1 },
  97	{ 4, 0x2 },
  98	{ 8, 0x3 },
  99};
 100
 101/* over sampling rate */
 102struct nau8825_osr_attr {
 103	unsigned int osr;
 104	unsigned int clk_src;
 105};
 106
 107static const struct nau8825_osr_attr osr_dac_sel[] = {
 108	{ 64, 2 },	/* OSR 64, SRC 1/4 */
 109	{ 256, 0 },	/* OSR 256, SRC 1 */
 110	{ 128, 1 },	/* OSR 128, SRC 1/2 */
 111	{ 0, 0 },
 112	{ 32, 3 },	/* OSR 32, SRC 1/8 */
 113};
 114
 115static const struct nau8825_osr_attr osr_adc_sel[] = {
 116	{ 32, 3 },	/* OSR 32, SRC 1/8 */
 117	{ 64, 2 },	/* OSR 64, SRC 1/4 */
 118	{ 128, 1 },	/* OSR 128, SRC 1/2 */
 119	{ 256, 0 },	/* OSR 256, SRC 1 */
 120};
 121
 122static const struct reg_default nau8825_reg_defaults[] = {
 123	{ NAU8825_REG_ENA_CTRL, 0x00ff },
 124	{ NAU8825_REG_IIC_ADDR_SET, 0x0 },
 125	{ NAU8825_REG_CLK_DIVIDER, 0x0050 },
 126	{ NAU8825_REG_FLL1, 0x0 },
 127	{ NAU8825_REG_FLL2, 0x3126 },
 128	{ NAU8825_REG_FLL3, 0x0008 },
 129	{ NAU8825_REG_FLL4, 0x0010 },
 130	{ NAU8825_REG_FLL5, 0x0 },
 131	{ NAU8825_REG_FLL6, 0x6000 },
 132	{ NAU8825_REG_FLL_VCO_RSV, 0xf13c },
 133	{ NAU8825_REG_HSD_CTRL, 0x000c },
 134	{ NAU8825_REG_JACK_DET_CTRL, 0x0 },
 135	{ NAU8825_REG_INTERRUPT_MASK, 0x0 },
 136	{ NAU8825_REG_INTERRUPT_DIS_CTRL, 0xffff },
 137	{ NAU8825_REG_SAR_CTRL, 0x0015 },
 138	{ NAU8825_REG_KEYDET_CTRL, 0x0110 },
 139	{ NAU8825_REG_VDET_THRESHOLD_1, 0x0 },
 140	{ NAU8825_REG_VDET_THRESHOLD_2, 0x0 },
 141	{ NAU8825_REG_VDET_THRESHOLD_3, 0x0 },
 142	{ NAU8825_REG_VDET_THRESHOLD_4, 0x0 },
 143	{ NAU8825_REG_GPIO34_CTRL, 0x0 },
 144	{ NAU8825_REG_GPIO12_CTRL, 0x0 },
 145	{ NAU8825_REG_TDM_CTRL, 0x0 },
 146	{ NAU8825_REG_I2S_PCM_CTRL1, 0x000b },
 147	{ NAU8825_REG_I2S_PCM_CTRL2, 0x8010 },
 148	{ NAU8825_REG_LEFT_TIME_SLOT, 0x0 },
 149	{ NAU8825_REG_RIGHT_TIME_SLOT, 0x0 },
 150	{ NAU8825_REG_BIQ_CTRL, 0x0 },
 151	{ NAU8825_REG_BIQ_COF1, 0x0 },
 152	{ NAU8825_REG_BIQ_COF2, 0x0 },
 153	{ NAU8825_REG_BIQ_COF3, 0x0 },
 154	{ NAU8825_REG_BIQ_COF4, 0x0 },
 155	{ NAU8825_REG_BIQ_COF5, 0x0 },
 156	{ NAU8825_REG_BIQ_COF6, 0x0 },
 157	{ NAU8825_REG_BIQ_COF7, 0x0 },
 158	{ NAU8825_REG_BIQ_COF8, 0x0 },
 159	{ NAU8825_REG_BIQ_COF9, 0x0 },
 160	{ NAU8825_REG_BIQ_COF10, 0x0 },
 161	{ NAU8825_REG_ADC_RATE, 0x0010 },
 162	{ NAU8825_REG_DAC_CTRL1, 0x0001 },
 163	{ NAU8825_REG_DAC_CTRL2, 0x0 },
 164	{ NAU8825_REG_DAC_DGAIN_CTRL, 0x0 },
 165	{ NAU8825_REG_ADC_DGAIN_CTRL, 0x00cf },
 166	{ NAU8825_REG_MUTE_CTRL, 0x0 },
 167	{ NAU8825_REG_HSVOL_CTRL, 0x0 },
 168	{ NAU8825_REG_DACL_CTRL, 0x02cf },
 169	{ NAU8825_REG_DACR_CTRL, 0x00cf },
 170	{ NAU8825_REG_ADC_DRC_KNEE_IP12, 0x1486 },
 171	{ NAU8825_REG_ADC_DRC_KNEE_IP34, 0x0f12 },
 172	{ NAU8825_REG_ADC_DRC_SLOPES, 0x25ff },
 173	{ NAU8825_REG_ADC_DRC_ATKDCY, 0x3457 },
 174	{ NAU8825_REG_DAC_DRC_KNEE_IP12, 0x1486 },
 175	{ NAU8825_REG_DAC_DRC_KNEE_IP34, 0x0f12 },
 176	{ NAU8825_REG_DAC_DRC_SLOPES, 0x25f9 },
 177	{ NAU8825_REG_DAC_DRC_ATKDCY, 0x3457 },
 178	{ NAU8825_REG_IMM_MODE_CTRL, 0x0 },
 179	{ NAU8825_REG_CLASSG_CTRL, 0x0 },
 180	{ NAU8825_REG_OPT_EFUSE_CTRL, 0x0 },
 181	{ NAU8825_REG_MISC_CTRL, 0x0 },
 182	{ NAU8825_REG_FLL2_LOWER, 0x0 },
 183	{ NAU8825_REG_FLL2_UPPER, 0x0 },
 184	{ NAU8825_REG_BIAS_ADJ, 0x0 },
 185	{ NAU8825_REG_TRIM_SETTINGS, 0x0 },
 186	{ NAU8825_REG_ANALOG_CONTROL_1, 0x0 },
 187	{ NAU8825_REG_ANALOG_CONTROL_2, 0x0 },
 188	{ NAU8825_REG_ANALOG_ADC_1, 0x0011 },
 189	{ NAU8825_REG_ANALOG_ADC_2, 0x0020 },
 190	{ NAU8825_REG_RDAC, 0x0008 },
 191	{ NAU8825_REG_MIC_BIAS, 0x0006 },
 192	{ NAU8825_REG_BOOST, 0x0 },
 193	{ NAU8825_REG_FEPGA, 0x0 },
 194	{ NAU8825_REG_POWER_UP_CONTROL, 0x0 },
 195	{ NAU8825_REG_CHARGE_PUMP, 0x0 },
 196};
 197
 198/* register backup table when cross talk detection */
 199static struct reg_default nau8825_xtalk_baktab[] = {
 200	{ NAU8825_REG_ADC_DGAIN_CTRL, 0x00cf },
 201	{ NAU8825_REG_HSVOL_CTRL, 0 },
 202	{ NAU8825_REG_DACL_CTRL, 0x00cf },
 203	{ NAU8825_REG_DACR_CTRL, 0x02cf },
 204};
 205
 206/* The regmap patch for Rev C */
 207static const struct reg_sequence nau8825_regmap_patch[] = {
 208	{ NAU8825_REG_FLL2, 0x0000 },
 209	{ NAU8825_REG_FLL4, 0x8010 },
 210	{ NAU8825_REG_FLL_VCO_RSV, 0x0bc0 },
 211	{ NAU8825_REG_INTERRUPT_MASK, 0x0800 },
 212	{ NAU8825_REG_DACL_CTRL, 0x00cf },
 213	{ NAU8825_REG_DACR_CTRL, 0x02cf },
 214	{ NAU8825_REG_OPT_EFUSE_CTRL, 0x0400 },
 215	{ NAU8825_REG_FLL2_LOWER, 0x26e9 },
 216	{ NAU8825_REG_FLL2_UPPER, 0x0031 },
 217	{ NAU8825_REG_ANALOG_CONTROL_2, 0x0020 },
 218	{ NAU8825_REG_ANALOG_ADC_2, 0x0220 },
 219	{ NAU8825_REG_MIC_BIAS, 0x0046 },
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 220};
 221
 222/**
 223 * nau8825_sema_acquire - acquire the semaphore of nau88l25
 224 * @nau8825:  component to register the codec private data with
 225 * @timeout: how long in jiffies to wait before failure or zero to wait
 226 * until release
 227 *
 228 * Attempts to acquire the semaphore with number of jiffies. If no more
 229 * tasks are allowed to acquire the semaphore, calling this function will
 230 * put the task to sleep. If the semaphore is not released within the
 231 * specified number of jiffies, this function returns.
 232 * If the semaphore is not released within the specified number of jiffies,
 233 * this function returns -ETIME. If the sleep is interrupted by a signal,
 234 * this function will return -EINTR. It returns 0 if the semaphore was
 235 * acquired successfully.
 236 *
 237 * Acquires the semaphore without jiffies. Try to acquire the semaphore
 238 * atomically. Returns 0 if the semaphore has been acquired successfully
 239 * or 1 if it cannot be acquired.
 240 */
 241static int nau8825_sema_acquire(struct nau8825 *nau8825, long timeout)
 242{
 243	int ret;
 244
 245	if (timeout) {
 246		ret = down_timeout(&nau8825->xtalk_sem, timeout);
 247		if (ret < 0)
 248			dev_warn(nau8825->dev, "Acquire semaphore timeout\n");
 249	} else {
 250		ret = down_trylock(&nau8825->xtalk_sem);
 251		if (ret)
 252			dev_warn(nau8825->dev, "Acquire semaphore fail\n");
 253	}
 254
 255	return ret;
 256}
 257
 258/**
 259 * nau8825_sema_release - release the semaphore of nau88l25
 260 * @nau8825:  component to register the codec private data with
 261 *
 262 * Release the semaphore which may be called from any context and
 263 * even by tasks which have never called down().
 264 */
 265static inline void nau8825_sema_release(struct nau8825 *nau8825)
 266{
 267	up(&nau8825->xtalk_sem);
 268}
 269
 270/**
 271 * nau8825_sema_reset - reset the semaphore for nau88l25
 272 * @nau8825:  component to register the codec private data with
 273 *
 274 * Reset the counter of the semaphore. Call this function to restart
 275 * a new round task management.
 276 */
 277static inline void nau8825_sema_reset(struct nau8825 *nau8825)
 278{
 279	nau8825->xtalk_sem.count = 1;
 280}
 281
 282/**
 283 * nau8825_hpvol_ramp - Ramp up the headphone volume change gradually to target level.
 284 *
 285 * @nau8825:  component to register the codec private data with
 286 * @vol_from: the volume to start up
 287 * @vol_to: the target volume
 288 * @step: the volume span to move on
 289 *
 290 * The headphone volume is from 0dB to minimum -54dB and -1dB per step.
 291 * If the volume changes sharp, there is a pop noise heard in headphone. We
 292 * provide the function to ramp up the volume up or down by delaying 10ms
 293 * per step.
 294 */
 295static void nau8825_hpvol_ramp(struct nau8825 *nau8825,
 296	unsigned int vol_from, unsigned int vol_to, unsigned int step)
 297{
 298	unsigned int value, volume, ramp_up, from, to;
 299
 300	if (vol_from == vol_to || step == 0) {
 301		return;
 302	} else if (vol_from < vol_to) {
 303		ramp_up = true;
 304		from = vol_from;
 305		to = vol_to;
 306	} else {
 307		ramp_up = false;
 308		from = vol_to;
 309		to = vol_from;
 310	}
 311	/* only handle volume from 0dB to minimum -54dB */
 312	if (to > NAU8825_HP_VOL_MIN)
 313		to = NAU8825_HP_VOL_MIN;
 314
 315	for (volume = from; volume < to; volume += step) {
 316		if (ramp_up)
 317			value = volume;
 318		else
 319			value = to - volume + from;
 320		regmap_update_bits(nau8825->regmap, NAU8825_REG_HSVOL_CTRL,
 321			NAU8825_HPL_VOL_MASK | NAU8825_HPR_VOL_MASK,
 322			(value << NAU8825_HPL_VOL_SFT) | value);
 323		usleep_range(10000, 10500);
 324	}
 325	if (ramp_up)
 326		value = to;
 327	else
 328		value = from;
 329	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSVOL_CTRL,
 330		NAU8825_HPL_VOL_MASK | NAU8825_HPR_VOL_MASK,
 331		(value << NAU8825_HPL_VOL_SFT) | value);
 332}
 333
 334/**
 335 * nau8825_intlog10_dec3 - Computes log10 of a value, rounding the result to 3 decimal places.
 
 
 336 * @value:  input for log10
 337 *
 338 * return log10(value) * 1000
 339 */
 340static u32 nau8825_intlog10_dec3(u32 value)
 341{
 342	return intlog10(value) / ((1 << 24) / 1000);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 343}
 344
 345/**
 346 * nau8825_xtalk_sidetone - computes cross talk suppression sidetone gain.
 347 *
 348 * @sig_org: orignal signal level
 349 * @sig_cros: cross talk signal level
 350 *
 351 * The orignal and cross talk signal vlues need to be characterized.
 352 * Once these values have been characterized, this sidetone value
 353 * can be converted to decibel with the equation below.
 354 * sidetone = 20 * log (original signal level / crosstalk signal level)
 355 *
 356 * return cross talk sidetone gain
 357 */
 358static u32 nau8825_xtalk_sidetone(u32 sig_org, u32 sig_cros)
 359{
 360	u32 gain, sidetone;
 361
 362	if (WARN_ON(sig_org == 0 || sig_cros == 0))
 363		return 0;
 364
 365	sig_org = nau8825_intlog10_dec3(sig_org);
 366	sig_cros = nau8825_intlog10_dec3(sig_cros);
 367	if (sig_org >= sig_cros)
 368		gain = (sig_org - sig_cros) * 20 + GAIN_AUGMENT;
 369	else
 370		gain = (sig_cros - sig_org) * 20 + GAIN_AUGMENT;
 371	sidetone = SIDETONE_BASE - gain * 2;
 372	sidetone /= 1000;
 373
 374	return sidetone;
 375}
 376
 377static int nau8825_xtalk_baktab_index_by_reg(unsigned int reg)
 378{
 379	int index;
 380
 381	for (index = 0; index < ARRAY_SIZE(nau8825_xtalk_baktab); index++)
 382		if (nau8825_xtalk_baktab[index].reg == reg)
 383			return index;
 384	return -EINVAL;
 385}
 386
 387static void nau8825_xtalk_backup(struct nau8825 *nau8825)
 388{
 389	int i;
 390
 391	if (nau8825->xtalk_baktab_initialized)
 392		return;
 393
 394	/* Backup some register values to backup table */
 395	for (i = 0; i < ARRAY_SIZE(nau8825_xtalk_baktab); i++)
 396		regmap_read(nau8825->regmap, nau8825_xtalk_baktab[i].reg,
 397				&nau8825_xtalk_baktab[i].def);
 398
 399	nau8825->xtalk_baktab_initialized = true;
 400}
 401
 402static void nau8825_xtalk_restore(struct nau8825 *nau8825, bool cause_cancel)
 403{
 404	int i, volume;
 405
 406	if (!nau8825->xtalk_baktab_initialized)
 407		return;
 408
 409	/* Restore register values from backup table; When the driver restores
 410	 * the headphone volume in XTALK_DONE state, it needs recover to
 411	 * original level gradually with 3dB per step for less pop noise.
 412	 * Otherwise, the restore should do ASAP.
 413	 */
 414	for (i = 0; i < ARRAY_SIZE(nau8825_xtalk_baktab); i++) {
 415		if (!cause_cancel && nau8825_xtalk_baktab[i].reg ==
 416			NAU8825_REG_HSVOL_CTRL) {
 417			/* Ramping up the volume change to reduce pop noise */
 418			volume = nau8825_xtalk_baktab[i].def &
 419				NAU8825_HPR_VOL_MASK;
 420			nau8825_hpvol_ramp(nau8825, 0, volume, 3);
 421			continue;
 422		}
 423		regmap_write(nau8825->regmap, nau8825_xtalk_baktab[i].reg,
 424				nau8825_xtalk_baktab[i].def);
 425	}
 426
 427	nau8825->xtalk_baktab_initialized = false;
 428}
 429
 430static void nau8825_xtalk_prepare_dac(struct nau8825 *nau8825)
 431{
 432	/* Enable power of DAC path */
 433	regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 434		NAU8825_ENABLE_DACR | NAU8825_ENABLE_DACL |
 435		NAU8825_ENABLE_ADC | NAU8825_ENABLE_ADC_CLK |
 436		NAU8825_ENABLE_DAC_CLK, NAU8825_ENABLE_DACR |
 437		NAU8825_ENABLE_DACL | NAU8825_ENABLE_ADC |
 438		NAU8825_ENABLE_ADC_CLK | NAU8825_ENABLE_DAC_CLK);
 439	/* Prevent startup click by letting charge pump to ramp up and
 440	 * change bump enable
 441	 */
 442	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 443		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN,
 444		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN);
 445	/* Enable clock sync of DAC and DAC clock */
 446	regmap_update_bits(nau8825->regmap, NAU8825_REG_RDAC,
 447		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN |
 448		NAU8825_RDAC_FS_BCLK_ENB,
 449		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN);
 450	/* Power up output driver with 2 stage */
 451	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 452		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 453		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L,
 454		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 455		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L);
 456	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 457		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L,
 458		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L);
 459	/* HP outputs not shouted to ground  */
 460	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSD_CTRL,
 461		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L, 0);
 462	/* Enable HP boost driver */
 463	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 464		NAU8825_HP_BOOST_DIS, NAU8825_HP_BOOST_DIS);
 465	/* Enable class G compare path to supply 1.8V or 0.9V. */
 466	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLASSG_CTRL,
 467		NAU8825_CLASSG_LDAC_EN | NAU8825_CLASSG_RDAC_EN,
 468		NAU8825_CLASSG_LDAC_EN | NAU8825_CLASSG_RDAC_EN);
 469}
 470
 471static void nau8825_xtalk_prepare_adc(struct nau8825 *nau8825)
 472{
 473	/* Power up left ADC and raise 5dB than Vmid for Vref  */
 474	regmap_update_bits(nau8825->regmap, NAU8825_REG_ANALOG_ADC_2,
 475		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_MASK,
 476		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_VMID_PLUS_0_5DB);
 477}
 478
 479static void nau8825_xtalk_clock(struct nau8825 *nau8825)
 480{
 481	/* Recover FLL default value */
 482	regmap_write(nau8825->regmap, NAU8825_REG_FLL1, 0x0);
 483	regmap_write(nau8825->regmap, NAU8825_REG_FLL2, 0x3126);
 484	regmap_write(nau8825->regmap, NAU8825_REG_FLL3, 0x0008);
 485	regmap_write(nau8825->regmap, NAU8825_REG_FLL4, 0x0010);
 486	regmap_write(nau8825->regmap, NAU8825_REG_FLL5, 0x0);
 487	regmap_write(nau8825->regmap, NAU8825_REG_FLL6, 0x6000);
 488	/* Enable internal VCO clock for detection signal generated */
 489	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
 490		NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
 491	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6, NAU8825_DCO_EN,
 492		NAU8825_DCO_EN);
 493	/* Given specific clock frequency of internal clock to
 494	 * generate signal.
 495	 */
 496	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
 497		NAU8825_CLK_MCLK_SRC_MASK, 0xf);
 498	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL1,
 499		NAU8825_FLL_RATIO_MASK, 0x10);
 500}
 501
 502static void nau8825_xtalk_prepare(struct nau8825 *nau8825)
 503{
 504	int volume, index;
 505
 506	/* Backup those registers changed by cross talk detection */
 507	nau8825_xtalk_backup(nau8825);
 508	/* Config IIS as master to output signal by codec */
 509	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
 510		NAU8825_I2S_MS_MASK | NAU8825_I2S_LRC_DIV_MASK |
 511		NAU8825_I2S_BLK_DIV_MASK, NAU8825_I2S_MS_MASTER |
 512		(0x2 << NAU8825_I2S_LRC_DIV_SFT) | 0x1);
 513	/* Ramp up headphone volume to 0dB to get better performance and
 514	 * avoid pop noise in headphone.
 515	 */
 516	index = nau8825_xtalk_baktab_index_by_reg(NAU8825_REG_HSVOL_CTRL);
 517	if (index != -EINVAL) {
 518		volume = nau8825_xtalk_baktab[index].def &
 519				NAU8825_HPR_VOL_MASK;
 520		nau8825_hpvol_ramp(nau8825, volume, 0, 3);
 521	}
 522	nau8825_xtalk_clock(nau8825);
 523	nau8825_xtalk_prepare_dac(nau8825);
 524	nau8825_xtalk_prepare_adc(nau8825);
 525	/* Config channel path and digital gain */
 526	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACL_CTRL,
 527		NAU8825_DACL_CH_SEL_MASK | NAU8825_DACL_CH_VOL_MASK,
 528		NAU8825_DACL_CH_SEL_L | 0xab);
 529	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACR_CTRL,
 530		NAU8825_DACR_CH_SEL_MASK | NAU8825_DACR_CH_VOL_MASK,
 531		NAU8825_DACR_CH_SEL_R | 0xab);
 532	/* Config cross talk parameters and generate the 23Hz sine wave with
 533	 * 1/16 full scale of signal level for impedance measurement.
 534	 */
 535	regmap_update_bits(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL,
 536		NAU8825_IMM_THD_MASK | NAU8825_IMM_GEN_VOL_MASK |
 537		NAU8825_IMM_CYC_MASK | NAU8825_IMM_DAC_SRC_MASK,
 538		(0x9 << NAU8825_IMM_THD_SFT) | NAU8825_IMM_GEN_VOL_1_16th |
 539		NAU8825_IMM_CYC_8192 | NAU8825_IMM_DAC_SRC_SIN);
 540	/* RMS intrruption enable */
 541	regmap_update_bits(nau8825->regmap,
 542		NAU8825_REG_INTERRUPT_MASK, NAU8825_IRQ_RMS_EN, 0);
 543	/* Power up left and right DAC */
 544	if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
 545		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 546				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL, 0);
 547	else
 548		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 549				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
 550				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 551}
 552
 553static void nau8825_xtalk_clean_dac(struct nau8825 *nau8825)
 554{
 555	/* Disable HP boost driver */
 556	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 557		NAU8825_HP_BOOST_DIS, 0);
 558	/* HP outputs shouted to ground  */
 559	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSD_CTRL,
 560		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L,
 561		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
 562	/* Power down left and right DAC */
 563	if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
 564		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 565				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
 566				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 567	else
 568		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 569				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL, 0);
 570
 571	/* Enable the TESTDAC and  disable L/R HP impedance */
 572	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 573		NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP |
 574		NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
 575	/* Power down output driver with 2 stage */
 576	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 577		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L, 0);
 578	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 579		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 580		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L, 0);
 581	/* Disable clock sync of DAC and DAC clock */
 582	regmap_update_bits(nau8825->regmap, NAU8825_REG_RDAC,
 583		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN, 0);
 584	/* Disable charge pump ramp up function and change bump */
 585	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 586		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN, 0);
 587	/* Disable power of DAC path */
 588	regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 589		NAU8825_ENABLE_DACR | NAU8825_ENABLE_DACL |
 590		NAU8825_ENABLE_ADC_CLK | NAU8825_ENABLE_DAC_CLK, 0);
 591	if (!nau8825->irq)
 592		regmap_update_bits(nau8825->regmap,
 593			NAU8825_REG_ENA_CTRL, NAU8825_ENABLE_ADC, 0);
 594}
 595
 596static void nau8825_xtalk_clean_adc(struct nau8825 *nau8825)
 597{
 598	/* Power down left ADC and restore voltage to Vmid */
 599	regmap_update_bits(nau8825->regmap, NAU8825_REG_ANALOG_ADC_2,
 600		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_MASK, 0);
 601}
 602
 603static void nau8825_xtalk_clean(struct nau8825 *nau8825, bool cause_cancel)
 604{
 605	/* Enable internal VCO needed for interruptions */
 606	nau8825_configure_sysclk(nau8825, NAU8825_CLK_INTERNAL, 0);
 607	nau8825_xtalk_clean_dac(nau8825);
 608	nau8825_xtalk_clean_adc(nau8825);
 609	/* Clear cross talk parameters and disable */
 610	regmap_write(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL, 0);
 611	/* RMS intrruption disable */
 612	regmap_update_bits(nau8825->regmap, NAU8825_REG_INTERRUPT_MASK,
 613		NAU8825_IRQ_RMS_EN, NAU8825_IRQ_RMS_EN);
 614	/* Recover default value for IIS */
 615	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
 616		NAU8825_I2S_MS_MASK | NAU8825_I2S_LRC_DIV_MASK |
 617		NAU8825_I2S_BLK_DIV_MASK, NAU8825_I2S_MS_SLAVE);
 618	/* Restore value of specific register for cross talk */
 619	nau8825_xtalk_restore(nau8825, cause_cancel);
 620}
 621
 622static void nau8825_xtalk_imm_start(struct nau8825 *nau8825, int vol)
 623{
 624	/* Apply ADC volume for better cross talk performance */
 625	regmap_update_bits(nau8825->regmap, NAU8825_REG_ADC_DGAIN_CTRL,
 626				NAU8825_ADC_DIG_VOL_MASK, vol);
 627	/* Disables JKTIP(HPL) DAC channel for right to left measurement.
 628	 * Do it before sending signal in order to erase pop noise.
 629	 */
 630	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 631		NAU8825_BIAS_TESTDACR_EN | NAU8825_BIAS_TESTDACL_EN,
 632		NAU8825_BIAS_TESTDACL_EN);
 633	switch (nau8825->xtalk_state) {
 634	case NAU8825_XTALK_HPR_R2L:
 635		/* Enable right headphone impedance */
 636		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 637			NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP,
 638			NAU8825_BIAS_HPR_IMP);
 639		break;
 640	case NAU8825_XTALK_HPL_R2L:
 641		/* Enable left headphone impedance */
 642		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 643			NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP,
 644			NAU8825_BIAS_HPL_IMP);
 645		break;
 646	default:
 647		break;
 648	}
 649	msleep(100);
 650	/* Impedance measurement mode enable */
 651	regmap_update_bits(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL,
 652				NAU8825_IMM_EN, NAU8825_IMM_EN);
 653}
 654
 655static void nau8825_xtalk_imm_stop(struct nau8825 *nau8825)
 656{
 657	/* Impedance measurement mode disable */
 658	regmap_update_bits(nau8825->regmap,
 659		NAU8825_REG_IMM_MODE_CTRL, NAU8825_IMM_EN, 0);
 660}
 661
 662/* The cross talk measurement function can reduce cross talk across the
 663 * JKTIP(HPL) and JKR1(HPR) outputs which measures the cross talk signal
 664 * level to determine what cross talk reduction gain is. This system works by
 665 * sending a 23Hz -24dBV sine wave into the headset output DAC and through
 666 * the PGA. The output of the PGA is then connected to an internal current
 667 * sense which measures the attenuated 23Hz signal and passing the output to
 668 * an ADC which converts the measurement to a binary code. With two separated
 669 * measurement, one for JKR1(HPR) and the other JKTIP(HPL), measurement data
 670 * can be separated read in IMM_RMS_L for HSR and HSL after each measurement.
 671 * Thus, the measurement function has four states to complete whole sequence.
 672 * 1. Prepare state : Prepare the resource for detection and transfer to HPR
 673 *     IMM stat to make JKR1(HPR) impedance measure.
 674 * 2. HPR IMM state : Read out orignal signal level of JKR1(HPR) and transfer
 675 *     to HPL IMM state to make JKTIP(HPL) impedance measure.
 676 * 3. HPL IMM state : Read out cross talk signal level of JKTIP(HPL) and
 677 *     transfer to IMM state to determine suppression sidetone gain.
 678 * 4. IMM state : Computes cross talk suppression sidetone gain with orignal
 679 *     and cross talk signal level. Apply this gain and then restore codec
 680 *     configuration. Then transfer to Done state for ending.
 681 */
 682static void nau8825_xtalk_measure(struct nau8825 *nau8825)
 683{
 684	u32 sidetone;
 685
 686	switch (nau8825->xtalk_state) {
 687	case NAU8825_XTALK_PREPARE:
 688		/* In prepare state, set up clock, intrruption, DAC path, ADC
 689		 * path and cross talk detection parameters for preparation.
 690		 */
 691		nau8825_xtalk_prepare(nau8825);
 692		msleep(280);
 693		/* Trigger right headphone impedance detection */
 694		nau8825->xtalk_state = NAU8825_XTALK_HPR_R2L;
 695		nau8825_xtalk_imm_start(nau8825, 0x00d2);
 696		break;
 697	case NAU8825_XTALK_HPR_R2L:
 698		/* In right headphone IMM state, read out right headphone
 699		 * impedance measure result, and then start up left side.
 700		 */
 701		regmap_read(nau8825->regmap, NAU8825_REG_IMM_RMS_L,
 702			&nau8825->imp_rms[NAU8825_XTALK_HPR_R2L]);
 703		dev_dbg(nau8825->dev, "HPR_R2L imm: %x\n",
 704			nau8825->imp_rms[NAU8825_XTALK_HPR_R2L]);
 705		/* Disable then re-enable IMM mode to update */
 706		nau8825_xtalk_imm_stop(nau8825);
 707		/* Trigger left headphone impedance detection */
 708		nau8825->xtalk_state = NAU8825_XTALK_HPL_R2L;
 709		nau8825_xtalk_imm_start(nau8825, 0x00ff);
 710		break;
 711	case NAU8825_XTALK_HPL_R2L:
 712		/* In left headphone IMM state, read out left headphone
 713		 * impedance measure result, and delay some time to wait
 714		 * detection sine wave output finish. Then, we can calculate
 715		 * the cross talk suppresstion side tone according to the L/R
 716		 * headphone imedance.
 717		 */
 718		regmap_read(nau8825->regmap, NAU8825_REG_IMM_RMS_L,
 719			&nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 720		dev_dbg(nau8825->dev, "HPL_R2L imm: %x\n",
 721			nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 722		nau8825_xtalk_imm_stop(nau8825);
 723		msleep(150);
 724		nau8825->xtalk_state = NAU8825_XTALK_IMM;
 725		break;
 726	case NAU8825_XTALK_IMM:
 727		/* In impedance measure state, the orignal and cross talk
 728		 * signal level vlues are ready. The side tone gain is deter-
 729		 * mined with these signal level. After all, restore codec
 730		 * configuration.
 731		 */
 732		sidetone = nau8825_xtalk_sidetone(
 733			nau8825->imp_rms[NAU8825_XTALK_HPR_R2L],
 734			nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 735		dev_dbg(nau8825->dev, "cross talk sidetone: %x\n", sidetone);
 736		regmap_write(nau8825->regmap, NAU8825_REG_DAC_DGAIN_CTRL,
 737					(sidetone << 8) | sidetone);
 738		nau8825_xtalk_clean(nau8825, false);
 739		nau8825->xtalk_state = NAU8825_XTALK_DONE;
 740		break;
 741	default:
 742		break;
 743	}
 744}
 745
 746static void nau8825_xtalk_work(struct work_struct *work)
 747{
 748	struct nau8825 *nau8825 = container_of(
 749		work, struct nau8825, xtalk_work);
 750
 751	nau8825_xtalk_measure(nau8825);
 752	/* To determine the cross talk side tone gain when reach
 753	 * the impedance measure state.
 754	 */
 755	if (nau8825->xtalk_state == NAU8825_XTALK_IMM)
 756		nau8825_xtalk_measure(nau8825);
 757
 758	/* Delay jack report until cross talk detection process
 759	 * completed. It can avoid application to do playback
 760	 * preparation before cross talk detection is still working.
 761	 * Meanwhile, the protection of the cross talk detection
 762	 * is released.
 763	 */
 764	if (nau8825->xtalk_state == NAU8825_XTALK_DONE) {
 765		snd_soc_jack_report(nau8825->jack, nau8825->xtalk_event,
 766				nau8825->xtalk_event_mask);
 767		nau8825_sema_release(nau8825);
 768		nau8825->xtalk_protect = false;
 769	}
 770}
 771
 772static void nau8825_xtalk_cancel(struct nau8825 *nau8825)
 773{
 774	/* If the crosstalk is eanbled and the process is on going,
 775	 * the driver forces to cancel the crosstalk task and
 776	 * restores the configuration to original status.
 777	 */
 778	if (nau8825->xtalk_enable && nau8825->xtalk_state !=
 779		NAU8825_XTALK_DONE) {
 780		cancel_work_sync(&nau8825->xtalk_work);
 781		nau8825_xtalk_clean(nau8825, true);
 782	}
 783	/* Reset parameters for cross talk suppression function */
 784	nau8825_sema_reset(nau8825);
 785	nau8825->xtalk_state = NAU8825_XTALK_DONE;
 786	nau8825->xtalk_protect = false;
 787}
 788
 789static bool nau8825_readable_reg(struct device *dev, unsigned int reg)
 790{
 791	switch (reg) {
 792	case NAU8825_REG_ENA_CTRL ... NAU8825_REG_FLL_VCO_RSV:
 793	case NAU8825_REG_HSD_CTRL ... NAU8825_REG_JACK_DET_CTRL:
 794	case NAU8825_REG_INTERRUPT_MASK ... NAU8825_REG_KEYDET_CTRL:
 795	case NAU8825_REG_VDET_THRESHOLD_1 ... NAU8825_REG_DACR_CTRL:
 796	case NAU8825_REG_ADC_DRC_KNEE_IP12 ... NAU8825_REG_ADC_DRC_ATKDCY:
 797	case NAU8825_REG_DAC_DRC_KNEE_IP12 ... NAU8825_REG_DAC_DRC_ATKDCY:
 798	case NAU8825_REG_IMM_MODE_CTRL ... NAU8825_REG_IMM_RMS_R:
 799	case NAU8825_REG_CLASSG_CTRL ... NAU8825_REG_OPT_EFUSE_CTRL:
 800	case NAU8825_REG_MISC_CTRL:
 801	case NAU8825_REG_I2C_DEVICE_ID ... NAU8825_REG_FLL2_UPPER:
 802	case NAU8825_REG_BIAS_ADJ:
 803	case NAU8825_REG_TRIM_SETTINGS ... NAU8825_REG_ANALOG_CONTROL_2:
 804	case NAU8825_REG_ANALOG_ADC_1 ... NAU8825_REG_MIC_BIAS:
 805	case NAU8825_REG_BOOST ... NAU8825_REG_FEPGA:
 806	case NAU8825_REG_POWER_UP_CONTROL ... NAU8825_REG_GENERAL_STATUS:
 807		return true;
 808	default:
 809		return false;
 810	}
 811
 812}
 813
 814static bool nau8825_writeable_reg(struct device *dev, unsigned int reg)
 815{
 816	switch (reg) {
 817	case NAU8825_REG_RESET ... NAU8825_REG_FLL_VCO_RSV:
 818	case NAU8825_REG_HSD_CTRL ... NAU8825_REG_JACK_DET_CTRL:
 819	case NAU8825_REG_INTERRUPT_MASK:
 820	case NAU8825_REG_INT_CLR_KEY_STATUS ... NAU8825_REG_KEYDET_CTRL:
 821	case NAU8825_REG_VDET_THRESHOLD_1 ... NAU8825_REG_DACR_CTRL:
 822	case NAU8825_REG_ADC_DRC_KNEE_IP12 ... NAU8825_REG_ADC_DRC_ATKDCY:
 823	case NAU8825_REG_DAC_DRC_KNEE_IP12 ... NAU8825_REG_DAC_DRC_ATKDCY:
 824	case NAU8825_REG_IMM_MODE_CTRL:
 825	case NAU8825_REG_CLASSG_CTRL ... NAU8825_REG_OPT_EFUSE_CTRL:
 826	case NAU8825_REG_MISC_CTRL:
 827	case NAU8825_REG_FLL2_LOWER ... NAU8825_REG_FLL2_UPPER:
 828	case NAU8825_REG_BIAS_ADJ:
 829	case NAU8825_REG_TRIM_SETTINGS ... NAU8825_REG_ANALOG_CONTROL_2:
 830	case NAU8825_REG_ANALOG_ADC_1 ... NAU8825_REG_MIC_BIAS:
 831	case NAU8825_REG_BOOST ... NAU8825_REG_FEPGA:
 832	case NAU8825_REG_POWER_UP_CONTROL ... NAU8825_REG_CHARGE_PUMP:
 833		return true;
 834	default:
 835		return false;
 836	}
 837}
 838
 839static bool nau8825_volatile_reg(struct device *dev, unsigned int reg)
 840{
 841	switch (reg) {
 842	case NAU8825_REG_RESET:
 843	case NAU8825_REG_IRQ_STATUS:
 844	case NAU8825_REG_INT_CLR_KEY_STATUS:
 845	case NAU8825_REG_IMM_RMS_L:
 846	case NAU8825_REG_IMM_RMS_R:
 847	case NAU8825_REG_I2C_DEVICE_ID:
 848	case NAU8825_REG_SARDOUT_RAM_STATUS:
 849	case NAU8825_REG_CHARGE_PUMP_INPUT_READ:
 850	case NAU8825_REG_GENERAL_STATUS:
 851	case NAU8825_REG_BIQ_CTRL ... NAU8825_REG_BIQ_COF10:
 852		return true;
 853	default:
 854		return false;
 855	}
 856}
 857
 858static int nau8825_fepga_event(struct snd_soc_dapm_widget *w,
 859			       struct snd_kcontrol *kcontrol, int event)
 860{
 861	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 862	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 863
 864	switch (event) {
 865	case SND_SOC_DAPM_POST_PMU:
 866		regmap_update_bits(nau8825->regmap, NAU8825_REG_FEPGA,
 867				   NAU8825_ACDC_CTRL_MASK,
 868				   NAU8825_ACDC_VREF_MICP | NAU8825_ACDC_VREF_MICN);
 869		regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 870				   NAU8825_DISCHRG_EN, NAU8825_DISCHRG_EN);
 871		msleep(40);
 872		regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 873				   NAU8825_DISCHRG_EN, 0);
 874		regmap_update_bits(nau8825->regmap, NAU8825_REG_FEPGA,
 875				   NAU8825_ACDC_CTRL_MASK, 0);
 876		break;
 877	default:
 878		break;
 879	}
 880
 881	return 0;
 882}
 883
 884static int nau8825_adc_event(struct snd_soc_dapm_widget *w,
 885		struct snd_kcontrol *kcontrol, int event)
 886{
 887	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 888	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 889
 890	switch (event) {
 891	case SND_SOC_DAPM_POST_PMU:
 892		msleep(nau8825->adc_delay);
 893		regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 894			NAU8825_ENABLE_ADC, NAU8825_ENABLE_ADC);
 895		break;
 896	case SND_SOC_DAPM_POST_PMD:
 897		if (!nau8825->irq)
 898			regmap_update_bits(nau8825->regmap,
 899				NAU8825_REG_ENA_CTRL, NAU8825_ENABLE_ADC, 0);
 900		break;
 901	default:
 902		return -EINVAL;
 903	}
 904
 905	return 0;
 906}
 907
 908static int nau8825_pump_event(struct snd_soc_dapm_widget *w,
 909	struct snd_kcontrol *kcontrol, int event)
 910{
 911	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 912	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 913
 914	switch (event) {
 915	case SND_SOC_DAPM_POST_PMU:
 916		/* Prevent startup click by letting charge pump to ramp up */
 917		msleep(10);
 918		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 919			NAU8825_JAMNODCLOW, NAU8825_JAMNODCLOW);
 920		break;
 921	case SND_SOC_DAPM_PRE_PMD:
 922		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 923			NAU8825_JAMNODCLOW, 0);
 924		break;
 925	default:
 926		return -EINVAL;
 927	}
 928
 929	return 0;
 930}
 931
 932static int nau8825_output_dac_event(struct snd_soc_dapm_widget *w,
 933	struct snd_kcontrol *kcontrol, int event)
 934{
 935	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 936	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 937
 938	switch (event) {
 939	case SND_SOC_DAPM_PRE_PMU:
 940		/* Disables the TESTDAC to let DAC signal pass through. */
 941		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 942			NAU8825_BIAS_TESTDAC_EN, 0);
 943		if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
 944			regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 945					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL, 0);
 946		else
 947			regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 948					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
 949					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 950		break;
 951	case SND_SOC_DAPM_POST_PMD:
 952		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 953			NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
 954		if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
 955			regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 956					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
 957					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 958		else
 959			regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 960					   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL, 0);
 961
 962		break;
 963	default:
 964		return -EINVAL;
 965	}
 966
 967	return 0;
 968}
 969
 970static int system_clock_control(struct snd_soc_dapm_widget *w,
 971				struct snd_kcontrol *k, int  event)
 972{
 973	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 974	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 975	struct regmap *regmap = nau8825->regmap;
 976
 977	if (SND_SOC_DAPM_EVENT_OFF(event)) {
 978		dev_dbg(nau8825->dev, "system clock control : POWER OFF\n");
 979		/* Set clock source to disable or internal clock before the
 980		 * playback or capture end. Codec needs clock for Jack
 981		 * detection and button press if jack inserted; otherwise,
 982		 * the clock should be closed.
 983		 */
 984		if (nau8825_is_jack_inserted(regmap)) {
 985			nau8825_configure_sysclk(nau8825,
 986						 NAU8825_CLK_INTERNAL, 0);
 987		} else {
 988			nau8825_configure_sysclk(nau8825, NAU8825_CLK_DIS, 0);
 989		}
 990	}
 991
 992	return 0;
 993}
 994
 995static int nau8825_biq_coeff_get(struct snd_kcontrol *kcontrol,
 996				     struct snd_ctl_elem_value *ucontrol)
 997{
 998	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
 999	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
1000
1001	if (!component->regmap)
1002		return -EINVAL;
1003
1004	regmap_raw_read(component->regmap, NAU8825_REG_BIQ_COF1,
1005		ucontrol->value.bytes.data, params->max);
1006	return 0;
1007}
1008
1009static int nau8825_biq_coeff_put(struct snd_kcontrol *kcontrol,
1010				     struct snd_ctl_elem_value *ucontrol)
1011{
1012	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1013	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
1014	void *data;
1015
1016	if (!component->regmap)
1017		return -EINVAL;
1018
1019	data = kmemdup(ucontrol->value.bytes.data,
1020		params->max, GFP_KERNEL | GFP_DMA);
1021	if (!data)
1022		return -ENOMEM;
1023
1024	regmap_update_bits(component->regmap, NAU8825_REG_BIQ_CTRL,
1025		NAU8825_BIQ_WRT_EN, 0);
1026	regmap_raw_write(component->regmap, NAU8825_REG_BIQ_COF1,
1027		data, params->max);
1028	regmap_update_bits(component->regmap, NAU8825_REG_BIQ_CTRL,
1029		NAU8825_BIQ_WRT_EN, NAU8825_BIQ_WRT_EN);
1030
1031	kfree(data);
1032	return 0;
1033}
1034
1035static const char * const nau8825_biq_path[] = {
1036	"ADC", "DAC"
1037};
1038
1039static const struct soc_enum nau8825_biq_path_enum =
1040	SOC_ENUM_SINGLE(NAU8825_REG_BIQ_CTRL, NAU8825_BIQ_PATH_SFT,
1041		ARRAY_SIZE(nau8825_biq_path), nau8825_biq_path);
1042
1043static const char * const nau8825_adc_decimation[] = {
1044	"32", "64", "128", "256"
1045};
1046
1047static const struct soc_enum nau8825_adc_decimation_enum =
1048	SOC_ENUM_SINGLE(NAU8825_REG_ADC_RATE, NAU8825_ADC_SYNC_DOWN_SFT,
1049		ARRAY_SIZE(nau8825_adc_decimation), nau8825_adc_decimation);
1050
1051static const char * const nau8825_dac_oversampl[] = {
1052	"64", "256", "128", "", "32"
1053};
1054
1055static const struct soc_enum nau8825_dac_oversampl_enum =
1056	SOC_ENUM_SINGLE(NAU8825_REG_DAC_CTRL1, NAU8825_DAC_OVERSAMPLE_SFT,
1057		ARRAY_SIZE(nau8825_dac_oversampl), nau8825_dac_oversampl);
1058
1059static const DECLARE_TLV_DB_MINMAX_MUTE(adc_vol_tlv, -10300, 2400);
1060static const DECLARE_TLV_DB_MINMAX_MUTE(sidetone_vol_tlv, -4200, 0);
1061static const DECLARE_TLV_DB_MINMAX(dac_vol_tlv, -5400, 0);
1062static const DECLARE_TLV_DB_MINMAX(fepga_gain_tlv, -100, 3600);
1063static const DECLARE_TLV_DB_MINMAX_MUTE(crosstalk_vol_tlv, -9600, 2400);
1064
1065static const struct snd_kcontrol_new nau8825_controls[] = {
1066	SOC_SINGLE_TLV("Mic Volume", NAU8825_REG_ADC_DGAIN_CTRL,
1067		0, 0xff, 0, adc_vol_tlv),
1068	SOC_DOUBLE_TLV("Headphone Bypass Volume", NAU8825_REG_ADC_DGAIN_CTRL,
1069		12, 8, 0x0f, 0, sidetone_vol_tlv),
1070	SOC_DOUBLE_TLV("Headphone Volume", NAU8825_REG_HSVOL_CTRL,
1071		6, 0, 0x3f, 1, dac_vol_tlv),
1072	SOC_SINGLE_TLV("Frontend PGA Volume", NAU8825_REG_POWER_UP_CONTROL,
1073		8, 37, 0, fepga_gain_tlv),
1074	SOC_DOUBLE_TLV("Headphone Crosstalk Volume", NAU8825_REG_DAC_DGAIN_CTRL,
1075		0, 8, 0xff, 0, crosstalk_vol_tlv),
1076
1077	SOC_ENUM("ADC Decimation Rate", nau8825_adc_decimation_enum),
1078	SOC_ENUM("DAC Oversampling Rate", nau8825_dac_oversampl_enum),
1079	/* programmable biquad filter */
1080	SOC_ENUM("BIQ Path Select", nau8825_biq_path_enum),
1081	SND_SOC_BYTES_EXT("BIQ Coefficients", 20,
1082		  nau8825_biq_coeff_get, nau8825_biq_coeff_put),
1083};
1084
1085/* DAC Mux 0x33[9] and 0x34[9] */
1086static const char * const nau8825_dac_src[] = {
1087	"DACL", "DACR",
1088};
1089
1090static SOC_ENUM_SINGLE_DECL(
1091	nau8825_dacl_enum, NAU8825_REG_DACL_CTRL,
1092	NAU8825_DACL_CH_SEL_SFT, nau8825_dac_src);
1093
1094static SOC_ENUM_SINGLE_DECL(
1095	nau8825_dacr_enum, NAU8825_REG_DACR_CTRL,
1096	NAU8825_DACR_CH_SEL_SFT, nau8825_dac_src);
1097
1098static const struct snd_kcontrol_new nau8825_dacl_mux =
1099	SOC_DAPM_ENUM("DACL Source", nau8825_dacl_enum);
1100
1101static const struct snd_kcontrol_new nau8825_dacr_mux =
1102	SOC_DAPM_ENUM("DACR Source", nau8825_dacr_enum);
1103
1104
1105static const struct snd_soc_dapm_widget nau8825_dapm_widgets[] = {
1106	SND_SOC_DAPM_AIF_OUT("AIFTX", "Capture", 0, NAU8825_REG_I2S_PCM_CTRL2,
1107		15, 1),
1108	SND_SOC_DAPM_AIF_IN("AIFRX", "Playback", 0, SND_SOC_NOPM, 0, 0),
1109	SND_SOC_DAPM_SUPPLY("System Clock", SND_SOC_NOPM, 0, 0,
1110			    system_clock_control, SND_SOC_DAPM_POST_PMD),
1111
1112	SND_SOC_DAPM_INPUT("MIC"),
1113	SND_SOC_DAPM_MICBIAS("MICBIAS", NAU8825_REG_MIC_BIAS, 8, 0),
1114
1115	SND_SOC_DAPM_PGA_E("Frontend PGA", NAU8825_REG_POWER_UP_CONTROL, 14, 0,
1116			   NULL, 0, nau8825_fepga_event, SND_SOC_DAPM_POST_PMU),
1117
1118	SND_SOC_DAPM_ADC_E("ADC", NULL, SND_SOC_NOPM, 0, 0,
1119		nau8825_adc_event, SND_SOC_DAPM_POST_PMU |
1120		SND_SOC_DAPM_POST_PMD),
1121	SND_SOC_DAPM_SUPPLY("ADC Clock", NAU8825_REG_ENA_CTRL, 7, 0, NULL, 0),
1122	SND_SOC_DAPM_SUPPLY("ADC Power", NAU8825_REG_ANALOG_ADC_2, 6, 0, NULL,
1123		0),
1124
1125	/* ADC for button press detection. A dapm supply widget is used to
1126	 * prevent dapm_power_widgets keeping the codec at SND_SOC_BIAS_ON
1127	 * during suspend.
1128	 */
1129	SND_SOC_DAPM_SUPPLY("SAR", NAU8825_REG_SAR_CTRL,
1130		NAU8825_SAR_ADC_EN_SFT, 0, NULL, 0),
1131
1132	SND_SOC_DAPM_PGA_S("ADACL", 2, NAU8825_REG_RDAC, 12, 0, NULL, 0),
1133	SND_SOC_DAPM_PGA_S("ADACR", 2, NAU8825_REG_RDAC, 13, 0, NULL, 0),
1134	SND_SOC_DAPM_PGA_S("ADACL Clock", 3, NAU8825_REG_RDAC, 8, 0, NULL, 0),
1135	SND_SOC_DAPM_PGA_S("ADACR Clock", 3, NAU8825_REG_RDAC, 9, 0, NULL, 0),
1136
1137	SND_SOC_DAPM_DAC("DDACR", NULL, NAU8825_REG_ENA_CTRL,
1138		NAU8825_ENABLE_DACR_SFT, 0),
1139	SND_SOC_DAPM_DAC("DDACL", NULL, NAU8825_REG_ENA_CTRL,
1140		NAU8825_ENABLE_DACL_SFT, 0),
1141	SND_SOC_DAPM_SUPPLY("DDAC Clock", NAU8825_REG_ENA_CTRL, 6, 0, NULL, 0),
1142
1143	SND_SOC_DAPM_MUX("DACL Mux", SND_SOC_NOPM, 0, 0, &nau8825_dacl_mux),
1144	SND_SOC_DAPM_MUX("DACR Mux", SND_SOC_NOPM, 0, 0, &nau8825_dacr_mux),
1145
1146	SND_SOC_DAPM_PGA_S("HP amp L", 0,
1147		NAU8825_REG_CLASSG_CTRL, 1, 0, NULL, 0),
1148	SND_SOC_DAPM_PGA_S("HP amp R", 0,
1149		NAU8825_REG_CLASSG_CTRL, 2, 0, NULL, 0),
1150
1151	SND_SOC_DAPM_PGA_S("Charge Pump", 1, NAU8825_REG_CHARGE_PUMP, 5, 0,
1152		nau8825_pump_event, SND_SOC_DAPM_POST_PMU |
1153		SND_SOC_DAPM_PRE_PMD),
1154
1155	SND_SOC_DAPM_PGA_S("Output Driver R Stage 1", 4,
1156		NAU8825_REG_POWER_UP_CONTROL, 5, 0, NULL, 0),
1157	SND_SOC_DAPM_PGA_S("Output Driver L Stage 1", 4,
1158		NAU8825_REG_POWER_UP_CONTROL, 4, 0, NULL, 0),
1159	SND_SOC_DAPM_PGA_S("Output Driver R Stage 2", 5,
1160		NAU8825_REG_POWER_UP_CONTROL, 3, 0, NULL, 0),
1161	SND_SOC_DAPM_PGA_S("Output Driver L Stage 2", 5,
1162		NAU8825_REG_POWER_UP_CONTROL, 2, 0, NULL, 0),
1163	SND_SOC_DAPM_PGA_S("Output Driver R Stage 3", 6,
1164		NAU8825_REG_POWER_UP_CONTROL, 1, 0, NULL, 0),
1165	SND_SOC_DAPM_PGA_S("Output Driver L Stage 3", 6,
1166		NAU8825_REG_POWER_UP_CONTROL, 0, 0, NULL, 0),
1167
1168	SND_SOC_DAPM_PGA_S("Output DACL", 7,
1169		SND_SOC_NOPM, 0, 0, nau8825_output_dac_event,
1170		SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1171	SND_SOC_DAPM_PGA_S("Output DACR", 7,
1172		SND_SOC_NOPM, 0, 0, nau8825_output_dac_event,
1173		SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1174
1175
1176	/* HPOL/R are ungrounded by disabling 16 Ohm pull-downs on playback */
1177	SND_SOC_DAPM_PGA_S("HPOL Pulldown", 8,
1178		NAU8825_REG_HSD_CTRL, 0, 1, NULL, 0),
1179	SND_SOC_DAPM_PGA_S("HPOR Pulldown", 8,
1180		NAU8825_REG_HSD_CTRL, 1, 1, NULL, 0),
1181
1182	/* High current HPOL/R boost driver */
1183	SND_SOC_DAPM_PGA_S("HP Boost Driver", 9,
1184		NAU8825_REG_BOOST, 9, 1, NULL, 0),
1185
1186	/* Class G operation control*/
1187	SND_SOC_DAPM_PGA_S("Class G", 10,
1188		NAU8825_REG_CLASSG_CTRL, 0, 0, NULL, 0),
1189
1190	SND_SOC_DAPM_OUTPUT("HPOL"),
1191	SND_SOC_DAPM_OUTPUT("HPOR"),
1192};
1193
1194static const struct snd_soc_dapm_route nau8825_dapm_routes[] = {
1195	{"Frontend PGA", NULL, "MIC"},
1196	{"ADC", NULL, "Frontend PGA"},
1197	{"ADC", NULL, "ADC Clock"},
1198	{"ADC", NULL, "ADC Power"},
1199	{"AIFTX", NULL, "ADC"},
1200	{"AIFTX", NULL, "System Clock"},
1201
1202	{"AIFRX", NULL, "System Clock"},
1203	{"DDACL", NULL, "AIFRX"},
1204	{"DDACR", NULL, "AIFRX"},
1205	{"DDACL", NULL, "DDAC Clock"},
1206	{"DDACR", NULL, "DDAC Clock"},
1207	{"DACL Mux", "DACL", "DDACL"},
1208	{"DACL Mux", "DACR", "DDACR"},
1209	{"DACR Mux", "DACL", "DDACL"},
1210	{"DACR Mux", "DACR", "DDACR"},
1211	{"HP amp L", NULL, "DACL Mux"},
1212	{"HP amp R", NULL, "DACR Mux"},
1213	{"Charge Pump", NULL, "HP amp L"},
1214	{"Charge Pump", NULL, "HP amp R"},
1215	{"ADACL", NULL, "Charge Pump"},
1216	{"ADACR", NULL, "Charge Pump"},
1217	{"ADACL Clock", NULL, "ADACL"},
1218	{"ADACR Clock", NULL, "ADACR"},
1219	{"Output Driver L Stage 1", NULL, "ADACL Clock"},
1220	{"Output Driver R Stage 1", NULL, "ADACR Clock"},
1221	{"Output Driver L Stage 2", NULL, "Output Driver L Stage 1"},
1222	{"Output Driver R Stage 2", NULL, "Output Driver R Stage 1"},
1223	{"Output Driver L Stage 3", NULL, "Output Driver L Stage 2"},
1224	{"Output Driver R Stage 3", NULL, "Output Driver R Stage 2"},
1225	{"Output DACL", NULL, "Output Driver L Stage 3"},
1226	{"Output DACR", NULL, "Output Driver R Stage 3"},
1227	{"HPOL Pulldown", NULL, "Output DACL"},
1228	{"HPOR Pulldown", NULL, "Output DACR"},
1229	{"HP Boost Driver", NULL, "HPOL Pulldown"},
1230	{"HP Boost Driver", NULL, "HPOR Pulldown"},
1231	{"Class G", NULL, "HP Boost Driver"},
1232	{"HPOL", NULL, "Class G"},
1233	{"HPOR", NULL, "Class G"},
1234};
1235
1236static const struct nau8825_osr_attr *
1237nau8825_get_osr(struct nau8825 *nau8825, int stream)
1238{
1239	unsigned int osr;
1240
1241	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1242		regmap_read(nau8825->regmap,
1243			    NAU8825_REG_DAC_CTRL1, &osr);
1244		osr &= NAU8825_DAC_OVERSAMPLE_MASK;
1245		if (osr >= ARRAY_SIZE(osr_dac_sel))
1246			return NULL;
1247		return &osr_dac_sel[osr];
1248	} else {
1249		regmap_read(nau8825->regmap,
1250			    NAU8825_REG_ADC_RATE, &osr);
1251		osr &= NAU8825_ADC_SYNC_DOWN_MASK;
1252		if (osr >= ARRAY_SIZE(osr_adc_sel))
1253			return NULL;
1254		return &osr_adc_sel[osr];
1255	}
1256}
1257
1258static int nau8825_dai_startup(struct snd_pcm_substream *substream,
1259			       struct snd_soc_dai *dai)
1260{
1261	struct snd_soc_component *component = dai->component;
1262	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1263	const struct nau8825_osr_attr *osr;
1264
1265	osr = nau8825_get_osr(nau8825, substream->stream);
1266	if (!osr || !osr->osr)
1267		return -EINVAL;
 
1268
1269	return snd_pcm_hw_constraint_minmax(substream->runtime,
1270					    SNDRV_PCM_HW_PARAM_RATE,
1271					    0, CLK_DA_AD_MAX / osr->osr);
1272}
1273
1274static int nau8825_hw_params(struct snd_pcm_substream *substream,
1275				struct snd_pcm_hw_params *params,
1276				struct snd_soc_dai *dai)
1277{
1278	struct snd_soc_component *component = dai->component;
1279	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1280	unsigned int val_len = 0, ctrl_val, bclk_fs, bclk_div;
1281	const struct nau8825_osr_attr *osr;
1282	int err = -EINVAL;
1283
1284	nau8825_sema_acquire(nau8825, 3 * HZ);
1285
1286	/* CLK_DAC or CLK_ADC = OSR * FS
1287	 * DAC or ADC clock frequency is defined as Over Sampling Rate (OSR)
1288	 * multiplied by the audio sample rate (Fs). Note that the OSR and Fs
1289	 * values must be selected such that the maximum frequency is less
1290	 * than 6.144 MHz.
1291	 */
1292	osr = nau8825_get_osr(nau8825, substream->stream);
1293	if (!osr || !osr->osr)
1294		goto error;
1295	if (params_rate(params) * osr->osr > CLK_DA_AD_MAX)
1296		goto error;
1297	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 
 
1298		regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
1299			NAU8825_CLK_DAC_SRC_MASK,
1300			osr->clk_src << NAU8825_CLK_DAC_SRC_SFT);
1301	else
 
 
 
 
 
 
 
1302		regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
1303			NAU8825_CLK_ADC_SRC_MASK,
1304			osr->clk_src << NAU8825_CLK_ADC_SRC_SFT);
 
1305
1306	/* make BCLK and LRC divde configuration if the codec as master. */
1307	regmap_read(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2, &ctrl_val);
1308	if (ctrl_val & NAU8825_I2S_MS_MASTER) {
1309		/* get the bclk and fs ratio */
1310		bclk_fs = snd_soc_params_to_bclk(params) / params_rate(params);
1311		if (bclk_fs <= 32)
1312			bclk_div = 2;
1313		else if (bclk_fs <= 64)
1314			bclk_div = 1;
1315		else if (bclk_fs <= 128)
1316			bclk_div = 0;
1317		else
1318			goto error;
 
 
1319		regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
1320			NAU8825_I2S_LRC_DIV_MASK | NAU8825_I2S_BLK_DIV_MASK,
1321			((bclk_div + 1) << NAU8825_I2S_LRC_DIV_SFT) | bclk_div);
1322	}
1323
1324	switch (params_width(params)) {
1325	case 16:
1326		val_len |= NAU8825_I2S_DL_16;
1327		break;
1328	case 20:
1329		val_len |= NAU8825_I2S_DL_20;
1330		break;
1331	case 24:
1332		val_len |= NAU8825_I2S_DL_24;
1333		break;
1334	case 32:
1335		val_len |= NAU8825_I2S_DL_32;
1336		break;
1337	default:
1338		goto error;
 
1339	}
1340
1341	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL1,
1342		NAU8825_I2S_DL_MASK, val_len);
1343	err = 0;
1344
1345 error:
1346	/* Release the semaphore. */
1347	nau8825_sema_release(nau8825);
1348
1349	return err;
1350}
1351
1352static int nau8825_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
1353{
1354	struct snd_soc_component *component = codec_dai->component;
1355	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1356	unsigned int ctrl1_val = 0, ctrl2_val = 0;
1357
1358	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1359	case SND_SOC_DAIFMT_CBM_CFM:
1360		ctrl2_val |= NAU8825_I2S_MS_MASTER;
1361		break;
1362	case SND_SOC_DAIFMT_CBS_CFS:
1363		break;
1364	default:
1365		return -EINVAL;
1366	}
1367
1368	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1369	case SND_SOC_DAIFMT_NB_NF:
1370		break;
1371	case SND_SOC_DAIFMT_IB_NF:
1372		ctrl1_val |= NAU8825_I2S_BP_INV;
1373		break;
1374	default:
1375		return -EINVAL;
1376	}
1377
1378	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1379	case SND_SOC_DAIFMT_I2S:
1380		ctrl1_val |= NAU8825_I2S_DF_I2S;
1381		break;
1382	case SND_SOC_DAIFMT_LEFT_J:
1383		ctrl1_val |= NAU8825_I2S_DF_LEFT;
1384		break;
1385	case SND_SOC_DAIFMT_RIGHT_J:
1386		ctrl1_val |= NAU8825_I2S_DF_RIGTH;
1387		break;
1388	case SND_SOC_DAIFMT_DSP_A:
1389		ctrl1_val |= NAU8825_I2S_DF_PCM_AB;
1390		break;
1391	case SND_SOC_DAIFMT_DSP_B:
1392		ctrl1_val |= NAU8825_I2S_DF_PCM_AB;
1393		ctrl1_val |= NAU8825_I2S_PCMB_EN;
1394		break;
1395	default:
1396		return -EINVAL;
1397	}
1398
1399	nau8825_sema_acquire(nau8825, 3 * HZ);
1400
1401	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL1,
1402		NAU8825_I2S_DL_MASK | NAU8825_I2S_DF_MASK |
1403		NAU8825_I2S_BP_MASK | NAU8825_I2S_PCMB_MASK,
1404		ctrl1_val);
1405	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
1406		NAU8825_I2S_MS_MASK, ctrl2_val);
1407
1408	/* Release the semaphore. */
1409	nau8825_sema_release(nau8825);
1410
1411	return 0;
1412}
1413
1414/**
1415 * nau8825_set_tdm_slot - configure DAI TDM.
1416 * @dai: DAI
1417 * @tx_mask: bitmask representing active TX slots.
1418 * @rx_mask: bitmask representing active RX slots.
1419 * @slots: Number of slots in use.
1420 * @slot_width: Width in bits for each slot.
1421 *
1422 * Configures a DAI for TDM operation. Support TDM 4/8 slots.
1423 * The limitation is DAC and ADC need shift 4 slots at 8 slots mode.
1424 */
1425static int nau8825_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
1426				unsigned int rx_mask, int slots, int slot_width)
1427{
1428	struct snd_soc_component *component = dai->component;
1429	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1430	unsigned int ctrl_val = 0, ctrl_offset = 0, value = 0, dac_s, adc_s;
1431
1432	if (slots != 4 && slots != 8) {
1433		dev_err(nau8825->dev, "Only support 4 or 8 slots!\n");
1434		return -EINVAL;
1435	}
1436
1437	/* The driver is limited to 1-channel for ADC, and 2-channel for DAC on TDM mode */
1438	if (hweight_long((unsigned long) tx_mask) != 1 ||
1439	    hweight_long((unsigned long) rx_mask) != 2) {
1440		dev_err(nau8825->dev,
1441			"The limitation is 1-channel for ADC, and 2-channel for DAC on TDM mode.\n");
1442		return -EINVAL;
1443	}
1444
1445	if (((tx_mask & 0xf) && (tx_mask & 0xf0)) ||
1446	    ((rx_mask & 0xf) && (rx_mask & 0xf0)) ||
1447	    ((tx_mask & 0xf) && (rx_mask & 0xf0)) ||
1448	    ((rx_mask & 0xf) && (tx_mask & 0xf0))) {
1449		dev_err(nau8825->dev,
1450			"Slot assignment of DAC and ADC need to set same interval.\n");
1451		return -EINVAL;
1452	}
1453
1454	/* The offset of fixed 4 slots for 8 slots support */
1455	if (rx_mask & 0xf0) {
1456		regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
1457				   NAU8825_I2S_PCM_TS_EN_MASK, NAU8825_I2S_PCM_TS_EN);
1458		regmap_read(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL1, &value);
1459		ctrl_val |= NAU8825_TDM_OFFSET_EN;
1460		ctrl_offset = 4 * slot_width;
1461		if (!(value & NAU8825_I2S_PCMB_MASK))
1462			ctrl_offset += 1;
1463		dac_s = (rx_mask & 0xf0) >> 4;
1464		adc_s = fls((tx_mask & 0xf0) >> 4);
1465	} else {
1466		dac_s = rx_mask & 0xf;
1467		adc_s = fls(tx_mask & 0xf);
1468	}
1469
1470	ctrl_val |= NAU8825_TDM_MODE;
1471
1472	switch (dac_s) {
1473	case 0x3:
1474		ctrl_val |= 1 << NAU8825_TDM_DACR_RX_SFT;
1475		break;
1476	case 0x5:
1477		ctrl_val |= 2 << NAU8825_TDM_DACR_RX_SFT;
1478		break;
1479	case 0x6:
1480		ctrl_val |= 1 << NAU8825_TDM_DACL_RX_SFT;
1481		ctrl_val |= 2 << NAU8825_TDM_DACR_RX_SFT;
1482		break;
1483	case 0x9:
1484		ctrl_val |= 3 << NAU8825_TDM_DACR_RX_SFT;
1485		break;
1486	case 0xa:
1487		ctrl_val |= 1 << NAU8825_TDM_DACL_RX_SFT;
1488		ctrl_val |= 3 << NAU8825_TDM_DACR_RX_SFT;
1489		break;
1490	case 0xc:
1491		ctrl_val |= 2 << NAU8825_TDM_DACL_RX_SFT;
1492		ctrl_val |= 3 << NAU8825_TDM_DACR_RX_SFT;
1493		break;
1494	default:
1495		return -EINVAL;
1496	}
1497
1498	ctrl_val |= adc_s - 1;
1499
1500	regmap_update_bits(nau8825->regmap, NAU8825_REG_TDM_CTRL,
1501			   NAU8825_TDM_MODE | NAU8825_TDM_OFFSET_EN |
1502			   NAU8825_TDM_DACL_RX_MASK | NAU8825_TDM_DACR_RX_MASK |
1503			   NAU8825_TDM_TX_MASK, ctrl_val);
1504	regmap_update_bits(nau8825->regmap, NAU8825_REG_LEFT_TIME_SLOT,
1505			   NAU8825_TSLOT_L0_MASK, ctrl_offset);
1506
1507	return 0;
1508}
1509
1510static const struct snd_soc_dai_ops nau8825_dai_ops = {
1511	.startup	= nau8825_dai_startup,
1512	.hw_params	= nau8825_hw_params,
1513	.set_fmt	= nau8825_set_dai_fmt,
1514	.set_tdm_slot	= nau8825_set_tdm_slot,
1515};
1516
1517#define NAU8825_RATES	SNDRV_PCM_RATE_8000_192000
1518#define NAU8825_FORMATS	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
1519			 | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
1520
1521static struct snd_soc_dai_driver nau8825_dai = {
1522	.name = "nau8825-hifi",
1523	.playback = {
1524		.stream_name	 = "Playback",
1525		.channels_min	 = 1,
1526		.channels_max	 = 2,
1527		.rates		 = NAU8825_RATES,
1528		.formats	 = NAU8825_FORMATS,
1529	},
1530	.capture = {
1531		.stream_name	 = "Capture",
1532		.channels_min	 = 1,
1533		.channels_max	 = 2,   /* Only 1 channel of data */
1534		.rates		 = NAU8825_RATES,
1535		.formats	 = NAU8825_FORMATS,
1536	},
1537	.ops = &nau8825_dai_ops,
1538};
1539
1540/**
1541 * nau8825_enable_jack_detect - Specify a jack for event reporting
1542 *
1543 * @component:  component to register the jack with
1544 * @jack: jack to use to report headset and button events on
1545 *
1546 * After this function has been called the headset insert/remove and button
1547 * events will be routed to the given jack.  Jack can be null to stop
1548 * reporting.
1549 */
1550int nau8825_enable_jack_detect(struct snd_soc_component *component,
1551				struct snd_soc_jack *jack)
1552{
1553	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1554	struct regmap *regmap = nau8825->regmap;
1555
1556	nau8825->jack = jack;
1557
1558	if (!nau8825->jack) {
1559		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1560				   NAU8825_HSD_AUTO_MODE | NAU8825_SPKR_DWN1R |
1561				   NAU8825_SPKR_DWN1L, 0);
1562		return 0;
1563	}
1564	/* Ground HP Outputs[1:0], needed for headset auto detection
1565	 * Enable Automatic Mic/Gnd switching reading on insert interrupt[6]
1566	 */
1567	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1568		NAU8825_HSD_AUTO_MODE | NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L,
1569		NAU8825_HSD_AUTO_MODE | NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
1570
1571	return 0;
1572}
1573EXPORT_SYMBOL_GPL(nau8825_enable_jack_detect);
1574
1575
1576static bool nau8825_is_jack_inserted(struct regmap *regmap)
1577{
1578	bool active_high, is_high;
1579	int status, jkdet;
1580
1581	regmap_read(regmap, NAU8825_REG_JACK_DET_CTRL, &jkdet);
1582	active_high = jkdet & NAU8825_JACK_POLARITY;
1583	regmap_read(regmap, NAU8825_REG_I2C_DEVICE_ID, &status);
1584	is_high = status & NAU8825_GPIO2JD1;
1585	/* return jack connection status according to jack insertion logic
1586	 * active high or active low.
1587	 */
1588	return active_high == is_high;
1589}
1590
1591static void nau8825_restart_jack_detection(struct regmap *regmap)
1592{
1593	/* this will restart the entire jack detection process including MIC/GND
1594	 * switching and create interrupts. We have to go from 0 to 1 and back
1595	 * to 0 to restart.
1596	 */
1597	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1598		NAU8825_JACK_DET_RESTART, NAU8825_JACK_DET_RESTART);
1599	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1600		NAU8825_JACK_DET_RESTART, 0);
1601}
1602
1603static void nau8825_int_status_clear_all(struct regmap *regmap)
1604{
1605	int active_irq, clear_irq, i;
1606
1607	/* Reset the intrruption status from rightmost bit if the corres-
1608	 * ponding irq event occurs.
1609	 */
1610	regmap_read(regmap, NAU8825_REG_IRQ_STATUS, &active_irq);
1611	for (i = 0; i < NAU8825_REG_DATA_LEN; i++) {
1612		clear_irq = (0x1 << i);
1613		if (active_irq & clear_irq)
1614			regmap_write(regmap,
1615				NAU8825_REG_INT_CLR_KEY_STATUS, clear_irq);
1616	}
1617}
1618
1619static void nau8825_eject_jack(struct nau8825 *nau8825)
1620{
1621	struct snd_soc_dapm_context *dapm = nau8825->dapm;
1622	struct regmap *regmap = nau8825->regmap;
1623
1624	/* Force to cancel the cross talk detection process */
1625	nau8825_xtalk_cancel(nau8825);
1626
1627	snd_soc_dapm_disable_pin(dapm, "SAR");
1628	snd_soc_dapm_disable_pin(dapm, "MICBIAS");
1629	/* Detach 2kOhm Resistors from MICBIAS to MICGND1/2 */
1630	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1631		NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2, 0);
1632	/* ground HPL/HPR, MICGRND1/2 */
1633	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 0xf, 0xf);
1634
1635	snd_soc_dapm_sync(dapm);
1636
1637	/* Clear all interruption status */
1638	nau8825_int_status_clear_all(regmap);
1639
1640	/* Enable the insertion interruption, disable the ejection inter-
1641	 * ruption, and then bypass de-bounce circuit.
1642	 */
1643	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL,
1644		NAU8825_IRQ_EJECT_DIS | NAU8825_IRQ_INSERT_DIS,
1645		NAU8825_IRQ_EJECT_DIS);
1646	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1647		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_EJECT_EN |
1648		NAU8825_IRQ_HEADSET_COMPLETE_EN | NAU8825_IRQ_INSERT_EN,
1649		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_EJECT_EN |
1650		NAU8825_IRQ_HEADSET_COMPLETE_EN);
1651	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1652		NAU8825_JACK_DET_DB_BYPASS, NAU8825_JACK_DET_DB_BYPASS);
1653
1654	/* Disable ADC needed for interruptions at audo mode */
1655	regmap_update_bits(regmap, NAU8825_REG_ENA_CTRL,
1656		NAU8825_ENABLE_ADC, 0);
1657
1658	/* Close clock for jack type detection at manual mode */
1659	nau8825_configure_sysclk(nau8825, NAU8825_CLK_DIS, 0);
1660}
1661
1662/* Enable audo mode interruptions with internal clock. */
1663static void nau8825_setup_auto_irq(struct nau8825 *nau8825)
1664{
1665	struct regmap *regmap = nau8825->regmap;
1666
1667	/* Enable HSD function */
1668	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1669			   NAU8825_HSD_AUTO_MODE, NAU8825_HSD_AUTO_MODE);
1670
1671	/* Enable headset jack type detection complete interruption and
1672	 * jack ejection interruption.
1673	 */
1674	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1675		NAU8825_IRQ_HEADSET_COMPLETE_EN | NAU8825_IRQ_EJECT_EN, 0);
1676
1677	/* Enable internal VCO needed for interruptions */
1678	nau8825_configure_sysclk(nau8825, NAU8825_CLK_INTERNAL, 0);
1679	/* Raise up the internal clock for jack detection */
1680	regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
1681			   NAU8825_CLK_MCLK_SRC_MASK, 0);
1682
1683	/* Enable ADC needed for interruptions */
1684	regmap_update_bits(regmap, NAU8825_REG_ENA_CTRL,
1685		NAU8825_ENABLE_ADC, NAU8825_ENABLE_ADC);
1686
1687	/* Chip needs one FSCLK cycle in order to generate interruptions,
1688	 * as we cannot guarantee one will be provided by the system. Turning
1689	 * master mode on then off enables us to generate that FSCLK cycle
1690	 * with a minimum of contention on the clock bus.
1691	 */
1692	regmap_update_bits(regmap, NAU8825_REG_I2S_PCM_CTRL2,
1693		NAU8825_I2S_MS_MASK, NAU8825_I2S_MS_MASTER);
1694	regmap_update_bits(regmap, NAU8825_REG_I2S_PCM_CTRL2,
1695		NAU8825_I2S_MS_MASK, NAU8825_I2S_MS_SLAVE);
1696
1697	/* Not bypass de-bounce circuit */
1698	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1699		NAU8825_JACK_DET_DB_BYPASS, 0);
1700
1701	/* Unmask all interruptions */
1702	regmap_write(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL, 0);
1703
1704	/* Restart the jack detection process at auto mode */
1705	nau8825_restart_jack_detection(regmap);
1706}
1707
1708static int nau8825_button_decode(int value)
1709{
1710	int buttons = 0;
1711
1712	/* The chip supports up to 8 buttons, but ALSA defines only 6 buttons */
1713	if (value & BIT(0))
1714		buttons |= SND_JACK_BTN_0;
1715	if (value & BIT(1))
1716		buttons |= SND_JACK_BTN_1;
1717	if (value & BIT(2))
1718		buttons |= SND_JACK_BTN_2;
1719	if (value & BIT(3))
1720		buttons |= SND_JACK_BTN_3;
1721	if (value & BIT(4))
1722		buttons |= SND_JACK_BTN_4;
1723	if (value & BIT(5))
1724		buttons |= SND_JACK_BTN_5;
1725
1726	return buttons;
1727}
1728
1729static int nau8825_high_imped_detection(struct nau8825 *nau8825)
1730{
1731	struct regmap *regmap = nau8825->regmap;
1732	struct snd_soc_dapm_context *dapm = nau8825->dapm;
1733	unsigned int adc_mg1, adc_mg2;
1734
1735	/* Initial phase */
1736	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1737			   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 | NAU8825_SPKR_DWN1R |
1738			   NAU8825_SPKR_DWN1L, NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2);
1739	regmap_update_bits(regmap, NAU8825_REG_ANALOG_CONTROL_1,
1740			   NAU8825_TESTDACIN_MASK, NAU8825_TESTDACIN_GND);
1741	regmap_write(regmap, NAU8825_REG_TRIM_SETTINGS, 0x6);
1742	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1743			   NAU8825_MICBIAS_LOWNOISE_MASK | NAU8825_MICBIAS_VOLTAGE_MASK,
1744			   NAU8825_MICBIAS_LOWNOISE_EN);
1745	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1746			   NAU8825_SAR_INPUT_MASK | NAU8825_SAR_TRACKING_GAIN_MASK |
1747			   NAU8825_SAR_HV_SEL_MASK | NAU8825_SAR_RES_SEL_MASK |
1748			   NAU8825_SAR_COMPARE_TIME_MASK | NAU8825_SAR_SAMPLING_TIME_MASK,
1749			   NAU8825_SAR_HV_SEL_VDDMIC | NAU8825_SAR_RES_SEL_70K);
1750
1751	snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1752	snd_soc_dapm_force_enable_pin(dapm, "SAR");
1753	snd_soc_dapm_sync(dapm);
1754
1755	/* Configure settings for first reading of SARADC */
1756	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1757			   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 | NAU8825_SPKR_DWN1R |
1758			   NAU8825_SPKR_DWN1L, NAU8825_SPKR_ENGND2);
1759	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1760			   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1761			   NAU8825_MICBIAS_JKR2);
1762	regmap_read(regmap, NAU8825_REG_SARDOUT_RAM_STATUS, &adc_mg1);
1763
1764	/* Configure settings for second reading of SARADC */
1765	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1766			   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2, 0);
1767	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1768			   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 | NAU8825_SPKR_DWN1R |
1769			   NAU8825_SPKR_DWN1L, NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 |
1770			   NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
1771	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1772			   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 | NAU8825_SPKR_DWN1R |
1773			   NAU8825_SPKR_DWN1L, NAU8825_SPKR_ENGND1);
1774	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1775			   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1776			   NAU8825_MICBIAS_JKSLV);
1777	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1778			   NAU8825_SAR_INPUT_MASK, NAU8825_SAR_INPUT_JKSLV);
1779	regmap_read(regmap, NAU8825_REG_SARDOUT_RAM_STATUS, &adc_mg2);
1780
1781	/* Disable phase */
1782	snd_soc_dapm_disable_pin(dapm, "SAR");
1783	snd_soc_dapm_disable_pin(dapm, "MICBIAS");
1784	snd_soc_dapm_sync(dapm);
1785
1786	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1787			   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_LOWNOISE_MASK |
1788			   NAU8825_MICBIAS_VOLTAGE_MASK, nau8825->micbias_voltage);
1789	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1790			   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 | NAU8825_SPKR_DWN1R |
1791			   NAU8825_SPKR_DWN1L, NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2 |
1792			   NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
1793	regmap_update_bits(regmap, NAU8825_REG_ANALOG_CONTROL_1,
1794			   NAU8825_TESTDACIN_MASK, NAU8825_TESTDACIN_GND);
1795	regmap_write(regmap, NAU8825_REG_TRIM_SETTINGS, 0);
1796	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1797			   NAU8825_SAR_TRACKING_GAIN_MASK | NAU8825_SAR_HV_SEL_MASK,
1798			   nau8825->sar_voltage << NAU8825_SAR_TRACKING_GAIN_SFT);
1799	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1800			   NAU8825_SAR_COMPARE_TIME_MASK | NAU8825_SAR_SAMPLING_TIME_MASK,
1801			   (nau8825->sar_compare_time << NAU8825_SAR_COMPARE_TIME_SFT) |
1802			   (nau8825->sar_sampling_time << NAU8825_SAR_SAMPLING_TIME_SFT));
1803	dev_dbg(nau8825->dev, "adc_mg1:%x, adc_mg2:%x\n", adc_mg1, adc_mg2);
1804
1805	/* Confirmation phase */
1806	if (adc_mg1 > adc_mg2) {
1807		dev_dbg(nau8825->dev, "OMTP (micgnd1) mic connected\n");
1808
1809		/* Unground MICGND1 */
1810		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1811				   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2,
1812				   NAU8825_SPKR_ENGND2);
1813		/* Attach 2kOhm Resistor from MICBIAS to MICGND1 */
1814		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1815				   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1816				   NAU8825_MICBIAS_JKR2);
1817		/* Attach SARADC to MICGND1 */
1818		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1819				   NAU8825_SAR_INPUT_MASK,
1820				   NAU8825_SAR_INPUT_JKR2);
1821	} else if (adc_mg1 < adc_mg2) {
1822		dev_dbg(nau8825->dev, "CTIA (micgnd2) mic connected\n");
1823
1824		/* Unground MICGND2 */
1825		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1826				   NAU8825_SPKR_ENGND1 | NAU8825_SPKR_ENGND2,
1827				   NAU8825_SPKR_ENGND1);
1828		/* Attach 2kOhm Resistor from MICBIAS to MICGND2 */
1829		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1830				   NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1831				   NAU8825_MICBIAS_JKSLV);
1832		/* Attach SARADC to MICGND2 */
1833		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1834				   NAU8825_SAR_INPUT_MASK,
1835				   NAU8825_SAR_INPUT_JKSLV);
1836	} else {
1837		dev_err(nau8825->dev, "Jack broken.\n");
1838		return -EINVAL;
1839	}
1840
1841	return 0;
1842}
1843
1844static int nau8825_jack_insert(struct nau8825 *nau8825)
1845{
1846	struct regmap *regmap = nau8825->regmap;
1847	struct snd_soc_dapm_context *dapm = nau8825->dapm;
1848	int jack_status_reg, mic_detected;
1849	int type = 0;
1850
1851	regmap_read(regmap, NAU8825_REG_GENERAL_STATUS, &jack_status_reg);
1852	mic_detected = (jack_status_reg >> 10) & 3;
1853	/* The JKSLV and JKR2 all detected in high impedance headset */
1854	if (mic_detected == 0x3)
1855		nau8825->high_imped = true;
1856	else
1857		nau8825->high_imped = false;
1858
1859	switch (mic_detected) {
1860	case 0:
1861		/* no mic */
1862		type = SND_JACK_HEADPHONE;
1863		break;
1864	case 1:
1865		dev_dbg(nau8825->dev, "OMTP (micgnd1) mic connected\n");
1866		type = SND_JACK_HEADSET;
1867
1868		/* Unground MICGND1 */
1869		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 3 << 2,
1870			1 << 2);
1871		/* Attach 2kOhm Resistor from MICBIAS to MICGND1 */
1872		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1873			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1874			NAU8825_MICBIAS_JKR2);
1875		/* Attach SARADC to MICGND1 */
1876		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1877			NAU8825_SAR_INPUT_MASK,
1878			NAU8825_SAR_INPUT_JKR2);
1879
1880		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1881		snd_soc_dapm_force_enable_pin(dapm, "SAR");
1882		snd_soc_dapm_sync(dapm);
1883		break;
1884	case 2:
1885		dev_dbg(nau8825->dev, "CTIA (micgnd2) mic connected\n");
1886		type = SND_JACK_HEADSET;
1887
1888		/* Unground MICGND2 */
1889		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 3 << 2,
1890			2 << 2);
1891		/* Attach 2kOhm Resistor from MICBIAS to MICGND2 */
1892		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1893			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1894			NAU8825_MICBIAS_JKSLV);
1895		/* Attach SARADC to MICGND2 */
1896		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1897			NAU8825_SAR_INPUT_MASK,
1898			NAU8825_SAR_INPUT_JKSLV);
1899
1900		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1901		snd_soc_dapm_force_enable_pin(dapm, "SAR");
1902		snd_soc_dapm_sync(dapm);
1903		break;
1904	case 3:
1905		/* Detection failure case */
1906		dev_warn(nau8825->dev,
1907			 "Detection failure. Try the manually mechanism for jack type checking.\n");
1908		if (!nau8825_high_imped_detection(nau8825)) {
1909			type = SND_JACK_HEADSET;
1910			snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1911			snd_soc_dapm_force_enable_pin(dapm, "SAR");
1912			snd_soc_dapm_sync(dapm);
1913		} else
1914			type = SND_JACK_HEADPHONE;
1915		break;
1916	}
1917
1918	/* Update to the default divider of internal clock for power saving */
1919	regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
1920			   NAU8825_CLK_MCLK_SRC_MASK, 0xf);
1921
1922	/* Disable HSD function */
1923	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, NAU8825_HSD_AUTO_MODE, 0);
1924
1925	/* Leaving HPOL/R grounded after jack insert by default. They will be
1926	 * ungrounded as part of the widget power up sequence at the beginning
1927	 * of playback to reduce pop.
1928	 */
1929	return type;
1930}
1931
1932#define NAU8825_BUTTONS (SND_JACK_BTN_0 | SND_JACK_BTN_1 | \
1933		SND_JACK_BTN_2 | SND_JACK_BTN_3)
1934
1935static irqreturn_t nau8825_interrupt(int irq, void *data)
1936{
1937	struct nau8825 *nau8825 = (struct nau8825 *)data;
1938	struct regmap *regmap = nau8825->regmap;
1939	int active_irq, clear_irq = 0, event = 0, event_mask = 0;
1940
1941	if (regmap_read(regmap, NAU8825_REG_IRQ_STATUS, &active_irq)) {
1942		dev_err(nau8825->dev, "failed to read irq status\n");
1943		return IRQ_NONE;
1944	}
1945
1946	if ((active_irq & NAU8825_JACK_EJECTION_IRQ_MASK) ==
1947		NAU8825_JACK_EJECTION_DETECTED) {
1948
1949		nau8825_eject_jack(nau8825);
1950		event_mask |= SND_JACK_HEADSET;
1951		clear_irq = NAU8825_JACK_EJECTION_IRQ_MASK;
1952	} else if (active_irq & NAU8825_KEY_SHORT_PRESS_IRQ) {
1953		int key_status;
1954
1955		regmap_read(regmap, NAU8825_REG_INT_CLR_KEY_STATUS,
1956			&key_status);
1957
1958		/* upper 8 bits of the register are for short pressed keys,
1959		 * lower 8 bits - for long pressed buttons
1960		 */
1961		nau8825->button_pressed = nau8825_button_decode(
1962			key_status >> 8);
1963
1964		event |= nau8825->button_pressed;
1965		event_mask |= NAU8825_BUTTONS;
1966		clear_irq = NAU8825_KEY_SHORT_PRESS_IRQ;
1967	} else if (active_irq & NAU8825_KEY_RELEASE_IRQ) {
1968		event_mask = NAU8825_BUTTONS;
1969		clear_irq = NAU8825_KEY_RELEASE_IRQ;
1970	} else if (active_irq & NAU8825_HEADSET_COMPLETION_IRQ) {
1971		if (nau8825_is_jack_inserted(regmap)) {
1972			event |= nau8825_jack_insert(nau8825);
1973			if (nau8825->xtalk_enable && !nau8825->high_imped) {
1974				/* Apply the cross talk suppression in the
1975				 * headset without high impedance.
1976				 */
1977				if (!nau8825->xtalk_protect) {
1978					/* Raise protection for cross talk de-
1979					 * tection if no protection before.
1980					 * The driver has to cancel the pro-
1981					 * cess and restore changes if process
1982					 * is ongoing when ejection.
1983					 */
1984					int ret;
1985					nau8825->xtalk_protect = true;
1986					ret = nau8825_sema_acquire(nau8825, 0);
1987					if (ret)
1988						nau8825->xtalk_protect = false;
1989				}
1990				/* Startup cross talk detection process */
1991				if (nau8825->xtalk_protect) {
1992					nau8825->xtalk_state =
1993						NAU8825_XTALK_PREPARE;
1994					schedule_work(&nau8825->xtalk_work);
1995				}
1996			} else {
1997				/* The cross talk suppression shouldn't apply
1998				 * in the headset with high impedance. Thus,
1999				 * relieve the protection raised before.
2000				 */
2001				if (nau8825->xtalk_protect) {
2002					nau8825_sema_release(nau8825);
2003					nau8825->xtalk_protect = false;
2004				}
2005			}
2006		} else {
2007			dev_warn(nau8825->dev, "Headset completion IRQ fired but no headset connected\n");
2008			nau8825_eject_jack(nau8825);
2009		}
2010
2011		event_mask |= SND_JACK_HEADSET;
2012		clear_irq = NAU8825_HEADSET_COMPLETION_IRQ;
2013		/* Record the interruption report event for driver to report
2014		 * the event later. The jack report will delay until cross
2015		 * talk detection process is done.
2016		 */
2017		if (nau8825->xtalk_state == NAU8825_XTALK_PREPARE) {
2018			nau8825->xtalk_event = event;
2019			nau8825->xtalk_event_mask = event_mask;
2020		}
2021	} else if (active_irq & NAU8825_IMPEDANCE_MEAS_IRQ) {
2022		/* crosstalk detection enable and process on going */
2023		if (nau8825->xtalk_enable && nau8825->xtalk_protect)
2024			schedule_work(&nau8825->xtalk_work);
2025		clear_irq = NAU8825_IMPEDANCE_MEAS_IRQ;
2026	} else if ((active_irq & NAU8825_JACK_INSERTION_IRQ_MASK) ==
2027		NAU8825_JACK_INSERTION_DETECTED) {
2028		/* One more step to check GPIO status directly. Thus, the
2029		 * driver can confirm the real insertion interruption because
2030		 * the intrruption at manual mode has bypassed debounce
2031		 * circuit which can get rid of unstable status.
2032		 */
2033		if (nau8825_is_jack_inserted(regmap)) {
2034			/* Turn off insertion interruption at manual mode */
2035			regmap_update_bits(regmap,
2036				NAU8825_REG_INTERRUPT_DIS_CTRL,
2037				NAU8825_IRQ_INSERT_DIS,
2038				NAU8825_IRQ_INSERT_DIS);
2039			regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
2040				NAU8825_IRQ_INSERT_EN, NAU8825_IRQ_INSERT_EN);
2041			/* Enable interruption for jack type detection at audo
2042			 * mode which can detect microphone and jack type.
2043			 */
2044			nau8825_setup_auto_irq(nau8825);
2045		}
2046	}
2047
2048	if (!clear_irq)
2049		clear_irq = active_irq;
2050	/* clears the rightmost interruption */
2051	regmap_write(regmap, NAU8825_REG_INT_CLR_KEY_STATUS, clear_irq);
2052
2053	/* Delay jack report until cross talk detection is done. It can avoid
2054	 * application to do playback preparation when cross talk detection
2055	 * process is still working. Otherwise, the resource like clock and
2056	 * power will be issued by them at the same time and conflict happens.
2057	 */
2058	if (event_mask && nau8825->xtalk_state == NAU8825_XTALK_DONE)
2059		snd_soc_jack_report(nau8825->jack, event, event_mask);
2060
2061	return IRQ_HANDLED;
2062}
2063
2064static void nau8825_setup_buttons(struct nau8825 *nau8825)
2065{
2066	struct regmap *regmap = nau8825->regmap;
2067
2068	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
2069		NAU8825_SAR_TRACKING_GAIN_MASK,
2070		nau8825->sar_voltage << NAU8825_SAR_TRACKING_GAIN_SFT);
2071	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
2072		NAU8825_SAR_COMPARE_TIME_MASK,
2073		nau8825->sar_compare_time << NAU8825_SAR_COMPARE_TIME_SFT);
2074	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
2075		NAU8825_SAR_SAMPLING_TIME_MASK,
2076		nau8825->sar_sampling_time << NAU8825_SAR_SAMPLING_TIME_SFT);
2077
2078	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
2079		NAU8825_KEYDET_LEVELS_NR_MASK,
2080		(nau8825->sar_threshold_num - 1) << NAU8825_KEYDET_LEVELS_NR_SFT);
2081	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
2082		NAU8825_KEYDET_HYSTERESIS_MASK,
2083		nau8825->sar_hysteresis << NAU8825_KEYDET_HYSTERESIS_SFT);
2084	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
2085		NAU8825_KEYDET_SHORTKEY_DEBOUNCE_MASK,
2086		nau8825->key_debounce << NAU8825_KEYDET_SHORTKEY_DEBOUNCE_SFT);
2087
2088	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_1,
2089		(nau8825->sar_threshold[0] << 8) | nau8825->sar_threshold[1]);
2090	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_2,
2091		(nau8825->sar_threshold[2] << 8) | nau8825->sar_threshold[3]);
2092	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_3,
2093		(nau8825->sar_threshold[4] << 8) | nau8825->sar_threshold[5]);
2094	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_4,
2095		(nau8825->sar_threshold[6] << 8) | nau8825->sar_threshold[7]);
2096
2097	/* Enable short press and release interruptions */
2098	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
2099		NAU8825_IRQ_KEY_SHORT_PRESS_EN | NAU8825_IRQ_KEY_RELEASE_EN,
2100		0);
2101}
2102
2103static void nau8825_init_regs(struct nau8825 *nau8825)
2104{
2105	struct regmap *regmap = nau8825->regmap;
2106
2107	/* Latch IIC LSB value */
2108	regmap_write(regmap, NAU8825_REG_IIC_ADDR_SET, 0x0001);
2109	/* Enable Bias/Vmid */
2110	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
2111		NAU8825_BIAS_VMID, NAU8825_BIAS_VMID);
2112	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
2113		NAU8825_GLOBAL_BIAS_EN, NAU8825_GLOBAL_BIAS_EN);
2114
2115	/* VMID Tieoff */
2116	regmap_update_bits(regmap, NAU8825_REG_BIAS_ADJ,
2117		NAU8825_BIAS_VMID_SEL_MASK,
2118		nau8825->vref_impedance << NAU8825_BIAS_VMID_SEL_SFT);
2119	/* Disable Boost Driver, Automatic Short circuit protection enable */
2120	regmap_update_bits(regmap, NAU8825_REG_BOOST,
2121		NAU8825_PRECHARGE_DIS | NAU8825_HP_BOOST_DIS |
2122		NAU8825_HP_BOOST_G_DIS | NAU8825_SHORT_SHUTDOWN_EN,
2123		NAU8825_PRECHARGE_DIS | NAU8825_HP_BOOST_DIS |
2124		NAU8825_HP_BOOST_G_DIS | NAU8825_SHORT_SHUTDOWN_EN);
2125
2126	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
2127		NAU8825_JKDET_OUTPUT_EN,
2128		nau8825->jkdet_enable ? 0 : NAU8825_JKDET_OUTPUT_EN);
2129	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
2130		NAU8825_JKDET_PULL_EN,
2131		nau8825->jkdet_pull_enable ? 0 : NAU8825_JKDET_PULL_EN);
2132	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
2133		NAU8825_JKDET_PULL_UP,
2134		nau8825->jkdet_pull_up ? NAU8825_JKDET_PULL_UP : 0);
2135	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
2136		NAU8825_JACK_POLARITY,
2137		/* jkdet_polarity - 1  is for active-low */
2138		nau8825->jkdet_polarity ? 0 : NAU8825_JACK_POLARITY);
2139
2140	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
2141		NAU8825_JACK_INSERT_DEBOUNCE_MASK,
2142		nau8825->jack_insert_debounce << NAU8825_JACK_INSERT_DEBOUNCE_SFT);
2143	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
2144		NAU8825_JACK_EJECT_DEBOUNCE_MASK,
2145		nau8825->jack_eject_debounce << NAU8825_JACK_EJECT_DEBOUNCE_SFT);
2146
2147	/* Pull up IRQ pin */
2148	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
2149		NAU8825_IRQ_PIN_PULLUP | NAU8825_IRQ_PIN_PULL_EN,
2150		NAU8825_IRQ_PIN_PULLUP | NAU8825_IRQ_PIN_PULL_EN);
2151	/* Mask unneeded IRQs: 1 - disable, 0 - enable */
2152	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK, 0x7ff, 0x7ff);
2153
2154	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
2155		NAU8825_MICBIAS_VOLTAGE_MASK, nau8825->micbias_voltage);
2156
2157	if (nau8825->sar_threshold_num)
2158		nau8825_setup_buttons(nau8825);
2159
2160	/* Default oversampling/decimations settings are unusable
2161	 * (audible hiss). Set it to something better.
2162	 */
2163	regmap_update_bits(regmap, NAU8825_REG_ADC_RATE,
2164		NAU8825_ADC_SYNC_DOWN_MASK | NAU8825_ADC_SINC4_EN,
2165		NAU8825_ADC_SYNC_DOWN_64);
2166	regmap_update_bits(regmap, NAU8825_REG_DAC_CTRL1,
2167		NAU8825_DAC_OVERSAMPLE_MASK, NAU8825_DAC_OVERSAMPLE_64);
2168	/* Disable DACR/L power */
2169	if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
2170		regmap_update_bits(regmap, NAU8825_REG_CHARGE_PUMP,
2171				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
2172				   NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
2173	/* Enable TESTDAC. This sets the analog DAC inputs to a '0' input
2174	 * signal to avoid any glitches due to power up transients in both
2175	 * the analog and digital DAC circuit.
2176	 */
2177	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
2178		NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
2179	/* CICCLP off */
2180	regmap_update_bits(regmap, NAU8825_REG_DAC_CTRL1,
2181		NAU8825_DAC_CLIP_OFF, NAU8825_DAC_CLIP_OFF);
2182
2183	/* Class AB bias current to 2x, DAC Capacitor enable MSB/LSB */
2184	regmap_update_bits(regmap, NAU8825_REG_ANALOG_CONTROL_2,
2185		NAU8825_HP_NON_CLASSG_CURRENT_2xADJ |
2186		NAU8825_DAC_CAPACITOR_MSB | NAU8825_DAC_CAPACITOR_LSB,
2187		NAU8825_HP_NON_CLASSG_CURRENT_2xADJ |
2188		NAU8825_DAC_CAPACITOR_MSB | NAU8825_DAC_CAPACITOR_LSB);
2189	/* Class G timer 64ms */
2190	regmap_update_bits(regmap, NAU8825_REG_CLASSG_CTRL,
2191		NAU8825_CLASSG_TIMER_MASK,
2192		0x20 << NAU8825_CLASSG_TIMER_SFT);
2193	/* DAC clock delay 2ns, VREF */
2194	regmap_update_bits(regmap, NAU8825_REG_RDAC,
2195		NAU8825_RDAC_CLK_DELAY_MASK | NAU8825_RDAC_VREF_MASK,
2196		(0x2 << NAU8825_RDAC_CLK_DELAY_SFT) |
2197		(0x3 << NAU8825_RDAC_VREF_SFT));
2198	/* Config L/R channel */
2199	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACL_CTRL,
2200		NAU8825_DACL_CH_SEL_MASK, NAU8825_DACL_CH_SEL_L);
2201	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACR_CTRL,
2202		NAU8825_DACL_CH_SEL_MASK, NAU8825_DACL_CH_SEL_R);
2203	/* Disable short Frame Sync detection logic */
2204	regmap_update_bits(regmap, NAU8825_REG_LEFT_TIME_SLOT,
2205		NAU8825_DIS_FS_SHORT_DET, NAU8825_DIS_FS_SHORT_DET);
2206	/* ADCDAT IO drive strength control */
2207	regmap_update_bits(regmap, NAU8825_REG_CHARGE_PUMP,
2208			   NAU8825_ADCOUT_DS_MASK,
2209			   nau8825->adcout_ds << NAU8825_ADCOUT_DS_SFT);
2210}
2211
2212static const struct regmap_config nau8825_regmap_config = {
2213	.val_bits = NAU8825_REG_DATA_LEN,
2214	.reg_bits = NAU8825_REG_ADDR_LEN,
2215
2216	.max_register = NAU8825_REG_MAX,
2217	.readable_reg = nau8825_readable_reg,
2218	.writeable_reg = nau8825_writeable_reg,
2219	.volatile_reg = nau8825_volatile_reg,
2220
2221	.cache_type = REGCACHE_RBTREE,
2222	.reg_defaults = nau8825_reg_defaults,
2223	.num_reg_defaults = ARRAY_SIZE(nau8825_reg_defaults),
2224};
2225
2226static int nau8825_component_probe(struct snd_soc_component *component)
2227{
2228	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2229	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
2230
2231	nau8825->dapm = dapm;
2232
2233	return 0;
2234}
2235
2236static void nau8825_component_remove(struct snd_soc_component *component)
2237{
2238	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2239
2240	/* Cancel and reset cross tak suppresstion detection funciton */
2241	nau8825_xtalk_cancel(nau8825);
2242}
2243
2244/**
2245 * nau8825_calc_fll_param - Calculate FLL parameters.
2246 * @fll_in: external clock provided to codec.
2247 * @fs: sampling rate.
2248 * @fll_param: Pointer to structure of FLL parameters.
2249 *
2250 * Calculate FLL parameters to configure codec.
2251 *
2252 * Returns 0 for success or negative error code.
2253 */
2254static int nau8825_calc_fll_param(unsigned int fll_in, unsigned int fs,
2255		struct nau8825_fll *fll_param)
2256{
2257	u64 fvco, fvco_max;
2258	unsigned int fref, i, fvco_sel;
2259
2260	/* Ensure the reference clock frequency (FREF) is <= 13.5MHz by dividing
2261	 * freq_in by 1, 2, 4, or 8 using FLL pre-scalar.
2262	 * FREF = freq_in / NAU8825_FLL_REF_DIV_MASK
2263	 */
2264	for (i = 0; i < ARRAY_SIZE(fll_pre_scalar); i++) {
2265		fref = fll_in / fll_pre_scalar[i].param;
2266		if (fref <= NAU_FREF_MAX)
2267			break;
2268	}
2269	if (i == ARRAY_SIZE(fll_pre_scalar))
2270		return -EINVAL;
2271	fll_param->clk_ref_div = fll_pre_scalar[i].val;
2272
2273	/* Choose the FLL ratio based on FREF */
2274	for (i = 0; i < ARRAY_SIZE(fll_ratio); i++) {
2275		if (fref >= fll_ratio[i].param)
2276			break;
2277	}
2278	if (i == ARRAY_SIZE(fll_ratio))
2279		return -EINVAL;
2280	fll_param->ratio = fll_ratio[i].val;
2281
2282	/* Calculate the frequency of DCO (FDCO) given freq_out = 256 * Fs.
2283	 * FDCO must be within the 90MHz - 124MHz or the FFL cannot be
2284	 * guaranteed across the full range of operation.
2285	 * FDCO = freq_out * 2 * mclk_src_scaling
2286	 */
2287	fvco_max = 0;
2288	fvco_sel = ARRAY_SIZE(mclk_src_scaling);
2289	for (i = 0; i < ARRAY_SIZE(mclk_src_scaling); i++) {
2290		fvco = 256ULL * fs * 2 * mclk_src_scaling[i].param;
2291		if (fvco > NAU_FVCO_MIN && fvco < NAU_FVCO_MAX &&
2292			fvco_max < fvco) {
2293			fvco_max = fvco;
2294			fvco_sel = i;
2295		}
2296	}
2297	if (ARRAY_SIZE(mclk_src_scaling) == fvco_sel)
2298		return -EINVAL;
2299	fll_param->mclk_src = mclk_src_scaling[fvco_sel].val;
2300
2301	/* Calculate the FLL 10-bit integer input and the FLL 16-bit fractional
2302	 * input based on FDCO, FREF and FLL ratio.
2303	 */
2304	fvco = div_u64(fvco_max << fll_param->fll_frac_num, fref * fll_param->ratio);
2305	fll_param->fll_int = (fvco >> fll_param->fll_frac_num) & 0x3FF;
2306	if (fll_param->fll_frac_num == 16)
2307		fll_param->fll_frac = fvco & 0xFFFF;
2308	else
2309		fll_param->fll_frac = fvco & 0xFFFFFF;
2310	return 0;
2311}
2312
2313static void nau8825_fll_apply(struct nau8825 *nau8825,
2314		struct nau8825_fll *fll_param)
2315{
2316	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
2317		NAU8825_CLK_SRC_MASK | NAU8825_CLK_MCLK_SRC_MASK,
2318		NAU8825_CLK_SRC_MCLK | fll_param->mclk_src);
2319	/* Make DSP operate at high speed for better performance. */
2320	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL1,
2321		NAU8825_FLL_RATIO_MASK | NAU8825_ICTRL_LATCH_MASK,
2322		fll_param->ratio | (0x6 << NAU8825_ICTRL_LATCH_SFT));
2323	/* FLL 16/24 bit fractional input */
2324	if (fll_param->fll_frac_num == 16)
2325		regmap_write(nau8825->regmap, NAU8825_REG_FLL2,
2326			     fll_param->fll_frac);
2327	else {
2328		regmap_write(nau8825->regmap, NAU8825_REG_FLL2_LOWER,
2329			     fll_param->fll_frac & 0xffff);
2330		regmap_write(nau8825->regmap, NAU8825_REG_FLL2_UPPER,
2331			     (fll_param->fll_frac >> 16) & 0xff);
2332	}
2333	/* FLL 10-bit integer input */
2334	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL3,
2335			NAU8825_FLL_INTEGER_MASK, fll_param->fll_int);
2336	/* FLL pre-scaler */
2337	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL4,
2338			NAU8825_FLL_REF_DIV_MASK,
2339			fll_param->clk_ref_div << NAU8825_FLL_REF_DIV_SFT);
2340	/* select divided VCO input */
2341	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2342		NAU8825_FLL_CLK_SW_MASK, NAU8825_FLL_CLK_SW_REF);
2343	/* Disable free-running mode */
2344	regmap_update_bits(nau8825->regmap,
2345		NAU8825_REG_FLL6, NAU8825_DCO_EN, 0);
2346	if (fll_param->fll_frac) {
2347		/* set FLL loop filter enable and cutoff frequency at 500Khz */
2348		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2349			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2350			NAU8825_FLL_FTR_SW_MASK,
2351			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2352			NAU8825_FLL_FTR_SW_FILTER);
2353		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6,
2354			NAU8825_SDM_EN | NAU8825_CUTOFF500,
2355			NAU8825_SDM_EN | NAU8825_CUTOFF500);
2356	} else {
2357		/* disable FLL loop filter and cutoff frequency */
2358		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2359			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2360			NAU8825_FLL_FTR_SW_MASK, NAU8825_FLL_FTR_SW_ACCU);
2361		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6,
2362			NAU8825_SDM_EN | NAU8825_CUTOFF500, 0);
2363	}
2364}
2365
2366/* freq_out must be 256*Fs in order to achieve the best performance */
2367static int nau8825_set_pll(struct snd_soc_component *component, int pll_id, int source,
2368		unsigned int freq_in, unsigned int freq_out)
2369{
2370	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2371	struct nau8825_fll fll_param;
2372	int ret, fs;
2373
2374	if (nau8825->sw_id == NAU8825_SOFTWARE_ID_NAU8825)
2375		fll_param.fll_frac_num = 16;
2376	else
2377		fll_param.fll_frac_num = 24;
2378
2379	fs = freq_out / 256;
2380	ret = nau8825_calc_fll_param(freq_in, fs, &fll_param);
2381	if (ret < 0) {
2382		dev_err(component->dev, "Unsupported input clock %d\n", freq_in);
2383		return ret;
2384	}
2385	dev_dbg(component->dev, "mclk_src=%x ratio=%x fll_frac=%x fll_int=%x clk_ref_div=%x\n",
2386		fll_param.mclk_src, fll_param.ratio, fll_param.fll_frac,
2387		fll_param.fll_int, fll_param.clk_ref_div);
2388
2389	nau8825_fll_apply(nau8825, &fll_param);
2390	mdelay(2);
2391	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
2392			NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
2393	return 0;
2394}
2395
2396static int nau8825_mclk_prepare(struct nau8825 *nau8825, unsigned int freq)
2397{
2398	int ret;
2399
2400	nau8825->mclk = devm_clk_get(nau8825->dev, "mclk");
2401	if (IS_ERR(nau8825->mclk)) {
2402		dev_info(nau8825->dev, "No 'mclk' clock found, assume MCLK is managed externally");
2403		return 0;
2404	}
2405
2406	if (!nau8825->mclk_freq) {
2407		ret = clk_prepare_enable(nau8825->mclk);
2408		if (ret) {
2409			dev_err(nau8825->dev, "Unable to prepare codec mclk\n");
2410			return ret;
2411		}
2412	}
2413
2414	if (nau8825->mclk_freq != freq) {
2415		freq = clk_round_rate(nau8825->mclk, freq);
2416		ret = clk_set_rate(nau8825->mclk, freq);
2417		if (ret) {
2418			dev_err(nau8825->dev, "Unable to set mclk rate\n");
2419			return ret;
2420		}
2421		nau8825->mclk_freq = freq;
2422	}
2423
2424	return 0;
2425}
2426
2427static void nau8825_configure_mclk_as_sysclk(struct regmap *regmap)
2428{
2429	regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2430		NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_MCLK);
2431	regmap_update_bits(regmap, NAU8825_REG_FLL6,
2432		NAU8825_DCO_EN, 0);
2433	/* Make DSP operate as default setting for power saving. */
2434	regmap_update_bits(regmap, NAU8825_REG_FLL1,
2435		NAU8825_ICTRL_LATCH_MASK, 0);
2436}
2437
2438static int nau8825_configure_sysclk(struct nau8825 *nau8825, int clk_id,
2439	unsigned int freq)
2440{
2441	struct regmap *regmap = nau8825->regmap;
2442	int ret;
2443
2444	switch (clk_id) {
2445	case NAU8825_CLK_DIS:
2446		/* Clock provided externally and disable internal VCO clock */
2447		nau8825_configure_mclk_as_sysclk(regmap);
2448		if (nau8825->mclk_freq) {
2449			clk_disable_unprepare(nau8825->mclk);
2450			nau8825->mclk_freq = 0;
2451		}
2452
2453		break;
2454	case NAU8825_CLK_MCLK:
2455		/* Acquire the semaphore to synchronize the playback and
2456		 * interrupt handler. In order to avoid the playback inter-
2457		 * fered by cross talk process, the driver make the playback
2458		 * preparation halted until cross talk process finish.
2459		 */
2460		nau8825_sema_acquire(nau8825, 3 * HZ);
2461		nau8825_configure_mclk_as_sysclk(regmap);
2462		/* MCLK not changed by clock tree */
2463		regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2464			NAU8825_CLK_MCLK_SRC_MASK, 0);
2465		/* Release the semaphore. */
2466		nau8825_sema_release(nau8825);
2467
2468		ret = nau8825_mclk_prepare(nau8825, freq);
2469		if (ret)
2470			return ret;
2471
2472		break;
2473	case NAU8825_CLK_INTERNAL:
2474		if (nau8825_is_jack_inserted(nau8825->regmap)) {
2475			regmap_update_bits(regmap, NAU8825_REG_FLL6,
2476				NAU8825_DCO_EN, NAU8825_DCO_EN);
2477			regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2478				NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
2479			/* Decrease the VCO frequency and make DSP operate
2480			 * as default setting for power saving.
2481			 */
2482			regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2483				NAU8825_CLK_MCLK_SRC_MASK, 0xf);
2484			regmap_update_bits(regmap, NAU8825_REG_FLL1,
2485				NAU8825_ICTRL_LATCH_MASK |
2486				NAU8825_FLL_RATIO_MASK, 0x10);
2487			regmap_update_bits(regmap, NAU8825_REG_FLL6,
2488				NAU8825_SDM_EN, NAU8825_SDM_EN);
2489		} else {
2490			/* The clock turns off intentionally for power saving
2491			 * when no headset connected.
2492			 */
2493			nau8825_configure_mclk_as_sysclk(regmap);
2494			dev_warn(nau8825->dev, "Disable clock for power saving when no headset connected\n");
2495		}
2496		if (nau8825->mclk_freq) {
2497			clk_disable_unprepare(nau8825->mclk);
2498			nau8825->mclk_freq = 0;
2499		}
2500
2501		break;
2502	case NAU8825_CLK_FLL_MCLK:
2503		/* Acquire the semaphore to synchronize the playback and
2504		 * interrupt handler. In order to avoid the playback inter-
2505		 * fered by cross talk process, the driver make the playback
2506		 * preparation halted until cross talk process finish.
2507		 */
2508		nau8825_sema_acquire(nau8825, 3 * HZ);
2509		/* Higher FLL reference input frequency can only set lower
2510		 * gain error, such as 0000 for input reference from MCLK
2511		 * 12.288Mhz.
2512		 */
2513		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2514			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2515			NAU8825_FLL_CLK_SRC_MCLK | 0);
2516		/* Release the semaphore. */
2517		nau8825_sema_release(nau8825);
2518
2519		ret = nau8825_mclk_prepare(nau8825, freq);
2520		if (ret)
2521			return ret;
2522
2523		break;
2524	case NAU8825_CLK_FLL_BLK:
2525		/* Acquire the semaphore to synchronize the playback and
2526		 * interrupt handler. In order to avoid the playback inter-
2527		 * fered by cross talk process, the driver make the playback
2528		 * preparation halted until cross talk process finish.
2529		 */
2530		nau8825_sema_acquire(nau8825, 3 * HZ);
2531		/* If FLL reference input is from low frequency source,
2532		 * higher error gain can apply such as 0xf which has
2533		 * the most sensitive gain error correction threshold,
2534		 * Therefore, FLL has the most accurate DCO to
2535		 * target frequency.
2536		 */
2537		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2538			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2539			NAU8825_FLL_CLK_SRC_BLK |
2540			(0xf << NAU8825_GAIN_ERR_SFT));
2541		/* Release the semaphore. */
2542		nau8825_sema_release(nau8825);
2543
2544		if (nau8825->mclk_freq) {
2545			clk_disable_unprepare(nau8825->mclk);
2546			nau8825->mclk_freq = 0;
2547		}
2548
2549		break;
2550	case NAU8825_CLK_FLL_FS:
2551		/* Acquire the semaphore to synchronize the playback and
2552		 * interrupt handler. In order to avoid the playback inter-
2553		 * fered by cross talk process, the driver make the playback
2554		 * preparation halted until cross talk process finish.
2555		 */
2556		nau8825_sema_acquire(nau8825, 3 * HZ);
2557		/* If FLL reference input is from low frequency source,
2558		 * higher error gain can apply such as 0xf which has
2559		 * the most sensitive gain error correction threshold,
2560		 * Therefore, FLL has the most accurate DCO to
2561		 * target frequency.
2562		 */
2563		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2564			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2565			NAU8825_FLL_CLK_SRC_FS |
2566			(0xf << NAU8825_GAIN_ERR_SFT));
2567		/* Release the semaphore. */
2568		nau8825_sema_release(nau8825);
2569
2570		if (nau8825->mclk_freq) {
2571			clk_disable_unprepare(nau8825->mclk);
2572			nau8825->mclk_freq = 0;
2573		}
2574
2575		break;
2576	default:
2577		dev_err(nau8825->dev, "Invalid clock id (%d)\n", clk_id);
2578		return -EINVAL;
2579	}
2580
2581	dev_dbg(nau8825->dev, "Sysclk is %dHz and clock id is %d\n", freq,
2582		clk_id);
2583	return 0;
2584}
2585
2586static int nau8825_set_sysclk(struct snd_soc_component *component, int clk_id,
2587	int source, unsigned int freq, int dir)
2588{
2589	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2590
2591	return nau8825_configure_sysclk(nau8825, clk_id, freq);
2592}
2593
2594static int nau8825_resume_setup(struct nau8825 *nau8825)
2595{
2596	struct regmap *regmap = nau8825->regmap;
2597
2598	/* Close clock when jack type detection at manual mode */
2599	nau8825_configure_sysclk(nau8825, NAU8825_CLK_DIS, 0);
2600
2601	/* Clear all interruption status */
2602	nau8825_int_status_clear_all(regmap);
2603
2604	/* Enable both insertion and ejection interruptions, and then
2605	 * bypass de-bounce circuit.
2606	 */
2607	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
2608		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_HEADSET_COMPLETE_EN |
2609		NAU8825_IRQ_EJECT_EN | NAU8825_IRQ_INSERT_EN,
2610		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_HEADSET_COMPLETE_EN);
2611	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
2612		NAU8825_JACK_DET_DB_BYPASS, NAU8825_JACK_DET_DB_BYPASS);
2613	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL,
2614		NAU8825_IRQ_INSERT_DIS | NAU8825_IRQ_EJECT_DIS, 0);
2615
2616	return 0;
2617}
2618
2619static int nau8825_set_bias_level(struct snd_soc_component *component,
2620				   enum snd_soc_bias_level level)
2621{
2622	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2623	int ret;
2624
2625	switch (level) {
2626	case SND_SOC_BIAS_ON:
2627		break;
2628
2629	case SND_SOC_BIAS_PREPARE:
2630		break;
2631
2632	case SND_SOC_BIAS_STANDBY:
2633		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
2634			if (nau8825->mclk_freq) {
2635				ret = clk_prepare_enable(nau8825->mclk);
2636				if (ret) {
2637					dev_err(nau8825->dev, "Unable to prepare component mclk\n");
2638					return ret;
2639				}
2640			}
2641			/* Setup codec configuration after resume */
2642			nau8825_resume_setup(nau8825);
2643		}
2644		break;
2645
2646	case SND_SOC_BIAS_OFF:
2647		/* Reset the configuration of jack type for detection */
2648		/* Detach 2kOhm Resistors from MICBIAS to MICGND1/2 */
2649		regmap_update_bits(nau8825->regmap, NAU8825_REG_MIC_BIAS,
2650			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2, 0);
2651		/* ground HPL/HPR, MICGRND1/2 */
2652		regmap_update_bits(nau8825->regmap,
2653			NAU8825_REG_HSD_CTRL, 0xf, 0xf);
2654		/* Cancel and reset cross talk detection funciton */
2655		nau8825_xtalk_cancel(nau8825);
2656		/* Turn off all interruptions before system shutdown. Keep the
2657		 * interruption quiet before resume setup completes.
2658		 */
2659		regmap_write(nau8825->regmap,
2660			NAU8825_REG_INTERRUPT_DIS_CTRL, 0xffff);
2661		/* Disable ADC needed for interruptions at audo mode */
2662		regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
2663			NAU8825_ENABLE_ADC, 0);
2664		if (nau8825->mclk_freq)
2665			clk_disable_unprepare(nau8825->mclk);
2666		break;
2667	}
2668	return 0;
2669}
2670
2671static int __maybe_unused nau8825_suspend(struct snd_soc_component *component)
2672{
2673	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2674
2675	disable_irq(nau8825->irq);
2676	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
2677	/* Power down codec power; don't suppoet button wakeup */
2678	snd_soc_dapm_disable_pin(nau8825->dapm, "SAR");
2679	snd_soc_dapm_disable_pin(nau8825->dapm, "MICBIAS");
2680	snd_soc_dapm_sync(nau8825->dapm);
2681	regcache_cache_only(nau8825->regmap, true);
2682	regcache_mark_dirty(nau8825->regmap);
2683
2684	return 0;
2685}
2686
2687static int __maybe_unused nau8825_resume(struct snd_soc_component *component)
2688{
2689	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2690	int ret;
2691
2692	regcache_cache_only(nau8825->regmap, false);
2693	regcache_sync(nau8825->regmap);
2694	nau8825->xtalk_protect = true;
2695	ret = nau8825_sema_acquire(nau8825, 0);
2696	if (ret)
2697		nau8825->xtalk_protect = false;
2698	enable_irq(nau8825->irq);
2699
2700	return 0;
2701}
2702
2703static int nau8825_set_jack(struct snd_soc_component *component,
2704			    struct snd_soc_jack *jack, void *data)
2705{
2706	return nau8825_enable_jack_detect(component, jack);
2707}
2708
2709static const struct snd_soc_component_driver nau8825_component_driver = {
2710	.probe			= nau8825_component_probe,
2711	.remove			= nau8825_component_remove,
2712	.set_sysclk		= nau8825_set_sysclk,
2713	.set_pll		= nau8825_set_pll,
2714	.set_bias_level		= nau8825_set_bias_level,
2715	.suspend		= nau8825_suspend,
2716	.resume			= nau8825_resume,
2717	.controls		= nau8825_controls,
2718	.num_controls		= ARRAY_SIZE(nau8825_controls),
2719	.dapm_widgets		= nau8825_dapm_widgets,
2720	.num_dapm_widgets	= ARRAY_SIZE(nau8825_dapm_widgets),
2721	.dapm_routes		= nau8825_dapm_routes,
2722	.num_dapm_routes	= ARRAY_SIZE(nau8825_dapm_routes),
2723	.set_jack		= nau8825_set_jack,
2724	.suspend_bias_off	= 1,
2725	.idle_bias_on		= 1,
2726	.use_pmdown_time	= 1,
2727	.endianness		= 1,
 
2728};
2729
2730static void nau8825_reset_chip(struct regmap *regmap)
2731{
2732	regmap_write(regmap, NAU8825_REG_RESET, 0x00);
2733	regmap_write(regmap, NAU8825_REG_RESET, 0x00);
2734}
2735
2736static void nau8825_print_device_properties(struct nau8825 *nau8825)
2737{
2738	int i;
2739	struct device *dev = nau8825->dev;
2740
2741	dev_dbg(dev, "jkdet-enable:         %d\n", nau8825->jkdet_enable);
2742	dev_dbg(dev, "jkdet-pull-enable:    %d\n", nau8825->jkdet_pull_enable);
2743	dev_dbg(dev, "jkdet-pull-up:        %d\n", nau8825->jkdet_pull_up);
2744	dev_dbg(dev, "jkdet-polarity:       %d\n", nau8825->jkdet_polarity);
2745	dev_dbg(dev, "micbias-voltage:      %d\n", nau8825->micbias_voltage);
2746	dev_dbg(dev, "vref-impedance:       %d\n", nau8825->vref_impedance);
2747
2748	dev_dbg(dev, "sar-threshold-num:    %d\n", nau8825->sar_threshold_num);
2749	for (i = 0; i < nau8825->sar_threshold_num; i++)
2750		dev_dbg(dev, "sar-threshold[%d]=%d\n", i,
2751				nau8825->sar_threshold[i]);
2752
2753	dev_dbg(dev, "sar-hysteresis:       %d\n", nau8825->sar_hysteresis);
2754	dev_dbg(dev, "sar-voltage:          %d\n", nau8825->sar_voltage);
2755	dev_dbg(dev, "sar-compare-time:     %d\n", nau8825->sar_compare_time);
2756	dev_dbg(dev, "sar-sampling-time:    %d\n", nau8825->sar_sampling_time);
2757	dev_dbg(dev, "short-key-debounce:   %d\n", nau8825->key_debounce);
2758	dev_dbg(dev, "jack-insert-debounce: %d\n",
2759			nau8825->jack_insert_debounce);
2760	dev_dbg(dev, "jack-eject-debounce:  %d\n",
2761			nau8825->jack_eject_debounce);
2762	dev_dbg(dev, "crosstalk-enable:     %d\n",
2763			nau8825->xtalk_enable);
2764	dev_dbg(dev, "adcout-drive-strong:  %d\n", nau8825->adcout_ds);
2765	dev_dbg(dev, "adc-delay-ms:         %d\n", nau8825->adc_delay);
2766}
2767
2768static int nau8825_read_device_properties(struct device *dev,
2769	struct nau8825 *nau8825) {
2770	int ret;
2771
2772	nau8825->jkdet_enable = device_property_read_bool(dev,
2773		"nuvoton,jkdet-enable");
2774	nau8825->jkdet_pull_enable = device_property_read_bool(dev,
2775		"nuvoton,jkdet-pull-enable");
2776	nau8825->jkdet_pull_up = device_property_read_bool(dev,
2777		"nuvoton,jkdet-pull-up");
2778	ret = device_property_read_u32(dev, "nuvoton,jkdet-polarity",
2779		&nau8825->jkdet_polarity);
2780	if (ret)
2781		nau8825->jkdet_polarity = 1;
2782	ret = device_property_read_u32(dev, "nuvoton,micbias-voltage",
2783		&nau8825->micbias_voltage);
2784	if (ret)
2785		nau8825->micbias_voltage = 6;
2786	ret = device_property_read_u32(dev, "nuvoton,vref-impedance",
2787		&nau8825->vref_impedance);
2788	if (ret)
2789		nau8825->vref_impedance = 2;
2790	ret = device_property_read_u32(dev, "nuvoton,sar-threshold-num",
2791		&nau8825->sar_threshold_num);
2792	if (ret)
2793		nau8825->sar_threshold_num = 4;
2794	ret = device_property_read_u32_array(dev, "nuvoton,sar-threshold",
2795		nau8825->sar_threshold, nau8825->sar_threshold_num);
2796	if (ret) {
2797		nau8825->sar_threshold[0] = 0x08;
2798		nau8825->sar_threshold[1] = 0x12;
2799		nau8825->sar_threshold[2] = 0x26;
2800		nau8825->sar_threshold[3] = 0x73;
2801	}
2802	ret = device_property_read_u32(dev, "nuvoton,sar-hysteresis",
2803		&nau8825->sar_hysteresis);
2804	if (ret)
2805		nau8825->sar_hysteresis = 0;
2806	ret = device_property_read_u32(dev, "nuvoton,sar-voltage",
2807		&nau8825->sar_voltage);
2808	if (ret)
2809		nau8825->sar_voltage = 6;
2810	ret = device_property_read_u32(dev, "nuvoton,sar-compare-time",
2811		&nau8825->sar_compare_time);
2812	if (ret)
2813		nau8825->sar_compare_time = 1;
2814	ret = device_property_read_u32(dev, "nuvoton,sar-sampling-time",
2815		&nau8825->sar_sampling_time);
2816	if (ret)
2817		nau8825->sar_sampling_time = 1;
2818	ret = device_property_read_u32(dev, "nuvoton,short-key-debounce",
2819		&nau8825->key_debounce);
2820	if (ret)
2821		nau8825->key_debounce = 3;
2822	ret = device_property_read_u32(dev, "nuvoton,jack-insert-debounce",
2823		&nau8825->jack_insert_debounce);
2824	if (ret)
2825		nau8825->jack_insert_debounce = 7;
2826	ret = device_property_read_u32(dev, "nuvoton,jack-eject-debounce",
2827		&nau8825->jack_eject_debounce);
2828	if (ret)
2829		nau8825->jack_eject_debounce = 0;
2830	nau8825->xtalk_enable = device_property_read_bool(dev,
2831		"nuvoton,crosstalk-enable");
2832	nau8825->adcout_ds = device_property_read_bool(dev, "nuvoton,adcout-drive-strong");
2833	ret = device_property_read_u32(dev, "nuvoton,adc-delay-ms", &nau8825->adc_delay);
2834	if (ret)
2835		nau8825->adc_delay = 125;
2836	if (nau8825->adc_delay < 125 || nau8825->adc_delay > 500)
2837		dev_warn(dev, "Please set the suitable delay time!\n");
2838
2839	nau8825->mclk = devm_clk_get_optional(dev, "mclk");
2840	if (IS_ERR(nau8825->mclk))
2841		return PTR_ERR(nau8825->mclk);
2842	if (!nau8825->mclk)
2843		/* The MCLK is managed externally or not used at all */
 
2844		dev_info(dev, "No 'mclk' clock found, assume MCLK is managed externally");
 
 
 
2845
2846	return 0;
2847}
2848
2849static int nau8825_setup_irq(struct nau8825 *nau8825)
2850{
2851	int ret;
2852
2853	ret = devm_request_threaded_irq(nau8825->dev, nau8825->irq, NULL,
2854		nau8825_interrupt, IRQF_TRIGGER_LOW | IRQF_ONESHOT,
2855		"nau8825", nau8825);
2856
2857	if (ret) {
2858		dev_err(nau8825->dev, "Cannot request irq %d (%d)\n",
2859			nau8825->irq, ret);
2860		return ret;
2861	}
2862
2863	return 0;
2864}
2865
2866static int nau8825_i2c_probe(struct i2c_client *i2c)
 
2867{
2868	struct device *dev = &i2c->dev;
2869	struct nau8825 *nau8825 = dev_get_platdata(&i2c->dev);
2870	int ret, value;
2871
2872	if (!nau8825) {
2873		nau8825 = devm_kzalloc(dev, sizeof(*nau8825), GFP_KERNEL);
2874		if (!nau8825)
2875			return -ENOMEM;
2876		ret = nau8825_read_device_properties(dev, nau8825);
2877		if (ret)
2878			return ret;
2879	}
2880
2881	i2c_set_clientdata(i2c, nau8825);
2882
2883	nau8825->regmap = devm_regmap_init_i2c(i2c, &nau8825_regmap_config);
2884	if (IS_ERR(nau8825->regmap))
2885		return PTR_ERR(nau8825->regmap);
2886	nau8825->dev = dev;
2887	nau8825->irq = i2c->irq;
2888	/* Initiate parameters, semaphore and work queue which are needed in
2889	 * cross talk suppression measurment function.
2890	 */
2891	nau8825->xtalk_state = NAU8825_XTALK_DONE;
2892	nau8825->xtalk_protect = false;
2893	nau8825->xtalk_baktab_initialized = false;
2894	sema_init(&nau8825->xtalk_sem, 1);
2895	INIT_WORK(&nau8825->xtalk_work, nau8825_xtalk_work);
2896
2897	nau8825_print_device_properties(nau8825);
2898
2899	nau8825_reset_chip(nau8825->regmap);
2900	ret = regmap_read(nau8825->regmap, NAU8825_REG_I2C_DEVICE_ID, &value);
2901	if (ret < 0) {
2902		dev_err(dev, "Failed to read device id from the NAU8825: %d\n",
2903			ret);
2904		return ret;
2905	}
2906	nau8825->sw_id = value & NAU8825_SOFTWARE_ID_MASK;
2907	switch (nau8825->sw_id) {
2908	case NAU8825_SOFTWARE_ID_NAU8825:
2909		break;
2910	case NAU8825_SOFTWARE_ID_NAU8825C:
2911		ret = regmap_register_patch(nau8825->regmap, nau8825_regmap_patch,
2912					    ARRAY_SIZE(nau8825_regmap_patch));
2913		if (ret) {
2914			dev_err(dev, "Failed to register Rev C patch: %d\n", ret);
2915			return ret;
2916		}
2917		break;
2918	default:
2919		dev_err(dev, "Not a NAU8825 chip\n");
2920		return -ENODEV;
2921	}
2922
2923	nau8825_init_regs(nau8825);
2924
2925	if (i2c->irq)
2926		nau8825_setup_irq(nau8825);
2927
2928	return devm_snd_soc_register_component(&i2c->dev,
2929		&nau8825_component_driver,
2930		&nau8825_dai, 1);
2931}
2932
2933static void nau8825_i2c_remove(struct i2c_client *client)
2934{}
 
 
2935
2936static const struct i2c_device_id nau8825_i2c_ids[] = {
2937	{ "nau8825" },
2938	{ }
2939};
2940MODULE_DEVICE_TABLE(i2c, nau8825_i2c_ids);
2941
2942#ifdef CONFIG_OF
2943static const struct of_device_id nau8825_of_ids[] = {
2944	{ .compatible = "nuvoton,nau8825", },
2945	{}
2946};
2947MODULE_DEVICE_TABLE(of, nau8825_of_ids);
2948#endif
2949
2950#ifdef CONFIG_ACPI
2951static const struct acpi_device_id nau8825_acpi_match[] = {
2952	{ "10508825", 0 },
2953	{},
2954};
2955MODULE_DEVICE_TABLE(acpi, nau8825_acpi_match);
2956#endif
2957
2958static struct i2c_driver nau8825_driver = {
2959	.driver = {
2960		.name = "nau8825",
2961		.of_match_table = of_match_ptr(nau8825_of_ids),
2962		.acpi_match_table = ACPI_PTR(nau8825_acpi_match),
2963	},
2964	.probe = nau8825_i2c_probe,
2965	.remove = nau8825_i2c_remove,
2966	.id_table = nau8825_i2c_ids,
2967};
2968module_i2c_driver(nau8825_driver);
2969
2970MODULE_DESCRIPTION("ASoC nau8825 driver");
2971MODULE_AUTHOR("Anatol Pomozov <anatol@chromium.org>");
2972MODULE_LICENSE("GPL");
v5.9
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Nuvoton NAU8825 audio codec driver
   4 *
   5 * Copyright 2015 Google Chromium project.
   6 *  Author: Anatol Pomozov <anatol@chromium.org>
   7 * Copyright 2015 Nuvoton Technology Corp.
   8 *  Co-author: Meng-Huang Kuo <mhkuo@nuvoton.com>
   9 */
  10
  11#include <linux/module.h>
  12#include <linux/delay.h>
  13#include <linux/init.h>
 
  14#include <linux/i2c.h>
  15#include <linux/regmap.h>
  16#include <linux/slab.h>
  17#include <linux/clk.h>
  18#include <linux/acpi.h>
  19#include <linux/math64.h>
  20#include <linux/semaphore.h>
  21
  22#include <sound/initval.h>
  23#include <sound/tlv.h>
  24#include <sound/core.h>
  25#include <sound/pcm.h>
  26#include <sound/pcm_params.h>
  27#include <sound/soc.h>
  28#include <sound/jack.h>
  29
  30
  31#include "nau8825.h"
  32
  33
  34#define NUVOTON_CODEC_DAI "nau8825-hifi"
  35
  36#define NAU_FREF_MAX 13500000
  37#define NAU_FVCO_MAX 124000000
  38#define NAU_FVCO_MIN 90000000
  39
  40/* cross talk suppression detection */
  41#define LOG10_MAGIC 646456993
  42#define GAIN_AUGMENT 22500
  43#define SIDETONE_BASE 207000
  44
  45/* the maximum frequency of CLK_ADC and CLK_DAC */
  46#define CLK_DA_AD_MAX 6144000
  47
  48static int nau8825_configure_sysclk(struct nau8825 *nau8825,
  49		int clk_id, unsigned int freq);
 
  50
  51struct nau8825_fll {
  52	int mclk_src;
  53	int ratio;
  54	int fll_frac;
 
  55	int fll_int;
  56	int clk_ref_div;
  57};
  58
  59struct nau8825_fll_attr {
  60	unsigned int param;
  61	unsigned int val;
  62};
  63
  64/* scaling for mclk from sysclk_src output */
  65static const struct nau8825_fll_attr mclk_src_scaling[] = {
  66	{ 1, 0x0 },
  67	{ 2, 0x2 },
  68	{ 4, 0x3 },
  69	{ 8, 0x4 },
  70	{ 16, 0x5 },
  71	{ 32, 0x6 },
  72	{ 3, 0x7 },
  73	{ 6, 0xa },
  74	{ 12, 0xb },
  75	{ 24, 0xc },
  76	{ 48, 0xd },
  77	{ 96, 0xe },
  78	{ 5, 0xf },
  79};
  80
  81/* ratio for input clk freq */
  82static const struct nau8825_fll_attr fll_ratio[] = {
  83	{ 512000, 0x01 },
  84	{ 256000, 0x02 },
  85	{ 128000, 0x04 },
  86	{ 64000, 0x08 },
  87	{ 32000, 0x10 },
  88	{ 8000, 0x20 },
  89	{ 4000, 0x40 },
  90};
  91
  92static const struct nau8825_fll_attr fll_pre_scalar[] = {
  93	{ 1, 0x0 },
  94	{ 2, 0x1 },
  95	{ 4, 0x2 },
  96	{ 8, 0x3 },
  97};
  98
  99/* over sampling rate */
 100struct nau8825_osr_attr {
 101	unsigned int osr;
 102	unsigned int clk_src;
 103};
 104
 105static const struct nau8825_osr_attr osr_dac_sel[] = {
 106	{ 64, 2 },	/* OSR 64, SRC 1/4 */
 107	{ 256, 0 },	/* OSR 256, SRC 1 */
 108	{ 128, 1 },	/* OSR 128, SRC 1/2 */
 109	{ 0, 0 },
 110	{ 32, 3 },	/* OSR 32, SRC 1/8 */
 111};
 112
 113static const struct nau8825_osr_attr osr_adc_sel[] = {
 114	{ 32, 3 },	/* OSR 32, SRC 1/8 */
 115	{ 64, 2 },	/* OSR 64, SRC 1/4 */
 116	{ 128, 1 },	/* OSR 128, SRC 1/2 */
 117	{ 256, 0 },	/* OSR 256, SRC 1 */
 118};
 119
 120static const struct reg_default nau8825_reg_defaults[] = {
 121	{ NAU8825_REG_ENA_CTRL, 0x00ff },
 122	{ NAU8825_REG_IIC_ADDR_SET, 0x0 },
 123	{ NAU8825_REG_CLK_DIVIDER, 0x0050 },
 124	{ NAU8825_REG_FLL1, 0x0 },
 125	{ NAU8825_REG_FLL2, 0x3126 },
 126	{ NAU8825_REG_FLL3, 0x0008 },
 127	{ NAU8825_REG_FLL4, 0x0010 },
 128	{ NAU8825_REG_FLL5, 0x0 },
 129	{ NAU8825_REG_FLL6, 0x6000 },
 130	{ NAU8825_REG_FLL_VCO_RSV, 0xf13c },
 131	{ NAU8825_REG_HSD_CTRL, 0x000c },
 132	{ NAU8825_REG_JACK_DET_CTRL, 0x0 },
 133	{ NAU8825_REG_INTERRUPT_MASK, 0x0 },
 134	{ NAU8825_REG_INTERRUPT_DIS_CTRL, 0xffff },
 135	{ NAU8825_REG_SAR_CTRL, 0x0015 },
 136	{ NAU8825_REG_KEYDET_CTRL, 0x0110 },
 137	{ NAU8825_REG_VDET_THRESHOLD_1, 0x0 },
 138	{ NAU8825_REG_VDET_THRESHOLD_2, 0x0 },
 139	{ NAU8825_REG_VDET_THRESHOLD_3, 0x0 },
 140	{ NAU8825_REG_VDET_THRESHOLD_4, 0x0 },
 141	{ NAU8825_REG_GPIO34_CTRL, 0x0 },
 142	{ NAU8825_REG_GPIO12_CTRL, 0x0 },
 143	{ NAU8825_REG_TDM_CTRL, 0x0 },
 144	{ NAU8825_REG_I2S_PCM_CTRL1, 0x000b },
 145	{ NAU8825_REG_I2S_PCM_CTRL2, 0x8010 },
 146	{ NAU8825_REG_LEFT_TIME_SLOT, 0x0 },
 147	{ NAU8825_REG_RIGHT_TIME_SLOT, 0x0 },
 148	{ NAU8825_REG_BIQ_CTRL, 0x0 },
 149	{ NAU8825_REG_BIQ_COF1, 0x0 },
 150	{ NAU8825_REG_BIQ_COF2, 0x0 },
 151	{ NAU8825_REG_BIQ_COF3, 0x0 },
 152	{ NAU8825_REG_BIQ_COF4, 0x0 },
 153	{ NAU8825_REG_BIQ_COF5, 0x0 },
 154	{ NAU8825_REG_BIQ_COF6, 0x0 },
 155	{ NAU8825_REG_BIQ_COF7, 0x0 },
 156	{ NAU8825_REG_BIQ_COF8, 0x0 },
 157	{ NAU8825_REG_BIQ_COF9, 0x0 },
 158	{ NAU8825_REG_BIQ_COF10, 0x0 },
 159	{ NAU8825_REG_ADC_RATE, 0x0010 },
 160	{ NAU8825_REG_DAC_CTRL1, 0x0001 },
 161	{ NAU8825_REG_DAC_CTRL2, 0x0 },
 162	{ NAU8825_REG_DAC_DGAIN_CTRL, 0x0 },
 163	{ NAU8825_REG_ADC_DGAIN_CTRL, 0x00cf },
 164	{ NAU8825_REG_MUTE_CTRL, 0x0 },
 165	{ NAU8825_REG_HSVOL_CTRL, 0x0 },
 166	{ NAU8825_REG_DACL_CTRL, 0x02cf },
 167	{ NAU8825_REG_DACR_CTRL, 0x00cf },
 168	{ NAU8825_REG_ADC_DRC_KNEE_IP12, 0x1486 },
 169	{ NAU8825_REG_ADC_DRC_KNEE_IP34, 0x0f12 },
 170	{ NAU8825_REG_ADC_DRC_SLOPES, 0x25ff },
 171	{ NAU8825_REG_ADC_DRC_ATKDCY, 0x3457 },
 172	{ NAU8825_REG_DAC_DRC_KNEE_IP12, 0x1486 },
 173	{ NAU8825_REG_DAC_DRC_KNEE_IP34, 0x0f12 },
 174	{ NAU8825_REG_DAC_DRC_SLOPES, 0x25f9 },
 175	{ NAU8825_REG_DAC_DRC_ATKDCY, 0x3457 },
 176	{ NAU8825_REG_IMM_MODE_CTRL, 0x0 },
 177	{ NAU8825_REG_CLASSG_CTRL, 0x0 },
 178	{ NAU8825_REG_OPT_EFUSE_CTRL, 0x0 },
 179	{ NAU8825_REG_MISC_CTRL, 0x0 },
 
 
 180	{ NAU8825_REG_BIAS_ADJ, 0x0 },
 181	{ NAU8825_REG_TRIM_SETTINGS, 0x0 },
 182	{ NAU8825_REG_ANALOG_CONTROL_1, 0x0 },
 183	{ NAU8825_REG_ANALOG_CONTROL_2, 0x0 },
 184	{ NAU8825_REG_ANALOG_ADC_1, 0x0011 },
 185	{ NAU8825_REG_ANALOG_ADC_2, 0x0020 },
 186	{ NAU8825_REG_RDAC, 0x0008 },
 187	{ NAU8825_REG_MIC_BIAS, 0x0006 },
 188	{ NAU8825_REG_BOOST, 0x0 },
 189	{ NAU8825_REG_FEPGA, 0x0 },
 190	{ NAU8825_REG_POWER_UP_CONTROL, 0x0 },
 191	{ NAU8825_REG_CHARGE_PUMP, 0x0 },
 192};
 193
 194/* register backup table when cross talk detection */
 195static struct reg_default nau8825_xtalk_baktab[] = {
 196	{ NAU8825_REG_ADC_DGAIN_CTRL, 0x00cf },
 197	{ NAU8825_REG_HSVOL_CTRL, 0 },
 198	{ NAU8825_REG_DACL_CTRL, 0x00cf },
 199	{ NAU8825_REG_DACR_CTRL, 0x02cf },
 200};
 201
 202static const unsigned short logtable[256] = {
 203	0x0000, 0x0171, 0x02e0, 0x044e, 0x05ba, 0x0725, 0x088e, 0x09f7,
 204	0x0b5d, 0x0cc3, 0x0e27, 0x0f8a, 0x10eb, 0x124b, 0x13aa, 0x1508,
 205	0x1664, 0x17bf, 0x1919, 0x1a71, 0x1bc8, 0x1d1e, 0x1e73, 0x1fc6,
 206	0x2119, 0x226a, 0x23ba, 0x2508, 0x2656, 0x27a2, 0x28ed, 0x2a37,
 207	0x2b80, 0x2cc8, 0x2e0f, 0x2f54, 0x3098, 0x31dc, 0x331e, 0x345f,
 208	0x359f, 0x36de, 0x381b, 0x3958, 0x3a94, 0x3bce, 0x3d08, 0x3e41,
 209	0x3f78, 0x40af, 0x41e4, 0x4319, 0x444c, 0x457f, 0x46b0, 0x47e1,
 210	0x4910, 0x4a3f, 0x4b6c, 0x4c99, 0x4dc5, 0x4eef, 0x5019, 0x5142,
 211	0x526a, 0x5391, 0x54b7, 0x55dc, 0x5700, 0x5824, 0x5946, 0x5a68,
 212	0x5b89, 0x5ca8, 0x5dc7, 0x5ee5, 0x6003, 0x611f, 0x623a, 0x6355,
 213	0x646f, 0x6588, 0x66a0, 0x67b7, 0x68ce, 0x69e4, 0x6af8, 0x6c0c,
 214	0x6d20, 0x6e32, 0x6f44, 0x7055, 0x7165, 0x7274, 0x7383, 0x7490,
 215	0x759d, 0x76aa, 0x77b5, 0x78c0, 0x79ca, 0x7ad3, 0x7bdb, 0x7ce3,
 216	0x7dea, 0x7ef0, 0x7ff6, 0x80fb, 0x81ff, 0x8302, 0x8405, 0x8507,
 217	0x8608, 0x8709, 0x8809, 0x8908, 0x8a06, 0x8b04, 0x8c01, 0x8cfe,
 218	0x8dfa, 0x8ef5, 0x8fef, 0x90e9, 0x91e2, 0x92db, 0x93d2, 0x94ca,
 219	0x95c0, 0x96b6, 0x97ab, 0x98a0, 0x9994, 0x9a87, 0x9b7a, 0x9c6c,
 220	0x9d5e, 0x9e4f, 0x9f3f, 0xa02e, 0xa11e, 0xa20c, 0xa2fa, 0xa3e7,
 221	0xa4d4, 0xa5c0, 0xa6ab, 0xa796, 0xa881, 0xa96a, 0xaa53, 0xab3c,
 222	0xac24, 0xad0c, 0xadf2, 0xaed9, 0xafbe, 0xb0a4, 0xb188, 0xb26c,
 223	0xb350, 0xb433, 0xb515, 0xb5f7, 0xb6d9, 0xb7ba, 0xb89a, 0xb97a,
 224	0xba59, 0xbb38, 0xbc16, 0xbcf4, 0xbdd1, 0xbead, 0xbf8a, 0xc065,
 225	0xc140, 0xc21b, 0xc2f5, 0xc3cf, 0xc4a8, 0xc580, 0xc658, 0xc730,
 226	0xc807, 0xc8de, 0xc9b4, 0xca8a, 0xcb5f, 0xcc34, 0xcd08, 0xcddc,
 227	0xceaf, 0xcf82, 0xd054, 0xd126, 0xd1f7, 0xd2c8, 0xd399, 0xd469,
 228	0xd538, 0xd607, 0xd6d6, 0xd7a4, 0xd872, 0xd93f, 0xda0c, 0xdad9,
 229	0xdba5, 0xdc70, 0xdd3b, 0xde06, 0xded0, 0xdf9a, 0xe063, 0xe12c,
 230	0xe1f5, 0xe2bd, 0xe385, 0xe44c, 0xe513, 0xe5d9, 0xe69f, 0xe765,
 231	0xe82a, 0xe8ef, 0xe9b3, 0xea77, 0xeb3b, 0xebfe, 0xecc1, 0xed83,
 232	0xee45, 0xef06, 0xefc8, 0xf088, 0xf149, 0xf209, 0xf2c8, 0xf387,
 233	0xf446, 0xf505, 0xf5c3, 0xf680, 0xf73e, 0xf7fb, 0xf8b7, 0xf973,
 234	0xfa2f, 0xfaea, 0xfba5, 0xfc60, 0xfd1a, 0xfdd4, 0xfe8e, 0xff47
 235};
 236
 237/**
 238 * nau8825_sema_acquire - acquire the semaphore of nau88l25
 239 * @nau8825:  component to register the codec private data with
 240 * @timeout: how long in jiffies to wait before failure or zero to wait
 241 * until release
 242 *
 243 * Attempts to acquire the semaphore with number of jiffies. If no more
 244 * tasks are allowed to acquire the semaphore, calling this function will
 245 * put the task to sleep. If the semaphore is not released within the
 246 * specified number of jiffies, this function returns.
 247 * If the semaphore is not released within the specified number of jiffies,
 248 * this function returns -ETIME. If the sleep is interrupted by a signal,
 249 * this function will return -EINTR. It returns 0 if the semaphore was
 250 * acquired successfully.
 251 *
 252 * Acquires the semaphore without jiffies. Try to acquire the semaphore
 253 * atomically. Returns 0 if the semaphore has been acquired successfully
 254 * or 1 if it it cannot be acquired.
 255 */
 256static int nau8825_sema_acquire(struct nau8825 *nau8825, long timeout)
 257{
 258	int ret;
 259
 260	if (timeout) {
 261		ret = down_timeout(&nau8825->xtalk_sem, timeout);
 262		if (ret < 0)
 263			dev_warn(nau8825->dev, "Acquire semaphore timeout\n");
 264	} else {
 265		ret = down_trylock(&nau8825->xtalk_sem);
 266		if (ret)
 267			dev_warn(nau8825->dev, "Acquire semaphore fail\n");
 268	}
 269
 270	return ret;
 271}
 272
 273/**
 274 * nau8825_sema_release - release the semaphore of nau88l25
 275 * @nau8825:  component to register the codec private data with
 276 *
 277 * Release the semaphore which may be called from any context and
 278 * even by tasks which have never called down().
 279 */
 280static inline void nau8825_sema_release(struct nau8825 *nau8825)
 281{
 282	up(&nau8825->xtalk_sem);
 283}
 284
 285/**
 286 * nau8825_sema_reset - reset the semaphore for nau88l25
 287 * @nau8825:  component to register the codec private data with
 288 *
 289 * Reset the counter of the semaphore. Call this function to restart
 290 * a new round task management.
 291 */
 292static inline void nau8825_sema_reset(struct nau8825 *nau8825)
 293{
 294	nau8825->xtalk_sem.count = 1;
 295}
 296
 297/**
 298 * Ramp up the headphone volume change gradually to target level.
 299 *
 300 * @nau8825:  component to register the codec private data with
 301 * @vol_from: the volume to start up
 302 * @vol_to: the target volume
 303 * @step: the volume span to move on
 304 *
 305 * The headphone volume is from 0dB to minimum -54dB and -1dB per step.
 306 * If the volume changes sharp, there is a pop noise heard in headphone. We
 307 * provide the function to ramp up the volume up or down by delaying 10ms
 308 * per step.
 309 */
 310static void nau8825_hpvol_ramp(struct nau8825 *nau8825,
 311	unsigned int vol_from, unsigned int vol_to, unsigned int step)
 312{
 313	unsigned int value, volume, ramp_up, from, to;
 314
 315	if (vol_from == vol_to || step == 0) {
 316		return;
 317	} else if (vol_from < vol_to) {
 318		ramp_up = true;
 319		from = vol_from;
 320		to = vol_to;
 321	} else {
 322		ramp_up = false;
 323		from = vol_to;
 324		to = vol_from;
 325	}
 326	/* only handle volume from 0dB to minimum -54dB */
 327	if (to > NAU8825_HP_VOL_MIN)
 328		to = NAU8825_HP_VOL_MIN;
 329
 330	for (volume = from; volume < to; volume += step) {
 331		if (ramp_up)
 332			value = volume;
 333		else
 334			value = to - volume + from;
 335		regmap_update_bits(nau8825->regmap, NAU8825_REG_HSVOL_CTRL,
 336			NAU8825_HPL_VOL_MASK | NAU8825_HPR_VOL_MASK,
 337			(value << NAU8825_HPL_VOL_SFT) | value);
 338		usleep_range(10000, 10500);
 339	}
 340	if (ramp_up)
 341		value = to;
 342	else
 343		value = from;
 344	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSVOL_CTRL,
 345		NAU8825_HPL_VOL_MASK | NAU8825_HPR_VOL_MASK,
 346		(value << NAU8825_HPL_VOL_SFT) | value);
 347}
 348
 349/**
 350 * Computes log10 of a value; the result is round off to 3 decimal. This func-
 351 * tion takes reference to dvb-math. The source code locates as the following.
 352 * Linux/drivers/media/dvb-core/dvb_math.c
 353 * @value:  input for log10
 354 *
 355 * return log10(value) * 1000
 356 */
 357static u32 nau8825_intlog10_dec3(u32 value)
 358{
 359	u32 msb, logentry, significand, interpolation, log10val;
 360	u64 log2val;
 361
 362	/* first detect the msb (count begins at 0) */
 363	msb = fls(value) - 1;
 364	/**
 365	 *      now we use a logtable after the following method:
 366	 *
 367	 *      log2(2^x * y) * 2^24 = x * 2^24 + log2(y) * 2^24
 368	 *      where x = msb and therefore 1 <= y < 2
 369	 *      first y is determined by shifting the value left
 370	 *      so that msb is bit 31
 371	 *              0x00231f56 -> 0x8C7D5800
 372	 *      the result is y * 2^31 -> "significand"
 373	 *      then the highest 9 bits are used for a table lookup
 374	 *      the highest bit is discarded because it's always set
 375	 *      the highest nine bits in our example are 100011000
 376	 *      so we would use the entry 0x18
 377	 */
 378	significand = value << (31 - msb);
 379	logentry = (significand >> 23) & 0xff;
 380	/**
 381	 *      last step we do is interpolation because of the
 382	 *      limitations of the log table the error is that part of
 383	 *      the significand which isn't used for lookup then we
 384	 *      compute the ratio between the error and the next table entry
 385	 *      and interpolate it between the log table entry used and the
 386	 *      next one the biggest error possible is 0x7fffff
 387	 *      (in our example it's 0x7D5800)
 388	 *      needed value for next table entry is 0x800000
 389	 *      so the interpolation is
 390	 *      (error / 0x800000) * (logtable_next - logtable_current)
 391	 *      in the implementation the division is moved to the end for
 392	 *      better accuracy there is also an overflow correction if
 393	 *      logtable_next is 256
 394	 */
 395	interpolation = ((significand & 0x7fffff) *
 396		((logtable[(logentry + 1) & 0xff] -
 397		logtable[logentry]) & 0xffff)) >> 15;
 398
 399	log2val = ((msb << 24) + (logtable[logentry] << 8) + interpolation);
 400	/**
 401	 *      log10(x) = log2(x) * log10(2)
 402	 */
 403	log10val = (log2val * LOG10_MAGIC) >> 31;
 404	/**
 405	 *      the result is round off to 3 decimal
 406	 */
 407	return log10val / ((1 << 24) / 1000);
 408}
 409
 410/**
 411 * computes cross talk suppression sidetone gain.
 412 *
 413 * @sig_org: orignal signal level
 414 * @sig_cros: cross talk signal level
 415 *
 416 * The orignal and cross talk signal vlues need to be characterized.
 417 * Once these values have been characterized, this sidetone value
 418 * can be converted to decibel with the equation below.
 419 * sidetone = 20 * log (original signal level / crosstalk signal level)
 420 *
 421 * return cross talk sidetone gain
 422 */
 423static u32 nau8825_xtalk_sidetone(u32 sig_org, u32 sig_cros)
 424{
 425	u32 gain, sidetone;
 426
 427	if (WARN_ON(sig_org == 0 || sig_cros == 0))
 428		return 0;
 429
 430	sig_org = nau8825_intlog10_dec3(sig_org);
 431	sig_cros = nau8825_intlog10_dec3(sig_cros);
 432	if (sig_org >= sig_cros)
 433		gain = (sig_org - sig_cros) * 20 + GAIN_AUGMENT;
 434	else
 435		gain = (sig_cros - sig_org) * 20 + GAIN_AUGMENT;
 436	sidetone = SIDETONE_BASE - gain * 2;
 437	sidetone /= 1000;
 438
 439	return sidetone;
 440}
 441
 442static int nau8825_xtalk_baktab_index_by_reg(unsigned int reg)
 443{
 444	int index;
 445
 446	for (index = 0; index < ARRAY_SIZE(nau8825_xtalk_baktab); index++)
 447		if (nau8825_xtalk_baktab[index].reg == reg)
 448			return index;
 449	return -EINVAL;
 450}
 451
 452static void nau8825_xtalk_backup(struct nau8825 *nau8825)
 453{
 454	int i;
 455
 456	if (nau8825->xtalk_baktab_initialized)
 457		return;
 458
 459	/* Backup some register values to backup table */
 460	for (i = 0; i < ARRAY_SIZE(nau8825_xtalk_baktab); i++)
 461		regmap_read(nau8825->regmap, nau8825_xtalk_baktab[i].reg,
 462				&nau8825_xtalk_baktab[i].def);
 463
 464	nau8825->xtalk_baktab_initialized = true;
 465}
 466
 467static void nau8825_xtalk_restore(struct nau8825 *nau8825, bool cause_cancel)
 468{
 469	int i, volume;
 470
 471	if (!nau8825->xtalk_baktab_initialized)
 472		return;
 473
 474	/* Restore register values from backup table; When the driver restores
 475	 * the headphone volume in XTALK_DONE state, it needs recover to
 476	 * original level gradually with 3dB per step for less pop noise.
 477	 * Otherwise, the restore should do ASAP.
 478	 */
 479	for (i = 0; i < ARRAY_SIZE(nau8825_xtalk_baktab); i++) {
 480		if (!cause_cancel && nau8825_xtalk_baktab[i].reg ==
 481			NAU8825_REG_HSVOL_CTRL) {
 482			/* Ramping up the volume change to reduce pop noise */
 483			volume = nau8825_xtalk_baktab[i].def &
 484				NAU8825_HPR_VOL_MASK;
 485			nau8825_hpvol_ramp(nau8825, 0, volume, 3);
 486			continue;
 487		}
 488		regmap_write(nau8825->regmap, nau8825_xtalk_baktab[i].reg,
 489				nau8825_xtalk_baktab[i].def);
 490	}
 491
 492	nau8825->xtalk_baktab_initialized = false;
 493}
 494
 495static void nau8825_xtalk_prepare_dac(struct nau8825 *nau8825)
 496{
 497	/* Enable power of DAC path */
 498	regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 499		NAU8825_ENABLE_DACR | NAU8825_ENABLE_DACL |
 500		NAU8825_ENABLE_ADC | NAU8825_ENABLE_ADC_CLK |
 501		NAU8825_ENABLE_DAC_CLK, NAU8825_ENABLE_DACR |
 502		NAU8825_ENABLE_DACL | NAU8825_ENABLE_ADC |
 503		NAU8825_ENABLE_ADC_CLK | NAU8825_ENABLE_DAC_CLK);
 504	/* Prevent startup click by letting charge pump to ramp up and
 505	 * change bump enable
 506	 */
 507	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 508		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN,
 509		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN);
 510	/* Enable clock sync of DAC and DAC clock */
 511	regmap_update_bits(nau8825->regmap, NAU8825_REG_RDAC,
 512		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN |
 513		NAU8825_RDAC_FS_BCLK_ENB,
 514		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN);
 515	/* Power up output driver with 2 stage */
 516	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 517		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 518		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L,
 519		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 520		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L);
 521	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 522		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L,
 523		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L);
 524	/* HP outputs not shouted to ground  */
 525	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSD_CTRL,
 526		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L, 0);
 527	/* Enable HP boost driver */
 528	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 529		NAU8825_HP_BOOST_DIS, NAU8825_HP_BOOST_DIS);
 530	/* Enable class G compare path to supply 1.8V or 0.9V. */
 531	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLASSG_CTRL,
 532		NAU8825_CLASSG_LDAC_EN | NAU8825_CLASSG_RDAC_EN,
 533		NAU8825_CLASSG_LDAC_EN | NAU8825_CLASSG_RDAC_EN);
 534}
 535
 536static void nau8825_xtalk_prepare_adc(struct nau8825 *nau8825)
 537{
 538	/* Power up left ADC and raise 5dB than Vmid for Vref  */
 539	regmap_update_bits(nau8825->regmap, NAU8825_REG_ANALOG_ADC_2,
 540		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_MASK,
 541		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_VMID_PLUS_0_5DB);
 542}
 543
 544static void nau8825_xtalk_clock(struct nau8825 *nau8825)
 545{
 546	/* Recover FLL default value */
 547	regmap_write(nau8825->regmap, NAU8825_REG_FLL1, 0x0);
 548	regmap_write(nau8825->regmap, NAU8825_REG_FLL2, 0x3126);
 549	regmap_write(nau8825->regmap, NAU8825_REG_FLL3, 0x0008);
 550	regmap_write(nau8825->regmap, NAU8825_REG_FLL4, 0x0010);
 551	regmap_write(nau8825->regmap, NAU8825_REG_FLL5, 0x0);
 552	regmap_write(nau8825->regmap, NAU8825_REG_FLL6, 0x6000);
 553	/* Enable internal VCO clock for detection signal generated */
 554	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
 555		NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
 556	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6, NAU8825_DCO_EN,
 557		NAU8825_DCO_EN);
 558	/* Given specific clock frequency of internal clock to
 559	 * generate signal.
 560	 */
 561	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
 562		NAU8825_CLK_MCLK_SRC_MASK, 0xf);
 563	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL1,
 564		NAU8825_FLL_RATIO_MASK, 0x10);
 565}
 566
 567static void nau8825_xtalk_prepare(struct nau8825 *nau8825)
 568{
 569	int volume, index;
 570
 571	/* Backup those registers changed by cross talk detection */
 572	nau8825_xtalk_backup(nau8825);
 573	/* Config IIS as master to output signal by codec */
 574	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
 575		NAU8825_I2S_MS_MASK | NAU8825_I2S_LRC_DIV_MASK |
 576		NAU8825_I2S_BLK_DIV_MASK, NAU8825_I2S_MS_MASTER |
 577		(0x2 << NAU8825_I2S_LRC_DIV_SFT) | 0x1);
 578	/* Ramp up headphone volume to 0dB to get better performance and
 579	 * avoid pop noise in headphone.
 580	 */
 581	index = nau8825_xtalk_baktab_index_by_reg(NAU8825_REG_HSVOL_CTRL);
 582	if (index != -EINVAL) {
 583		volume = nau8825_xtalk_baktab[index].def &
 584				NAU8825_HPR_VOL_MASK;
 585		nau8825_hpvol_ramp(nau8825, volume, 0, 3);
 586	}
 587	nau8825_xtalk_clock(nau8825);
 588	nau8825_xtalk_prepare_dac(nau8825);
 589	nau8825_xtalk_prepare_adc(nau8825);
 590	/* Config channel path and digital gain */
 591	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACL_CTRL,
 592		NAU8825_DACL_CH_SEL_MASK | NAU8825_DACL_CH_VOL_MASK,
 593		NAU8825_DACL_CH_SEL_L | 0xab);
 594	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACR_CTRL,
 595		NAU8825_DACR_CH_SEL_MASK | NAU8825_DACR_CH_VOL_MASK,
 596		NAU8825_DACR_CH_SEL_R | 0xab);
 597	/* Config cross talk parameters and generate the 23Hz sine wave with
 598	 * 1/16 full scale of signal level for impedance measurement.
 599	 */
 600	regmap_update_bits(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL,
 601		NAU8825_IMM_THD_MASK | NAU8825_IMM_GEN_VOL_MASK |
 602		NAU8825_IMM_CYC_MASK | NAU8825_IMM_DAC_SRC_MASK,
 603		(0x9 << NAU8825_IMM_THD_SFT) | NAU8825_IMM_GEN_VOL_1_16th |
 604		NAU8825_IMM_CYC_8192 | NAU8825_IMM_DAC_SRC_SIN);
 605	/* RMS intrruption enable */
 606	regmap_update_bits(nau8825->regmap,
 607		NAU8825_REG_INTERRUPT_MASK, NAU8825_IRQ_RMS_EN, 0);
 608	/* Power up left and right DAC */
 609	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 610		NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL, 0);
 
 
 
 
 
 611}
 612
 613static void nau8825_xtalk_clean_dac(struct nau8825 *nau8825)
 614{
 615	/* Disable HP boost driver */
 616	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
 617		NAU8825_HP_BOOST_DIS, 0);
 618	/* HP outputs shouted to ground  */
 619	regmap_update_bits(nau8825->regmap, NAU8825_REG_HSD_CTRL,
 620		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L,
 621		NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
 622	/* Power down left and right DAC */
 623	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 624		NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
 625		NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 
 
 
 
 
 626	/* Enable the TESTDAC and  disable L/R HP impedance */
 627	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 628		NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP |
 629		NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
 630	/* Power down output driver with 2 stage */
 631	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 632		NAU8825_POWERUP_HP_DRV_R | NAU8825_POWERUP_HP_DRV_L, 0);
 633	regmap_update_bits(nau8825->regmap, NAU8825_REG_POWER_UP_CONTROL,
 634		NAU8825_POWERUP_INTEGR_R | NAU8825_POWERUP_INTEGR_L |
 635		NAU8825_POWERUP_DRV_IN_R | NAU8825_POWERUP_DRV_IN_L, 0);
 636	/* Disable clock sync of DAC and DAC clock */
 637	regmap_update_bits(nau8825->regmap, NAU8825_REG_RDAC,
 638		NAU8825_RDAC_EN | NAU8825_RDAC_CLK_EN, 0);
 639	/* Disable charge pump ramp up function and change bump */
 640	regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 641		NAU8825_JAMNODCLOW | NAU8825_CHANRGE_PUMP_EN, 0);
 642	/* Disable power of DAC path */
 643	regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 644		NAU8825_ENABLE_DACR | NAU8825_ENABLE_DACL |
 645		NAU8825_ENABLE_ADC_CLK | NAU8825_ENABLE_DAC_CLK, 0);
 646	if (!nau8825->irq)
 647		regmap_update_bits(nau8825->regmap,
 648			NAU8825_REG_ENA_CTRL, NAU8825_ENABLE_ADC, 0);
 649}
 650
 651static void nau8825_xtalk_clean_adc(struct nau8825 *nau8825)
 652{
 653	/* Power down left ADC and restore voltage to Vmid */
 654	regmap_update_bits(nau8825->regmap, NAU8825_REG_ANALOG_ADC_2,
 655		NAU8825_POWERUP_ADCL | NAU8825_ADC_VREFSEL_MASK, 0);
 656}
 657
 658static void nau8825_xtalk_clean(struct nau8825 *nau8825, bool cause_cancel)
 659{
 660	/* Enable internal VCO needed for interruptions */
 661	nau8825_configure_sysclk(nau8825, NAU8825_CLK_INTERNAL, 0);
 662	nau8825_xtalk_clean_dac(nau8825);
 663	nau8825_xtalk_clean_adc(nau8825);
 664	/* Clear cross talk parameters and disable */
 665	regmap_write(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL, 0);
 666	/* RMS intrruption disable */
 667	regmap_update_bits(nau8825->regmap, NAU8825_REG_INTERRUPT_MASK,
 668		NAU8825_IRQ_RMS_EN, NAU8825_IRQ_RMS_EN);
 669	/* Recover default value for IIS */
 670	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
 671		NAU8825_I2S_MS_MASK | NAU8825_I2S_LRC_DIV_MASK |
 672		NAU8825_I2S_BLK_DIV_MASK, NAU8825_I2S_MS_SLAVE);
 673	/* Restore value of specific register for cross talk */
 674	nau8825_xtalk_restore(nau8825, cause_cancel);
 675}
 676
 677static void nau8825_xtalk_imm_start(struct nau8825 *nau8825, int vol)
 678{
 679	/* Apply ADC volume for better cross talk performance */
 680	regmap_update_bits(nau8825->regmap, NAU8825_REG_ADC_DGAIN_CTRL,
 681				NAU8825_ADC_DIG_VOL_MASK, vol);
 682	/* Disables JKTIP(HPL) DAC channel for right to left measurement.
 683	 * Do it before sending signal in order to erase pop noise.
 684	 */
 685	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 686		NAU8825_BIAS_TESTDACR_EN | NAU8825_BIAS_TESTDACL_EN,
 687		NAU8825_BIAS_TESTDACL_EN);
 688	switch (nau8825->xtalk_state) {
 689	case NAU8825_XTALK_HPR_R2L:
 690		/* Enable right headphone impedance */
 691		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 692			NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP,
 693			NAU8825_BIAS_HPR_IMP);
 694		break;
 695	case NAU8825_XTALK_HPL_R2L:
 696		/* Enable left headphone impedance */
 697		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 698			NAU8825_BIAS_HPR_IMP | NAU8825_BIAS_HPL_IMP,
 699			NAU8825_BIAS_HPL_IMP);
 700		break;
 701	default:
 702		break;
 703	}
 704	msleep(100);
 705	/* Impedance measurement mode enable */
 706	regmap_update_bits(nau8825->regmap, NAU8825_REG_IMM_MODE_CTRL,
 707				NAU8825_IMM_EN, NAU8825_IMM_EN);
 708}
 709
 710static void nau8825_xtalk_imm_stop(struct nau8825 *nau8825)
 711{
 712	/* Impedance measurement mode disable */
 713	regmap_update_bits(nau8825->regmap,
 714		NAU8825_REG_IMM_MODE_CTRL, NAU8825_IMM_EN, 0);
 715}
 716
 717/* The cross talk measurement function can reduce cross talk across the
 718 * JKTIP(HPL) and JKR1(HPR) outputs which measures the cross talk signal
 719 * level to determine what cross talk reduction gain is. This system works by
 720 * sending a 23Hz -24dBV sine wave into the headset output DAC and through
 721 * the PGA. The output of the PGA is then connected to an internal current
 722 * sense which measures the attenuated 23Hz signal and passing the output to
 723 * an ADC which converts the measurement to a binary code. With two separated
 724 * measurement, one for JKR1(HPR) and the other JKTIP(HPL), measurement data
 725 * can be separated read in IMM_RMS_L for HSR and HSL after each measurement.
 726 * Thus, the measurement function has four states to complete whole sequence.
 727 * 1. Prepare state : Prepare the resource for detection and transfer to HPR
 728 *     IMM stat to make JKR1(HPR) impedance measure.
 729 * 2. HPR IMM state : Read out orignal signal level of JKR1(HPR) and transfer
 730 *     to HPL IMM state to make JKTIP(HPL) impedance measure.
 731 * 3. HPL IMM state : Read out cross talk signal level of JKTIP(HPL) and
 732 *     transfer to IMM state to determine suppression sidetone gain.
 733 * 4. IMM state : Computes cross talk suppression sidetone gain with orignal
 734 *     and cross talk signal level. Apply this gain and then restore codec
 735 *     configuration. Then transfer to Done state for ending.
 736 */
 737static void nau8825_xtalk_measure(struct nau8825 *nau8825)
 738{
 739	u32 sidetone;
 740
 741	switch (nau8825->xtalk_state) {
 742	case NAU8825_XTALK_PREPARE:
 743		/* In prepare state, set up clock, intrruption, DAC path, ADC
 744		 * path and cross talk detection parameters for preparation.
 745		 */
 746		nau8825_xtalk_prepare(nau8825);
 747		msleep(280);
 748		/* Trigger right headphone impedance detection */
 749		nau8825->xtalk_state = NAU8825_XTALK_HPR_R2L;
 750		nau8825_xtalk_imm_start(nau8825, 0x00d2);
 751		break;
 752	case NAU8825_XTALK_HPR_R2L:
 753		/* In right headphone IMM state, read out right headphone
 754		 * impedance measure result, and then start up left side.
 755		 */
 756		regmap_read(nau8825->regmap, NAU8825_REG_IMM_RMS_L,
 757			&nau8825->imp_rms[NAU8825_XTALK_HPR_R2L]);
 758		dev_dbg(nau8825->dev, "HPR_R2L imm: %x\n",
 759			nau8825->imp_rms[NAU8825_XTALK_HPR_R2L]);
 760		/* Disable then re-enable IMM mode to update */
 761		nau8825_xtalk_imm_stop(nau8825);
 762		/* Trigger left headphone impedance detection */
 763		nau8825->xtalk_state = NAU8825_XTALK_HPL_R2L;
 764		nau8825_xtalk_imm_start(nau8825, 0x00ff);
 765		break;
 766	case NAU8825_XTALK_HPL_R2L:
 767		/* In left headphone IMM state, read out left headphone
 768		 * impedance measure result, and delay some time to wait
 769		 * detection sine wave output finish. Then, we can calculate
 770		 * the cross talk suppresstion side tone according to the L/R
 771		 * headphone imedance.
 772		 */
 773		regmap_read(nau8825->regmap, NAU8825_REG_IMM_RMS_L,
 774			&nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 775		dev_dbg(nau8825->dev, "HPL_R2L imm: %x\n",
 776			nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 777		nau8825_xtalk_imm_stop(nau8825);
 778		msleep(150);
 779		nau8825->xtalk_state = NAU8825_XTALK_IMM;
 780		break;
 781	case NAU8825_XTALK_IMM:
 782		/* In impedance measure state, the orignal and cross talk
 783		 * signal level vlues are ready. The side tone gain is deter-
 784		 * mined with these signal level. After all, restore codec
 785		 * configuration.
 786		 */
 787		sidetone = nau8825_xtalk_sidetone(
 788			nau8825->imp_rms[NAU8825_XTALK_HPR_R2L],
 789			nau8825->imp_rms[NAU8825_XTALK_HPL_R2L]);
 790		dev_dbg(nau8825->dev, "cross talk sidetone: %x\n", sidetone);
 791		regmap_write(nau8825->regmap, NAU8825_REG_DAC_DGAIN_CTRL,
 792					(sidetone << 8) | sidetone);
 793		nau8825_xtalk_clean(nau8825, false);
 794		nau8825->xtalk_state = NAU8825_XTALK_DONE;
 795		break;
 796	default:
 797		break;
 798	}
 799}
 800
 801static void nau8825_xtalk_work(struct work_struct *work)
 802{
 803	struct nau8825 *nau8825 = container_of(
 804		work, struct nau8825, xtalk_work);
 805
 806	nau8825_xtalk_measure(nau8825);
 807	/* To determine the cross talk side tone gain when reach
 808	 * the impedance measure state.
 809	 */
 810	if (nau8825->xtalk_state == NAU8825_XTALK_IMM)
 811		nau8825_xtalk_measure(nau8825);
 812
 813	/* Delay jack report until cross talk detection process
 814	 * completed. It can avoid application to do playback
 815	 * preparation before cross talk detection is still working.
 816	 * Meanwhile, the protection of the cross talk detection
 817	 * is released.
 818	 */
 819	if (nau8825->xtalk_state == NAU8825_XTALK_DONE) {
 820		snd_soc_jack_report(nau8825->jack, nau8825->xtalk_event,
 821				nau8825->xtalk_event_mask);
 822		nau8825_sema_release(nau8825);
 823		nau8825->xtalk_protect = false;
 824	}
 825}
 826
 827static void nau8825_xtalk_cancel(struct nau8825 *nau8825)
 828{
 829	/* If the crosstalk is eanbled and the process is on going,
 830	 * the driver forces to cancel the crosstalk task and
 831	 * restores the configuration to original status.
 832	 */
 833	if (nau8825->xtalk_enable && nau8825->xtalk_state !=
 834		NAU8825_XTALK_DONE) {
 835		cancel_work_sync(&nau8825->xtalk_work);
 836		nau8825_xtalk_clean(nau8825, true);
 837	}
 838	/* Reset parameters for cross talk suppression function */
 839	nau8825_sema_reset(nau8825);
 840	nau8825->xtalk_state = NAU8825_XTALK_DONE;
 841	nau8825->xtalk_protect = false;
 842}
 843
 844static bool nau8825_readable_reg(struct device *dev, unsigned int reg)
 845{
 846	switch (reg) {
 847	case NAU8825_REG_ENA_CTRL ... NAU8825_REG_FLL_VCO_RSV:
 848	case NAU8825_REG_HSD_CTRL ... NAU8825_REG_JACK_DET_CTRL:
 849	case NAU8825_REG_INTERRUPT_MASK ... NAU8825_REG_KEYDET_CTRL:
 850	case NAU8825_REG_VDET_THRESHOLD_1 ... NAU8825_REG_DACR_CTRL:
 851	case NAU8825_REG_ADC_DRC_KNEE_IP12 ... NAU8825_REG_ADC_DRC_ATKDCY:
 852	case NAU8825_REG_DAC_DRC_KNEE_IP12 ... NAU8825_REG_DAC_DRC_ATKDCY:
 853	case NAU8825_REG_IMM_MODE_CTRL ... NAU8825_REG_IMM_RMS_R:
 854	case NAU8825_REG_CLASSG_CTRL ... NAU8825_REG_OPT_EFUSE_CTRL:
 855	case NAU8825_REG_MISC_CTRL:
 856	case NAU8825_REG_I2C_DEVICE_ID ... NAU8825_REG_SARDOUT_RAM_STATUS:
 857	case NAU8825_REG_BIAS_ADJ:
 858	case NAU8825_REG_TRIM_SETTINGS ... NAU8825_REG_ANALOG_CONTROL_2:
 859	case NAU8825_REG_ANALOG_ADC_1 ... NAU8825_REG_MIC_BIAS:
 860	case NAU8825_REG_BOOST ... NAU8825_REG_FEPGA:
 861	case NAU8825_REG_POWER_UP_CONTROL ... NAU8825_REG_GENERAL_STATUS:
 862		return true;
 863	default:
 864		return false;
 865	}
 866
 867}
 868
 869static bool nau8825_writeable_reg(struct device *dev, unsigned int reg)
 870{
 871	switch (reg) {
 872	case NAU8825_REG_RESET ... NAU8825_REG_FLL_VCO_RSV:
 873	case NAU8825_REG_HSD_CTRL ... NAU8825_REG_JACK_DET_CTRL:
 874	case NAU8825_REG_INTERRUPT_MASK:
 875	case NAU8825_REG_INT_CLR_KEY_STATUS ... NAU8825_REG_KEYDET_CTRL:
 876	case NAU8825_REG_VDET_THRESHOLD_1 ... NAU8825_REG_DACR_CTRL:
 877	case NAU8825_REG_ADC_DRC_KNEE_IP12 ... NAU8825_REG_ADC_DRC_ATKDCY:
 878	case NAU8825_REG_DAC_DRC_KNEE_IP12 ... NAU8825_REG_DAC_DRC_ATKDCY:
 879	case NAU8825_REG_IMM_MODE_CTRL:
 880	case NAU8825_REG_CLASSG_CTRL ... NAU8825_REG_OPT_EFUSE_CTRL:
 881	case NAU8825_REG_MISC_CTRL:
 
 882	case NAU8825_REG_BIAS_ADJ:
 883	case NAU8825_REG_TRIM_SETTINGS ... NAU8825_REG_ANALOG_CONTROL_2:
 884	case NAU8825_REG_ANALOG_ADC_1 ... NAU8825_REG_MIC_BIAS:
 885	case NAU8825_REG_BOOST ... NAU8825_REG_FEPGA:
 886	case NAU8825_REG_POWER_UP_CONTROL ... NAU8825_REG_CHARGE_PUMP:
 887		return true;
 888	default:
 889		return false;
 890	}
 891}
 892
 893static bool nau8825_volatile_reg(struct device *dev, unsigned int reg)
 894{
 895	switch (reg) {
 896	case NAU8825_REG_RESET:
 897	case NAU8825_REG_IRQ_STATUS:
 898	case NAU8825_REG_INT_CLR_KEY_STATUS:
 899	case NAU8825_REG_IMM_RMS_L:
 900	case NAU8825_REG_IMM_RMS_R:
 901	case NAU8825_REG_I2C_DEVICE_ID:
 902	case NAU8825_REG_SARDOUT_RAM_STATUS:
 903	case NAU8825_REG_CHARGE_PUMP_INPUT_READ:
 904	case NAU8825_REG_GENERAL_STATUS:
 905	case NAU8825_REG_BIQ_CTRL ... NAU8825_REG_BIQ_COF10:
 906		return true;
 907	default:
 908		return false;
 909	}
 910}
 911
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 912static int nau8825_adc_event(struct snd_soc_dapm_widget *w,
 913		struct snd_kcontrol *kcontrol, int event)
 914{
 915	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 916	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 917
 918	switch (event) {
 919	case SND_SOC_DAPM_POST_PMU:
 920		msleep(125);
 921		regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
 922			NAU8825_ENABLE_ADC, NAU8825_ENABLE_ADC);
 923		break;
 924	case SND_SOC_DAPM_POST_PMD:
 925		if (!nau8825->irq)
 926			regmap_update_bits(nau8825->regmap,
 927				NAU8825_REG_ENA_CTRL, NAU8825_ENABLE_ADC, 0);
 928		break;
 929	default:
 930		return -EINVAL;
 931	}
 932
 933	return 0;
 934}
 935
 936static int nau8825_pump_event(struct snd_soc_dapm_widget *w,
 937	struct snd_kcontrol *kcontrol, int event)
 938{
 939	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 940	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 941
 942	switch (event) {
 943	case SND_SOC_DAPM_POST_PMU:
 944		/* Prevent startup click by letting charge pump to ramp up */
 945		msleep(10);
 946		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 947			NAU8825_JAMNODCLOW, NAU8825_JAMNODCLOW);
 948		break;
 949	case SND_SOC_DAPM_PRE_PMD:
 950		regmap_update_bits(nau8825->regmap, NAU8825_REG_CHARGE_PUMP,
 951			NAU8825_JAMNODCLOW, 0);
 952		break;
 953	default:
 954		return -EINVAL;
 955	}
 956
 957	return 0;
 958}
 959
 960static int nau8825_output_dac_event(struct snd_soc_dapm_widget *w,
 961	struct snd_kcontrol *kcontrol, int event)
 962{
 963	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 964	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
 965
 966	switch (event) {
 967	case SND_SOC_DAPM_PRE_PMU:
 968		/* Disables the TESTDAC to let DAC signal pass through. */
 969		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 970			NAU8825_BIAS_TESTDAC_EN, 0);
 
 
 
 
 
 
 
 971		break;
 972	case SND_SOC_DAPM_POST_PMD:
 973		regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
 974			NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
 
 
 
 
 
 
 
 
 975		break;
 976	default:
 977		return -EINVAL;
 978	}
 979
 980	return 0;
 981}
 982
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 983static int nau8825_biq_coeff_get(struct snd_kcontrol *kcontrol,
 984				     struct snd_ctl_elem_value *ucontrol)
 985{
 986	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
 987	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
 988
 989	if (!component->regmap)
 990		return -EINVAL;
 991
 992	regmap_raw_read(component->regmap, NAU8825_REG_BIQ_COF1,
 993		ucontrol->value.bytes.data, params->max);
 994	return 0;
 995}
 996
 997static int nau8825_biq_coeff_put(struct snd_kcontrol *kcontrol,
 998				     struct snd_ctl_elem_value *ucontrol)
 999{
1000	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1001	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
1002	void *data;
1003
1004	if (!component->regmap)
1005		return -EINVAL;
1006
1007	data = kmemdup(ucontrol->value.bytes.data,
1008		params->max, GFP_KERNEL | GFP_DMA);
1009	if (!data)
1010		return -ENOMEM;
1011
1012	regmap_update_bits(component->regmap, NAU8825_REG_BIQ_CTRL,
1013		NAU8825_BIQ_WRT_EN, 0);
1014	regmap_raw_write(component->regmap, NAU8825_REG_BIQ_COF1,
1015		data, params->max);
1016	regmap_update_bits(component->regmap, NAU8825_REG_BIQ_CTRL,
1017		NAU8825_BIQ_WRT_EN, NAU8825_BIQ_WRT_EN);
1018
1019	kfree(data);
1020	return 0;
1021}
1022
1023static const char * const nau8825_biq_path[] = {
1024	"ADC", "DAC"
1025};
1026
1027static const struct soc_enum nau8825_biq_path_enum =
1028	SOC_ENUM_SINGLE(NAU8825_REG_BIQ_CTRL, NAU8825_BIQ_PATH_SFT,
1029		ARRAY_SIZE(nau8825_biq_path), nau8825_biq_path);
1030
1031static const char * const nau8825_adc_decimation[] = {
1032	"32", "64", "128", "256"
1033};
1034
1035static const struct soc_enum nau8825_adc_decimation_enum =
1036	SOC_ENUM_SINGLE(NAU8825_REG_ADC_RATE, NAU8825_ADC_SYNC_DOWN_SFT,
1037		ARRAY_SIZE(nau8825_adc_decimation), nau8825_adc_decimation);
1038
1039static const char * const nau8825_dac_oversampl[] = {
1040	"64", "256", "128", "", "32"
1041};
1042
1043static const struct soc_enum nau8825_dac_oversampl_enum =
1044	SOC_ENUM_SINGLE(NAU8825_REG_DAC_CTRL1, NAU8825_DAC_OVERSAMPLE_SFT,
1045		ARRAY_SIZE(nau8825_dac_oversampl), nau8825_dac_oversampl);
1046
1047static const DECLARE_TLV_DB_MINMAX_MUTE(adc_vol_tlv, -10300, 2400);
1048static const DECLARE_TLV_DB_MINMAX_MUTE(sidetone_vol_tlv, -4200, 0);
1049static const DECLARE_TLV_DB_MINMAX(dac_vol_tlv, -5400, 0);
1050static const DECLARE_TLV_DB_MINMAX(fepga_gain_tlv, -100, 3600);
1051static const DECLARE_TLV_DB_MINMAX_MUTE(crosstalk_vol_tlv, -9600, 2400);
1052
1053static const struct snd_kcontrol_new nau8825_controls[] = {
1054	SOC_SINGLE_TLV("Mic Volume", NAU8825_REG_ADC_DGAIN_CTRL,
1055		0, 0xff, 0, adc_vol_tlv),
1056	SOC_DOUBLE_TLV("Headphone Bypass Volume", NAU8825_REG_ADC_DGAIN_CTRL,
1057		12, 8, 0x0f, 0, sidetone_vol_tlv),
1058	SOC_DOUBLE_TLV("Headphone Volume", NAU8825_REG_HSVOL_CTRL,
1059		6, 0, 0x3f, 1, dac_vol_tlv),
1060	SOC_SINGLE_TLV("Frontend PGA Volume", NAU8825_REG_POWER_UP_CONTROL,
1061		8, 37, 0, fepga_gain_tlv),
1062	SOC_DOUBLE_TLV("Headphone Crosstalk Volume", NAU8825_REG_DAC_DGAIN_CTRL,
1063		0, 8, 0xff, 0, crosstalk_vol_tlv),
1064
1065	SOC_ENUM("ADC Decimation Rate", nau8825_adc_decimation_enum),
1066	SOC_ENUM("DAC Oversampling Rate", nau8825_dac_oversampl_enum),
1067	/* programmable biquad filter */
1068	SOC_ENUM("BIQ Path Select", nau8825_biq_path_enum),
1069	SND_SOC_BYTES_EXT("BIQ Coefficients", 20,
1070		  nau8825_biq_coeff_get, nau8825_biq_coeff_put),
1071};
1072
1073/* DAC Mux 0x33[9] and 0x34[9] */
1074static const char * const nau8825_dac_src[] = {
1075	"DACL", "DACR",
1076};
1077
1078static SOC_ENUM_SINGLE_DECL(
1079	nau8825_dacl_enum, NAU8825_REG_DACL_CTRL,
1080	NAU8825_DACL_CH_SEL_SFT, nau8825_dac_src);
1081
1082static SOC_ENUM_SINGLE_DECL(
1083	nau8825_dacr_enum, NAU8825_REG_DACR_CTRL,
1084	NAU8825_DACR_CH_SEL_SFT, nau8825_dac_src);
1085
1086static const struct snd_kcontrol_new nau8825_dacl_mux =
1087	SOC_DAPM_ENUM("DACL Source", nau8825_dacl_enum);
1088
1089static const struct snd_kcontrol_new nau8825_dacr_mux =
1090	SOC_DAPM_ENUM("DACR Source", nau8825_dacr_enum);
1091
1092
1093static const struct snd_soc_dapm_widget nau8825_dapm_widgets[] = {
1094	SND_SOC_DAPM_AIF_OUT("AIFTX", "Capture", 0, NAU8825_REG_I2S_PCM_CTRL2,
1095		15, 1),
 
 
 
1096
1097	SND_SOC_DAPM_INPUT("MIC"),
1098	SND_SOC_DAPM_MICBIAS("MICBIAS", NAU8825_REG_MIC_BIAS, 8, 0),
1099
1100	SND_SOC_DAPM_PGA("Frontend PGA", NAU8825_REG_POWER_UP_CONTROL, 14, 0,
1101		NULL, 0),
1102
1103	SND_SOC_DAPM_ADC_E("ADC", NULL, SND_SOC_NOPM, 0, 0,
1104		nau8825_adc_event, SND_SOC_DAPM_POST_PMU |
1105		SND_SOC_DAPM_POST_PMD),
1106	SND_SOC_DAPM_SUPPLY("ADC Clock", NAU8825_REG_ENA_CTRL, 7, 0, NULL, 0),
1107	SND_SOC_DAPM_SUPPLY("ADC Power", NAU8825_REG_ANALOG_ADC_2, 6, 0, NULL,
1108		0),
1109
1110	/* ADC for button press detection. A dapm supply widget is used to
1111	 * prevent dapm_power_widgets keeping the codec at SND_SOC_BIAS_ON
1112	 * during suspend.
1113	 */
1114	SND_SOC_DAPM_SUPPLY("SAR", NAU8825_REG_SAR_CTRL,
1115		NAU8825_SAR_ADC_EN_SFT, 0, NULL, 0),
1116
1117	SND_SOC_DAPM_PGA_S("ADACL", 2, NAU8825_REG_RDAC, 12, 0, NULL, 0),
1118	SND_SOC_DAPM_PGA_S("ADACR", 2, NAU8825_REG_RDAC, 13, 0, NULL, 0),
1119	SND_SOC_DAPM_PGA_S("ADACL Clock", 3, NAU8825_REG_RDAC, 8, 0, NULL, 0),
1120	SND_SOC_DAPM_PGA_S("ADACR Clock", 3, NAU8825_REG_RDAC, 9, 0, NULL, 0),
1121
1122	SND_SOC_DAPM_DAC("DDACR", NULL, NAU8825_REG_ENA_CTRL,
1123		NAU8825_ENABLE_DACR_SFT, 0),
1124	SND_SOC_DAPM_DAC("DDACL", NULL, NAU8825_REG_ENA_CTRL,
1125		NAU8825_ENABLE_DACL_SFT, 0),
1126	SND_SOC_DAPM_SUPPLY("DDAC Clock", NAU8825_REG_ENA_CTRL, 6, 0, NULL, 0),
1127
1128	SND_SOC_DAPM_MUX("DACL Mux", SND_SOC_NOPM, 0, 0, &nau8825_dacl_mux),
1129	SND_SOC_DAPM_MUX("DACR Mux", SND_SOC_NOPM, 0, 0, &nau8825_dacr_mux),
1130
1131	SND_SOC_DAPM_PGA_S("HP amp L", 0,
1132		NAU8825_REG_CLASSG_CTRL, 1, 0, NULL, 0),
1133	SND_SOC_DAPM_PGA_S("HP amp R", 0,
1134		NAU8825_REG_CLASSG_CTRL, 2, 0, NULL, 0),
1135
1136	SND_SOC_DAPM_PGA_S("Charge Pump", 1, NAU8825_REG_CHARGE_PUMP, 5, 0,
1137		nau8825_pump_event, SND_SOC_DAPM_POST_PMU |
1138		SND_SOC_DAPM_PRE_PMD),
1139
1140	SND_SOC_DAPM_PGA_S("Output Driver R Stage 1", 4,
1141		NAU8825_REG_POWER_UP_CONTROL, 5, 0, NULL, 0),
1142	SND_SOC_DAPM_PGA_S("Output Driver L Stage 1", 4,
1143		NAU8825_REG_POWER_UP_CONTROL, 4, 0, NULL, 0),
1144	SND_SOC_DAPM_PGA_S("Output Driver R Stage 2", 5,
1145		NAU8825_REG_POWER_UP_CONTROL, 3, 0, NULL, 0),
1146	SND_SOC_DAPM_PGA_S("Output Driver L Stage 2", 5,
1147		NAU8825_REG_POWER_UP_CONTROL, 2, 0, NULL, 0),
1148	SND_SOC_DAPM_PGA_S("Output Driver R Stage 3", 6,
1149		NAU8825_REG_POWER_UP_CONTROL, 1, 0, NULL, 0),
1150	SND_SOC_DAPM_PGA_S("Output Driver L Stage 3", 6,
1151		NAU8825_REG_POWER_UP_CONTROL, 0, 0, NULL, 0),
1152
1153	SND_SOC_DAPM_PGA_S("Output DACL", 7,
1154		NAU8825_REG_CHARGE_PUMP, 8, 1, nau8825_output_dac_event,
1155		SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1156	SND_SOC_DAPM_PGA_S("Output DACR", 7,
1157		NAU8825_REG_CHARGE_PUMP, 9, 1, nau8825_output_dac_event,
1158		SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1159
 
1160	/* HPOL/R are ungrounded by disabling 16 Ohm pull-downs on playback */
1161	SND_SOC_DAPM_PGA_S("HPOL Pulldown", 8,
1162		NAU8825_REG_HSD_CTRL, 0, 1, NULL, 0),
1163	SND_SOC_DAPM_PGA_S("HPOR Pulldown", 8,
1164		NAU8825_REG_HSD_CTRL, 1, 1, NULL, 0),
1165
1166	/* High current HPOL/R boost driver */
1167	SND_SOC_DAPM_PGA_S("HP Boost Driver", 9,
1168		NAU8825_REG_BOOST, 9, 1, NULL, 0),
1169
1170	/* Class G operation control*/
1171	SND_SOC_DAPM_PGA_S("Class G", 10,
1172		NAU8825_REG_CLASSG_CTRL, 0, 0, NULL, 0),
1173
1174	SND_SOC_DAPM_OUTPUT("HPOL"),
1175	SND_SOC_DAPM_OUTPUT("HPOR"),
1176};
1177
1178static const struct snd_soc_dapm_route nau8825_dapm_routes[] = {
1179	{"Frontend PGA", NULL, "MIC"},
1180	{"ADC", NULL, "Frontend PGA"},
1181	{"ADC", NULL, "ADC Clock"},
1182	{"ADC", NULL, "ADC Power"},
1183	{"AIFTX", NULL, "ADC"},
 
1184
1185	{"DDACL", NULL, "Playback"},
1186	{"DDACR", NULL, "Playback"},
 
1187	{"DDACL", NULL, "DDAC Clock"},
1188	{"DDACR", NULL, "DDAC Clock"},
1189	{"DACL Mux", "DACL", "DDACL"},
1190	{"DACL Mux", "DACR", "DDACR"},
1191	{"DACR Mux", "DACL", "DDACL"},
1192	{"DACR Mux", "DACR", "DDACR"},
1193	{"HP amp L", NULL, "DACL Mux"},
1194	{"HP amp R", NULL, "DACR Mux"},
1195	{"Charge Pump", NULL, "HP amp L"},
1196	{"Charge Pump", NULL, "HP amp R"},
1197	{"ADACL", NULL, "Charge Pump"},
1198	{"ADACR", NULL, "Charge Pump"},
1199	{"ADACL Clock", NULL, "ADACL"},
1200	{"ADACR Clock", NULL, "ADACR"},
1201	{"Output Driver L Stage 1", NULL, "ADACL Clock"},
1202	{"Output Driver R Stage 1", NULL, "ADACR Clock"},
1203	{"Output Driver L Stage 2", NULL, "Output Driver L Stage 1"},
1204	{"Output Driver R Stage 2", NULL, "Output Driver R Stage 1"},
1205	{"Output Driver L Stage 3", NULL, "Output Driver L Stage 2"},
1206	{"Output Driver R Stage 3", NULL, "Output Driver R Stage 2"},
1207	{"Output DACL", NULL, "Output Driver L Stage 3"},
1208	{"Output DACR", NULL, "Output Driver R Stage 3"},
1209	{"HPOL Pulldown", NULL, "Output DACL"},
1210	{"HPOR Pulldown", NULL, "Output DACR"},
1211	{"HP Boost Driver", NULL, "HPOL Pulldown"},
1212	{"HP Boost Driver", NULL, "HPOR Pulldown"},
1213	{"Class G", NULL, "HP Boost Driver"},
1214	{"HPOL", NULL, "Class G"},
1215	{"HPOR", NULL, "Class G"},
1216};
1217
1218static int nau8825_clock_check(struct nau8825 *nau8825,
1219	int stream, int rate, int osr)
1220{
1221	int osrate;
1222
1223	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
 
 
 
1224		if (osr >= ARRAY_SIZE(osr_dac_sel))
1225			return -EINVAL;
1226		osrate = osr_dac_sel[osr].osr;
1227	} else {
 
 
 
1228		if (osr >= ARRAY_SIZE(osr_adc_sel))
1229			return -EINVAL;
1230		osrate = osr_adc_sel[osr].osr;
1231	}
 
 
 
 
 
 
 
 
1232
1233	if (!osrate || rate * osr > CLK_DA_AD_MAX) {
1234		dev_err(nau8825->dev, "exceed the maximum frequency of CLK_ADC or CLK_DAC\n");
1235		return -EINVAL;
1236	}
1237
1238	return 0;
 
 
1239}
1240
1241static int nau8825_hw_params(struct snd_pcm_substream *substream,
1242				struct snd_pcm_hw_params *params,
1243				struct snd_soc_dai *dai)
1244{
1245	struct snd_soc_component *component = dai->component;
1246	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1247	unsigned int val_len = 0, osr, ctrl_val, bclk_fs, bclk_div;
 
 
1248
1249	nau8825_sema_acquire(nau8825, 3 * HZ);
1250
1251	/* CLK_DAC or CLK_ADC = OSR * FS
1252	 * DAC or ADC clock frequency is defined as Over Sampling Rate (OSR)
1253	 * multiplied by the audio sample rate (Fs). Note that the OSR and Fs
1254	 * values must be selected such that the maximum frequency is less
1255	 * than 6.144 MHz.
1256	 */
1257	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1258		regmap_read(nau8825->regmap, NAU8825_REG_DAC_CTRL1, &osr);
1259		osr &= NAU8825_DAC_OVERSAMPLE_MASK;
1260		if (nau8825_clock_check(nau8825, substream->stream,
1261			params_rate(params), osr)) {
1262			nau8825_sema_release(nau8825);
1263			return -EINVAL;
1264		}
1265		regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
1266			NAU8825_CLK_DAC_SRC_MASK,
1267			osr_dac_sel[osr].clk_src << NAU8825_CLK_DAC_SRC_SFT);
1268	} else {
1269		regmap_read(nau8825->regmap, NAU8825_REG_ADC_RATE, &osr);
1270		osr &= NAU8825_ADC_SYNC_DOWN_MASK;
1271		if (nau8825_clock_check(nau8825, substream->stream,
1272			params_rate(params), osr)) {
1273			nau8825_sema_release(nau8825);
1274			return -EINVAL;
1275		}
1276		regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
1277			NAU8825_CLK_ADC_SRC_MASK,
1278			osr_adc_sel[osr].clk_src << NAU8825_CLK_ADC_SRC_SFT);
1279	}
1280
1281	/* make BCLK and LRC divde configuration if the codec as master. */
1282	regmap_read(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2, &ctrl_val);
1283	if (ctrl_val & NAU8825_I2S_MS_MASTER) {
1284		/* get the bclk and fs ratio */
1285		bclk_fs = snd_soc_params_to_bclk(params) / params_rate(params);
1286		if (bclk_fs <= 32)
1287			bclk_div = 2;
1288		else if (bclk_fs <= 64)
1289			bclk_div = 1;
1290		else if (bclk_fs <= 128)
1291			bclk_div = 0;
1292		else {
1293			nau8825_sema_release(nau8825);
1294			return -EINVAL;
1295		}
1296		regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
1297			NAU8825_I2S_LRC_DIV_MASK | NAU8825_I2S_BLK_DIV_MASK,
1298			((bclk_div + 1) << NAU8825_I2S_LRC_DIV_SFT) | bclk_div);
1299	}
1300
1301	switch (params_width(params)) {
1302	case 16:
1303		val_len |= NAU8825_I2S_DL_16;
1304		break;
1305	case 20:
1306		val_len |= NAU8825_I2S_DL_20;
1307		break;
1308	case 24:
1309		val_len |= NAU8825_I2S_DL_24;
1310		break;
1311	case 32:
1312		val_len |= NAU8825_I2S_DL_32;
1313		break;
1314	default:
1315		nau8825_sema_release(nau8825);
1316		return -EINVAL;
1317	}
1318
1319	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL1,
1320		NAU8825_I2S_DL_MASK, val_len);
 
1321
 
1322	/* Release the semaphore. */
1323	nau8825_sema_release(nau8825);
1324
1325	return 0;
1326}
1327
1328static int nau8825_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
1329{
1330	struct snd_soc_component *component = codec_dai->component;
1331	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1332	unsigned int ctrl1_val = 0, ctrl2_val = 0;
1333
1334	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1335	case SND_SOC_DAIFMT_CBM_CFM:
1336		ctrl2_val |= NAU8825_I2S_MS_MASTER;
1337		break;
1338	case SND_SOC_DAIFMT_CBS_CFS:
1339		break;
1340	default:
1341		return -EINVAL;
1342	}
1343
1344	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1345	case SND_SOC_DAIFMT_NB_NF:
1346		break;
1347	case SND_SOC_DAIFMT_IB_NF:
1348		ctrl1_val |= NAU8825_I2S_BP_INV;
1349		break;
1350	default:
1351		return -EINVAL;
1352	}
1353
1354	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1355	case SND_SOC_DAIFMT_I2S:
1356		ctrl1_val |= NAU8825_I2S_DF_I2S;
1357		break;
1358	case SND_SOC_DAIFMT_LEFT_J:
1359		ctrl1_val |= NAU8825_I2S_DF_LEFT;
1360		break;
1361	case SND_SOC_DAIFMT_RIGHT_J:
1362		ctrl1_val |= NAU8825_I2S_DF_RIGTH;
1363		break;
1364	case SND_SOC_DAIFMT_DSP_A:
1365		ctrl1_val |= NAU8825_I2S_DF_PCM_AB;
1366		break;
1367	case SND_SOC_DAIFMT_DSP_B:
1368		ctrl1_val |= NAU8825_I2S_DF_PCM_AB;
1369		ctrl1_val |= NAU8825_I2S_PCMB_EN;
1370		break;
1371	default:
1372		return -EINVAL;
1373	}
1374
1375	nau8825_sema_acquire(nau8825, 3 * HZ);
1376
1377	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL1,
1378		NAU8825_I2S_DL_MASK | NAU8825_I2S_DF_MASK |
1379		NAU8825_I2S_BP_MASK | NAU8825_I2S_PCMB_MASK,
1380		ctrl1_val);
1381	regmap_update_bits(nau8825->regmap, NAU8825_REG_I2S_PCM_CTRL2,
1382		NAU8825_I2S_MS_MASK, ctrl2_val);
1383
1384	/* Release the semaphore. */
1385	nau8825_sema_release(nau8825);
1386
1387	return 0;
1388}
1389
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1390static const struct snd_soc_dai_ops nau8825_dai_ops = {
 
1391	.hw_params	= nau8825_hw_params,
1392	.set_fmt	= nau8825_set_dai_fmt,
 
1393};
1394
1395#define NAU8825_RATES	SNDRV_PCM_RATE_8000_192000
1396#define NAU8825_FORMATS	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
1397			 | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
1398
1399static struct snd_soc_dai_driver nau8825_dai = {
1400	.name = "nau8825-hifi",
1401	.playback = {
1402		.stream_name	 = "Playback",
1403		.channels_min	 = 1,
1404		.channels_max	 = 2,
1405		.rates		 = NAU8825_RATES,
1406		.formats	 = NAU8825_FORMATS,
1407	},
1408	.capture = {
1409		.stream_name	 = "Capture",
1410		.channels_min	 = 1,
1411		.channels_max	 = 1,
1412		.rates		 = NAU8825_RATES,
1413		.formats	 = NAU8825_FORMATS,
1414	},
1415	.ops = &nau8825_dai_ops,
1416};
1417
1418/**
1419 * nau8825_enable_jack_detect - Specify a jack for event reporting
1420 *
1421 * @component:  component to register the jack with
1422 * @jack: jack to use to report headset and button events on
1423 *
1424 * After this function has been called the headset insert/remove and button
1425 * events will be routed to the given jack.  Jack can be null to stop
1426 * reporting.
1427 */
1428int nau8825_enable_jack_detect(struct snd_soc_component *component,
1429				struct snd_soc_jack *jack)
1430{
1431	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1432	struct regmap *regmap = nau8825->regmap;
1433
1434	nau8825->jack = jack;
1435
 
 
 
 
 
 
1436	/* Ground HP Outputs[1:0], needed for headset auto detection
1437	 * Enable Automatic Mic/Gnd switching reading on insert interrupt[6]
1438	 */
1439	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL,
1440		NAU8825_HSD_AUTO_MODE | NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L,
1441		NAU8825_HSD_AUTO_MODE | NAU8825_SPKR_DWN1R | NAU8825_SPKR_DWN1L);
1442
1443	return 0;
1444}
1445EXPORT_SYMBOL_GPL(nau8825_enable_jack_detect);
1446
1447
1448static bool nau8825_is_jack_inserted(struct regmap *regmap)
1449{
1450	bool active_high, is_high;
1451	int status, jkdet;
1452
1453	regmap_read(regmap, NAU8825_REG_JACK_DET_CTRL, &jkdet);
1454	active_high = jkdet & NAU8825_JACK_POLARITY;
1455	regmap_read(regmap, NAU8825_REG_I2C_DEVICE_ID, &status);
1456	is_high = status & NAU8825_GPIO2JD1;
1457	/* return jack connection status according to jack insertion logic
1458	 * active high or active low.
1459	 */
1460	return active_high == is_high;
1461}
1462
1463static void nau8825_restart_jack_detection(struct regmap *regmap)
1464{
1465	/* this will restart the entire jack detection process including MIC/GND
1466	 * switching and create interrupts. We have to go from 0 to 1 and back
1467	 * to 0 to restart.
1468	 */
1469	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1470		NAU8825_JACK_DET_RESTART, NAU8825_JACK_DET_RESTART);
1471	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1472		NAU8825_JACK_DET_RESTART, 0);
1473}
1474
1475static void nau8825_int_status_clear_all(struct regmap *regmap)
1476{
1477	int active_irq, clear_irq, i;
1478
1479	/* Reset the intrruption status from rightmost bit if the corres-
1480	 * ponding irq event occurs.
1481	 */
1482	regmap_read(regmap, NAU8825_REG_IRQ_STATUS, &active_irq);
1483	for (i = 0; i < NAU8825_REG_DATA_LEN; i++) {
1484		clear_irq = (0x1 << i);
1485		if (active_irq & clear_irq)
1486			regmap_write(regmap,
1487				NAU8825_REG_INT_CLR_KEY_STATUS, clear_irq);
1488	}
1489}
1490
1491static void nau8825_eject_jack(struct nau8825 *nau8825)
1492{
1493	struct snd_soc_dapm_context *dapm = nau8825->dapm;
1494	struct regmap *regmap = nau8825->regmap;
1495
1496	/* Force to cancel the cross talk detection process */
1497	nau8825_xtalk_cancel(nau8825);
1498
1499	snd_soc_dapm_disable_pin(dapm, "SAR");
1500	snd_soc_dapm_disable_pin(dapm, "MICBIAS");
1501	/* Detach 2kOhm Resistors from MICBIAS to MICGND1/2 */
1502	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1503		NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2, 0);
1504	/* ground HPL/HPR, MICGRND1/2 */
1505	regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 0xf, 0xf);
1506
1507	snd_soc_dapm_sync(dapm);
1508
1509	/* Clear all interruption status */
1510	nau8825_int_status_clear_all(regmap);
1511
1512	/* Enable the insertion interruption, disable the ejection inter-
1513	 * ruption, and then bypass de-bounce circuit.
1514	 */
1515	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL,
1516		NAU8825_IRQ_EJECT_DIS | NAU8825_IRQ_INSERT_DIS,
1517		NAU8825_IRQ_EJECT_DIS);
1518	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1519		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_EJECT_EN |
1520		NAU8825_IRQ_HEADSET_COMPLETE_EN | NAU8825_IRQ_INSERT_EN,
1521		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_EJECT_EN |
1522		NAU8825_IRQ_HEADSET_COMPLETE_EN);
1523	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1524		NAU8825_JACK_DET_DB_BYPASS, NAU8825_JACK_DET_DB_BYPASS);
1525
1526	/* Disable ADC needed for interruptions at audo mode */
1527	regmap_update_bits(regmap, NAU8825_REG_ENA_CTRL,
1528		NAU8825_ENABLE_ADC, 0);
1529
1530	/* Close clock for jack type detection at manual mode */
1531	nau8825_configure_sysclk(nau8825, NAU8825_CLK_DIS, 0);
1532}
1533
1534/* Enable audo mode interruptions with internal clock. */
1535static void nau8825_setup_auto_irq(struct nau8825 *nau8825)
1536{
1537	struct regmap *regmap = nau8825->regmap;
1538
 
 
 
 
1539	/* Enable headset jack type detection complete interruption and
1540	 * jack ejection interruption.
1541	 */
1542	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1543		NAU8825_IRQ_HEADSET_COMPLETE_EN | NAU8825_IRQ_EJECT_EN, 0);
1544
1545	/* Enable internal VCO needed for interruptions */
1546	nau8825_configure_sysclk(nau8825, NAU8825_CLK_INTERNAL, 0);
 
 
 
1547
1548	/* Enable ADC needed for interruptions */
1549	regmap_update_bits(regmap, NAU8825_REG_ENA_CTRL,
1550		NAU8825_ENABLE_ADC, NAU8825_ENABLE_ADC);
1551
1552	/* Chip needs one FSCLK cycle in order to generate interruptions,
1553	 * as we cannot guarantee one will be provided by the system. Turning
1554	 * master mode on then off enables us to generate that FSCLK cycle
1555	 * with a minimum of contention on the clock bus.
1556	 */
1557	regmap_update_bits(regmap, NAU8825_REG_I2S_PCM_CTRL2,
1558		NAU8825_I2S_MS_MASK, NAU8825_I2S_MS_MASTER);
1559	regmap_update_bits(regmap, NAU8825_REG_I2S_PCM_CTRL2,
1560		NAU8825_I2S_MS_MASK, NAU8825_I2S_MS_SLAVE);
1561
1562	/* Not bypass de-bounce circuit */
1563	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1564		NAU8825_JACK_DET_DB_BYPASS, 0);
1565
1566	/* Unmask all interruptions */
1567	regmap_write(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL, 0);
1568
1569	/* Restart the jack detection process at auto mode */
1570	nau8825_restart_jack_detection(regmap);
1571}
1572
1573static int nau8825_button_decode(int value)
1574{
1575	int buttons = 0;
1576
1577	/* The chip supports up to 8 buttons, but ALSA defines only 6 buttons */
1578	if (value & BIT(0))
1579		buttons |= SND_JACK_BTN_0;
1580	if (value & BIT(1))
1581		buttons |= SND_JACK_BTN_1;
1582	if (value & BIT(2))
1583		buttons |= SND_JACK_BTN_2;
1584	if (value & BIT(3))
1585		buttons |= SND_JACK_BTN_3;
1586	if (value & BIT(4))
1587		buttons |= SND_JACK_BTN_4;
1588	if (value & BIT(5))
1589		buttons |= SND_JACK_BTN_5;
1590
1591	return buttons;
1592}
1593
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1594static int nau8825_jack_insert(struct nau8825 *nau8825)
1595{
1596	struct regmap *regmap = nau8825->regmap;
1597	struct snd_soc_dapm_context *dapm = nau8825->dapm;
1598	int jack_status_reg, mic_detected;
1599	int type = 0;
1600
1601	regmap_read(regmap, NAU8825_REG_GENERAL_STATUS, &jack_status_reg);
1602	mic_detected = (jack_status_reg >> 10) & 3;
1603	/* The JKSLV and JKR2 all detected in high impedance headset */
1604	if (mic_detected == 0x3)
1605		nau8825->high_imped = true;
1606	else
1607		nau8825->high_imped = false;
1608
1609	switch (mic_detected) {
1610	case 0:
1611		/* no mic */
1612		type = SND_JACK_HEADPHONE;
1613		break;
1614	case 1:
1615		dev_dbg(nau8825->dev, "OMTP (micgnd1) mic connected\n");
1616		type = SND_JACK_HEADSET;
1617
1618		/* Unground MICGND1 */
1619		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 3 << 2,
1620			1 << 2);
1621		/* Attach 2kOhm Resistor from MICBIAS to MICGND1 */
1622		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1623			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1624			NAU8825_MICBIAS_JKR2);
1625		/* Attach SARADC to MICGND1 */
1626		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1627			NAU8825_SAR_INPUT_MASK,
1628			NAU8825_SAR_INPUT_JKR2);
1629
1630		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1631		snd_soc_dapm_force_enable_pin(dapm, "SAR");
1632		snd_soc_dapm_sync(dapm);
1633		break;
1634	case 2:
1635		dev_dbg(nau8825->dev, "CTIA (micgnd2) mic connected\n");
1636		type = SND_JACK_HEADSET;
1637
1638		/* Unground MICGND2 */
1639		regmap_update_bits(regmap, NAU8825_REG_HSD_CTRL, 3 << 2,
1640			2 << 2);
1641		/* Attach 2kOhm Resistor from MICBIAS to MICGND2 */
1642		regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1643			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2,
1644			NAU8825_MICBIAS_JKSLV);
1645		/* Attach SARADC to MICGND2 */
1646		regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1647			NAU8825_SAR_INPUT_MASK,
1648			NAU8825_SAR_INPUT_JKSLV);
1649
1650		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS");
1651		snd_soc_dapm_force_enable_pin(dapm, "SAR");
1652		snd_soc_dapm_sync(dapm);
1653		break;
1654	case 3:
1655		/* detect error case */
1656		dev_err(nau8825->dev, "detection error; disable mic function\n");
1657		type = SND_JACK_HEADPHONE;
 
 
 
 
 
 
 
1658		break;
1659	}
1660
 
 
 
 
 
 
 
1661	/* Leaving HPOL/R grounded after jack insert by default. They will be
1662	 * ungrounded as part of the widget power up sequence at the beginning
1663	 * of playback to reduce pop.
1664	 */
1665	return type;
1666}
1667
1668#define NAU8825_BUTTONS (SND_JACK_BTN_0 | SND_JACK_BTN_1 | \
1669		SND_JACK_BTN_2 | SND_JACK_BTN_3)
1670
1671static irqreturn_t nau8825_interrupt(int irq, void *data)
1672{
1673	struct nau8825 *nau8825 = (struct nau8825 *)data;
1674	struct regmap *regmap = nau8825->regmap;
1675	int active_irq, clear_irq = 0, event = 0, event_mask = 0;
1676
1677	if (regmap_read(regmap, NAU8825_REG_IRQ_STATUS, &active_irq)) {
1678		dev_err(nau8825->dev, "failed to read irq status\n");
1679		return IRQ_NONE;
1680	}
1681
1682	if ((active_irq & NAU8825_JACK_EJECTION_IRQ_MASK) ==
1683		NAU8825_JACK_EJECTION_DETECTED) {
1684
1685		nau8825_eject_jack(nau8825);
1686		event_mask |= SND_JACK_HEADSET;
1687		clear_irq = NAU8825_JACK_EJECTION_IRQ_MASK;
1688	} else if (active_irq & NAU8825_KEY_SHORT_PRESS_IRQ) {
1689		int key_status;
1690
1691		regmap_read(regmap, NAU8825_REG_INT_CLR_KEY_STATUS,
1692			&key_status);
1693
1694		/* upper 8 bits of the register are for short pressed keys,
1695		 * lower 8 bits - for long pressed buttons
1696		 */
1697		nau8825->button_pressed = nau8825_button_decode(
1698			key_status >> 8);
1699
1700		event |= nau8825->button_pressed;
1701		event_mask |= NAU8825_BUTTONS;
1702		clear_irq = NAU8825_KEY_SHORT_PRESS_IRQ;
1703	} else if (active_irq & NAU8825_KEY_RELEASE_IRQ) {
1704		event_mask = NAU8825_BUTTONS;
1705		clear_irq = NAU8825_KEY_RELEASE_IRQ;
1706	} else if (active_irq & NAU8825_HEADSET_COMPLETION_IRQ) {
1707		if (nau8825_is_jack_inserted(regmap)) {
1708			event |= nau8825_jack_insert(nau8825);
1709			if (nau8825->xtalk_enable && !nau8825->high_imped) {
1710				/* Apply the cross talk suppression in the
1711				 * headset without high impedance.
1712				 */
1713				if (!nau8825->xtalk_protect) {
1714					/* Raise protection for cross talk de-
1715					 * tection if no protection before.
1716					 * The driver has to cancel the pro-
1717					 * cess and restore changes if process
1718					 * is ongoing when ejection.
1719					 */
1720					int ret;
1721					nau8825->xtalk_protect = true;
1722					ret = nau8825_sema_acquire(nau8825, 0);
1723					if (ret)
1724						nau8825->xtalk_protect = false;
1725				}
1726				/* Startup cross talk detection process */
1727				if (nau8825->xtalk_protect) {
1728					nau8825->xtalk_state =
1729						NAU8825_XTALK_PREPARE;
1730					schedule_work(&nau8825->xtalk_work);
1731				}
1732			} else {
1733				/* The cross talk suppression shouldn't apply
1734				 * in the headset with high impedance. Thus,
1735				 * relieve the protection raised before.
1736				 */
1737				if (nau8825->xtalk_protect) {
1738					nau8825_sema_release(nau8825);
1739					nau8825->xtalk_protect = false;
1740				}
1741			}
1742		} else {
1743			dev_warn(nau8825->dev, "Headset completion IRQ fired but no headset connected\n");
1744			nau8825_eject_jack(nau8825);
1745		}
1746
1747		event_mask |= SND_JACK_HEADSET;
1748		clear_irq = NAU8825_HEADSET_COMPLETION_IRQ;
1749		/* Record the interruption report event for driver to report
1750		 * the event later. The jack report will delay until cross
1751		 * talk detection process is done.
1752		 */
1753		if (nau8825->xtalk_state == NAU8825_XTALK_PREPARE) {
1754			nau8825->xtalk_event = event;
1755			nau8825->xtalk_event_mask = event_mask;
1756		}
1757	} else if (active_irq & NAU8825_IMPEDANCE_MEAS_IRQ) {
1758		/* crosstalk detection enable and process on going */
1759		if (nau8825->xtalk_enable && nau8825->xtalk_protect)
1760			schedule_work(&nau8825->xtalk_work);
1761		clear_irq = NAU8825_IMPEDANCE_MEAS_IRQ;
1762	} else if ((active_irq & NAU8825_JACK_INSERTION_IRQ_MASK) ==
1763		NAU8825_JACK_INSERTION_DETECTED) {
1764		/* One more step to check GPIO status directly. Thus, the
1765		 * driver can confirm the real insertion interruption because
1766		 * the intrruption at manual mode has bypassed debounce
1767		 * circuit which can get rid of unstable status.
1768		 */
1769		if (nau8825_is_jack_inserted(regmap)) {
1770			/* Turn off insertion interruption at manual mode */
1771			regmap_update_bits(regmap,
1772				NAU8825_REG_INTERRUPT_DIS_CTRL,
1773				NAU8825_IRQ_INSERT_DIS,
1774				NAU8825_IRQ_INSERT_DIS);
1775			regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1776				NAU8825_IRQ_INSERT_EN, NAU8825_IRQ_INSERT_EN);
1777			/* Enable interruption for jack type detection at audo
1778			 * mode which can detect microphone and jack type.
1779			 */
1780			nau8825_setup_auto_irq(nau8825);
1781		}
1782	}
1783
1784	if (!clear_irq)
1785		clear_irq = active_irq;
1786	/* clears the rightmost interruption */
1787	regmap_write(regmap, NAU8825_REG_INT_CLR_KEY_STATUS, clear_irq);
1788
1789	/* Delay jack report until cross talk detection is done. It can avoid
1790	 * application to do playback preparation when cross talk detection
1791	 * process is still working. Otherwise, the resource like clock and
1792	 * power will be issued by them at the same time and conflict happens.
1793	 */
1794	if (event_mask && nau8825->xtalk_state == NAU8825_XTALK_DONE)
1795		snd_soc_jack_report(nau8825->jack, event, event_mask);
1796
1797	return IRQ_HANDLED;
1798}
1799
1800static void nau8825_setup_buttons(struct nau8825 *nau8825)
1801{
1802	struct regmap *regmap = nau8825->regmap;
1803
1804	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1805		NAU8825_SAR_TRACKING_GAIN_MASK,
1806		nau8825->sar_voltage << NAU8825_SAR_TRACKING_GAIN_SFT);
1807	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1808		NAU8825_SAR_COMPARE_TIME_MASK,
1809		nau8825->sar_compare_time << NAU8825_SAR_COMPARE_TIME_SFT);
1810	regmap_update_bits(regmap, NAU8825_REG_SAR_CTRL,
1811		NAU8825_SAR_SAMPLING_TIME_MASK,
1812		nau8825->sar_sampling_time << NAU8825_SAR_SAMPLING_TIME_SFT);
1813
1814	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
1815		NAU8825_KEYDET_LEVELS_NR_MASK,
1816		(nau8825->sar_threshold_num - 1) << NAU8825_KEYDET_LEVELS_NR_SFT);
1817	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
1818		NAU8825_KEYDET_HYSTERESIS_MASK,
1819		nau8825->sar_hysteresis << NAU8825_KEYDET_HYSTERESIS_SFT);
1820	regmap_update_bits(regmap, NAU8825_REG_KEYDET_CTRL,
1821		NAU8825_KEYDET_SHORTKEY_DEBOUNCE_MASK,
1822		nau8825->key_debounce << NAU8825_KEYDET_SHORTKEY_DEBOUNCE_SFT);
1823
1824	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_1,
1825		(nau8825->sar_threshold[0] << 8) | nau8825->sar_threshold[1]);
1826	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_2,
1827		(nau8825->sar_threshold[2] << 8) | nau8825->sar_threshold[3]);
1828	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_3,
1829		(nau8825->sar_threshold[4] << 8) | nau8825->sar_threshold[5]);
1830	regmap_write(regmap, NAU8825_REG_VDET_THRESHOLD_4,
1831		(nau8825->sar_threshold[6] << 8) | nau8825->sar_threshold[7]);
1832
1833	/* Enable short press and release interruptions */
1834	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1835		NAU8825_IRQ_KEY_SHORT_PRESS_EN | NAU8825_IRQ_KEY_RELEASE_EN,
1836		0);
1837}
1838
1839static void nau8825_init_regs(struct nau8825 *nau8825)
1840{
1841	struct regmap *regmap = nau8825->regmap;
1842
1843	/* Latch IIC LSB value */
1844	regmap_write(regmap, NAU8825_REG_IIC_ADDR_SET, 0x0001);
1845	/* Enable Bias/Vmid */
1846	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
1847		NAU8825_BIAS_VMID, NAU8825_BIAS_VMID);
1848	regmap_update_bits(nau8825->regmap, NAU8825_REG_BOOST,
1849		NAU8825_GLOBAL_BIAS_EN, NAU8825_GLOBAL_BIAS_EN);
1850
1851	/* VMID Tieoff */
1852	regmap_update_bits(regmap, NAU8825_REG_BIAS_ADJ,
1853		NAU8825_BIAS_VMID_SEL_MASK,
1854		nau8825->vref_impedance << NAU8825_BIAS_VMID_SEL_SFT);
1855	/* Disable Boost Driver, Automatic Short circuit protection enable */
1856	regmap_update_bits(regmap, NAU8825_REG_BOOST,
1857		NAU8825_PRECHARGE_DIS | NAU8825_HP_BOOST_DIS |
1858		NAU8825_HP_BOOST_G_DIS | NAU8825_SHORT_SHUTDOWN_EN,
1859		NAU8825_PRECHARGE_DIS | NAU8825_HP_BOOST_DIS |
1860		NAU8825_HP_BOOST_G_DIS | NAU8825_SHORT_SHUTDOWN_EN);
1861
1862	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
1863		NAU8825_JKDET_OUTPUT_EN,
1864		nau8825->jkdet_enable ? 0 : NAU8825_JKDET_OUTPUT_EN);
1865	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
1866		NAU8825_JKDET_PULL_EN,
1867		nau8825->jkdet_pull_enable ? 0 : NAU8825_JKDET_PULL_EN);
1868	regmap_update_bits(regmap, NAU8825_REG_GPIO12_CTRL,
1869		NAU8825_JKDET_PULL_UP,
1870		nau8825->jkdet_pull_up ? NAU8825_JKDET_PULL_UP : 0);
1871	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1872		NAU8825_JACK_POLARITY,
1873		/* jkdet_polarity - 1  is for active-low */
1874		nau8825->jkdet_polarity ? 0 : NAU8825_JACK_POLARITY);
1875
1876	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1877		NAU8825_JACK_INSERT_DEBOUNCE_MASK,
1878		nau8825->jack_insert_debounce << NAU8825_JACK_INSERT_DEBOUNCE_SFT);
1879	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
1880		NAU8825_JACK_EJECT_DEBOUNCE_MASK,
1881		nau8825->jack_eject_debounce << NAU8825_JACK_EJECT_DEBOUNCE_SFT);
1882
1883	/* Pull up IRQ pin */
1884	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
1885		NAU8825_IRQ_PIN_PULLUP | NAU8825_IRQ_PIN_PULL_EN,
1886		NAU8825_IRQ_PIN_PULLUP | NAU8825_IRQ_PIN_PULL_EN);
1887	/* Mask unneeded IRQs: 1 - disable, 0 - enable */
1888	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK, 0x7ff, 0x7ff);
1889
1890	regmap_update_bits(regmap, NAU8825_REG_MIC_BIAS,
1891		NAU8825_MICBIAS_VOLTAGE_MASK, nau8825->micbias_voltage);
1892
1893	if (nau8825->sar_threshold_num)
1894		nau8825_setup_buttons(nau8825);
1895
1896	/* Default oversampling/decimations settings are unusable
1897	 * (audible hiss). Set it to something better.
1898	 */
1899	regmap_update_bits(regmap, NAU8825_REG_ADC_RATE,
1900		NAU8825_ADC_SYNC_DOWN_MASK | NAU8825_ADC_SINC4_EN,
1901		NAU8825_ADC_SYNC_DOWN_64);
1902	regmap_update_bits(regmap, NAU8825_REG_DAC_CTRL1,
1903		NAU8825_DAC_OVERSAMPLE_MASK, NAU8825_DAC_OVERSAMPLE_64);
1904	/* Disable DACR/L power */
1905	regmap_update_bits(regmap, NAU8825_REG_CHARGE_PUMP,
1906		NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL,
1907		NAU8825_POWER_DOWN_DACR | NAU8825_POWER_DOWN_DACL);
 
1908	/* Enable TESTDAC. This sets the analog DAC inputs to a '0' input
1909	 * signal to avoid any glitches due to power up transients in both
1910	 * the analog and digital DAC circuit.
1911	 */
1912	regmap_update_bits(nau8825->regmap, NAU8825_REG_BIAS_ADJ,
1913		NAU8825_BIAS_TESTDAC_EN, NAU8825_BIAS_TESTDAC_EN);
1914	/* CICCLP off */
1915	regmap_update_bits(regmap, NAU8825_REG_DAC_CTRL1,
1916		NAU8825_DAC_CLIP_OFF, NAU8825_DAC_CLIP_OFF);
1917
1918	/* Class AB bias current to 2x, DAC Capacitor enable MSB/LSB */
1919	regmap_update_bits(regmap, NAU8825_REG_ANALOG_CONTROL_2,
1920		NAU8825_HP_NON_CLASSG_CURRENT_2xADJ |
1921		NAU8825_DAC_CAPACITOR_MSB | NAU8825_DAC_CAPACITOR_LSB,
1922		NAU8825_HP_NON_CLASSG_CURRENT_2xADJ |
1923		NAU8825_DAC_CAPACITOR_MSB | NAU8825_DAC_CAPACITOR_LSB);
1924	/* Class G timer 64ms */
1925	regmap_update_bits(regmap, NAU8825_REG_CLASSG_CTRL,
1926		NAU8825_CLASSG_TIMER_MASK,
1927		0x20 << NAU8825_CLASSG_TIMER_SFT);
1928	/* DAC clock delay 2ns, VREF */
1929	regmap_update_bits(regmap, NAU8825_REG_RDAC,
1930		NAU8825_RDAC_CLK_DELAY_MASK | NAU8825_RDAC_VREF_MASK,
1931		(0x2 << NAU8825_RDAC_CLK_DELAY_SFT) |
1932		(0x3 << NAU8825_RDAC_VREF_SFT));
1933	/* Config L/R channel */
1934	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACL_CTRL,
1935		NAU8825_DACL_CH_SEL_MASK, NAU8825_DACL_CH_SEL_L);
1936	regmap_update_bits(nau8825->regmap, NAU8825_REG_DACR_CTRL,
1937		NAU8825_DACL_CH_SEL_MASK, NAU8825_DACL_CH_SEL_R);
1938	/* Disable short Frame Sync detection logic */
1939	regmap_update_bits(regmap, NAU8825_REG_LEFT_TIME_SLOT,
1940		NAU8825_DIS_FS_SHORT_DET, NAU8825_DIS_FS_SHORT_DET);
 
 
 
 
1941}
1942
1943static const struct regmap_config nau8825_regmap_config = {
1944	.val_bits = NAU8825_REG_DATA_LEN,
1945	.reg_bits = NAU8825_REG_ADDR_LEN,
1946
1947	.max_register = NAU8825_REG_MAX,
1948	.readable_reg = nau8825_readable_reg,
1949	.writeable_reg = nau8825_writeable_reg,
1950	.volatile_reg = nau8825_volatile_reg,
1951
1952	.cache_type = REGCACHE_RBTREE,
1953	.reg_defaults = nau8825_reg_defaults,
1954	.num_reg_defaults = ARRAY_SIZE(nau8825_reg_defaults),
1955};
1956
1957static int nau8825_component_probe(struct snd_soc_component *component)
1958{
1959	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1960	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
1961
1962	nau8825->dapm = dapm;
1963
1964	return 0;
1965}
1966
1967static void nau8825_component_remove(struct snd_soc_component *component)
1968{
1969	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
1970
1971	/* Cancel and reset cross tak suppresstion detection funciton */
1972	nau8825_xtalk_cancel(nau8825);
1973}
1974
1975/**
1976 * nau8825_calc_fll_param - Calculate FLL parameters.
1977 * @fll_in: external clock provided to codec.
1978 * @fs: sampling rate.
1979 * @fll_param: Pointer to structure of FLL parameters.
1980 *
1981 * Calculate FLL parameters to configure codec.
1982 *
1983 * Returns 0 for success or negative error code.
1984 */
1985static int nau8825_calc_fll_param(unsigned int fll_in, unsigned int fs,
1986		struct nau8825_fll *fll_param)
1987{
1988	u64 fvco, fvco_max;
1989	unsigned int fref, i, fvco_sel;
1990
1991	/* Ensure the reference clock frequency (FREF) is <= 13.5MHz by dividing
1992	 * freq_in by 1, 2, 4, or 8 using FLL pre-scalar.
1993	 * FREF = freq_in / NAU8825_FLL_REF_DIV_MASK
1994	 */
1995	for (i = 0; i < ARRAY_SIZE(fll_pre_scalar); i++) {
1996		fref = fll_in / fll_pre_scalar[i].param;
1997		if (fref <= NAU_FREF_MAX)
1998			break;
1999	}
2000	if (i == ARRAY_SIZE(fll_pre_scalar))
2001		return -EINVAL;
2002	fll_param->clk_ref_div = fll_pre_scalar[i].val;
2003
2004	/* Choose the FLL ratio based on FREF */
2005	for (i = 0; i < ARRAY_SIZE(fll_ratio); i++) {
2006		if (fref >= fll_ratio[i].param)
2007			break;
2008	}
2009	if (i == ARRAY_SIZE(fll_ratio))
2010		return -EINVAL;
2011	fll_param->ratio = fll_ratio[i].val;
2012
2013	/* Calculate the frequency of DCO (FDCO) given freq_out = 256 * Fs.
2014	 * FDCO must be within the 90MHz - 124MHz or the FFL cannot be
2015	 * guaranteed across the full range of operation.
2016	 * FDCO = freq_out * 2 * mclk_src_scaling
2017	 */
2018	fvco_max = 0;
2019	fvco_sel = ARRAY_SIZE(mclk_src_scaling);
2020	for (i = 0; i < ARRAY_SIZE(mclk_src_scaling); i++) {
2021		fvco = 256ULL * fs * 2 * mclk_src_scaling[i].param;
2022		if (fvco > NAU_FVCO_MIN && fvco < NAU_FVCO_MAX &&
2023			fvco_max < fvco) {
2024			fvco_max = fvco;
2025			fvco_sel = i;
2026		}
2027	}
2028	if (ARRAY_SIZE(mclk_src_scaling) == fvco_sel)
2029		return -EINVAL;
2030	fll_param->mclk_src = mclk_src_scaling[fvco_sel].val;
2031
2032	/* Calculate the FLL 10-bit integer input and the FLL 16-bit fractional
2033	 * input based on FDCO, FREF and FLL ratio.
2034	 */
2035	fvco = div_u64(fvco_max << 16, fref * fll_param->ratio);
2036	fll_param->fll_int = (fvco >> 16) & 0x3FF;
2037	fll_param->fll_frac = fvco & 0xFFFF;
 
 
 
2038	return 0;
2039}
2040
2041static void nau8825_fll_apply(struct nau8825 *nau8825,
2042		struct nau8825_fll *fll_param)
2043{
2044	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
2045		NAU8825_CLK_SRC_MASK | NAU8825_CLK_MCLK_SRC_MASK,
2046		NAU8825_CLK_SRC_MCLK | fll_param->mclk_src);
2047	/* Make DSP operate at high speed for better performance. */
2048	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL1,
2049		NAU8825_FLL_RATIO_MASK | NAU8825_ICTRL_LATCH_MASK,
2050		fll_param->ratio | (0x6 << NAU8825_ICTRL_LATCH_SFT));
2051	/* FLL 16-bit fractional input */
2052	regmap_write(nau8825->regmap, NAU8825_REG_FLL2, fll_param->fll_frac);
 
 
 
 
 
 
 
 
2053	/* FLL 10-bit integer input */
2054	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL3,
2055			NAU8825_FLL_INTEGER_MASK, fll_param->fll_int);
2056	/* FLL pre-scaler */
2057	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL4,
2058			NAU8825_FLL_REF_DIV_MASK,
2059			fll_param->clk_ref_div << NAU8825_FLL_REF_DIV_SFT);
2060	/* select divided VCO input */
2061	regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2062		NAU8825_FLL_CLK_SW_MASK, NAU8825_FLL_CLK_SW_REF);
2063	/* Disable free-running mode */
2064	regmap_update_bits(nau8825->regmap,
2065		NAU8825_REG_FLL6, NAU8825_DCO_EN, 0);
2066	if (fll_param->fll_frac) {
2067		/* set FLL loop filter enable and cutoff frequency at 500Khz */
2068		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2069			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2070			NAU8825_FLL_FTR_SW_MASK,
2071			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2072			NAU8825_FLL_FTR_SW_FILTER);
2073		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6,
2074			NAU8825_SDM_EN | NAU8825_CUTOFF500,
2075			NAU8825_SDM_EN | NAU8825_CUTOFF500);
2076	} else {
2077		/* disable FLL loop filter and cutoff frequency */
2078		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL5,
2079			NAU8825_FLL_PDB_DAC_EN | NAU8825_FLL_LOOP_FTR_EN |
2080			NAU8825_FLL_FTR_SW_MASK, NAU8825_FLL_FTR_SW_ACCU);
2081		regmap_update_bits(nau8825->regmap, NAU8825_REG_FLL6,
2082			NAU8825_SDM_EN | NAU8825_CUTOFF500, 0);
2083	}
2084}
2085
2086/* freq_out must be 256*Fs in order to achieve the best performance */
2087static int nau8825_set_pll(struct snd_soc_component *component, int pll_id, int source,
2088		unsigned int freq_in, unsigned int freq_out)
2089{
2090	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2091	struct nau8825_fll fll_param;
2092	int ret, fs;
2093
 
 
 
 
 
2094	fs = freq_out / 256;
2095	ret = nau8825_calc_fll_param(freq_in, fs, &fll_param);
2096	if (ret < 0) {
2097		dev_err(component->dev, "Unsupported input clock %d\n", freq_in);
2098		return ret;
2099	}
2100	dev_dbg(component->dev, "mclk_src=%x ratio=%x fll_frac=%x fll_int=%x clk_ref_div=%x\n",
2101		fll_param.mclk_src, fll_param.ratio, fll_param.fll_frac,
2102		fll_param.fll_int, fll_param.clk_ref_div);
2103
2104	nau8825_fll_apply(nau8825, &fll_param);
2105	mdelay(2);
2106	regmap_update_bits(nau8825->regmap, NAU8825_REG_CLK_DIVIDER,
2107			NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
2108	return 0;
2109}
2110
2111static int nau8825_mclk_prepare(struct nau8825 *nau8825, unsigned int freq)
2112{
2113	int ret = 0;
2114
2115	nau8825->mclk = devm_clk_get(nau8825->dev, "mclk");
2116	if (IS_ERR(nau8825->mclk)) {
2117		dev_info(nau8825->dev, "No 'mclk' clock found, assume MCLK is managed externally");
2118		return 0;
2119	}
2120
2121	if (!nau8825->mclk_freq) {
2122		ret = clk_prepare_enable(nau8825->mclk);
2123		if (ret) {
2124			dev_err(nau8825->dev, "Unable to prepare codec mclk\n");
2125			return ret;
2126		}
2127	}
2128
2129	if (nau8825->mclk_freq != freq) {
2130		freq = clk_round_rate(nau8825->mclk, freq);
2131		ret = clk_set_rate(nau8825->mclk, freq);
2132		if (ret) {
2133			dev_err(nau8825->dev, "Unable to set mclk rate\n");
2134			return ret;
2135		}
2136		nau8825->mclk_freq = freq;
2137	}
2138
2139	return 0;
2140}
2141
2142static void nau8825_configure_mclk_as_sysclk(struct regmap *regmap)
2143{
2144	regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2145		NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_MCLK);
2146	regmap_update_bits(regmap, NAU8825_REG_FLL6,
2147		NAU8825_DCO_EN, 0);
2148	/* Make DSP operate as default setting for power saving. */
2149	regmap_update_bits(regmap, NAU8825_REG_FLL1,
2150		NAU8825_ICTRL_LATCH_MASK, 0);
2151}
2152
2153static int nau8825_configure_sysclk(struct nau8825 *nau8825, int clk_id,
2154	unsigned int freq)
2155{
2156	struct regmap *regmap = nau8825->regmap;
2157	int ret;
2158
2159	switch (clk_id) {
2160	case NAU8825_CLK_DIS:
2161		/* Clock provided externally and disable internal VCO clock */
2162		nau8825_configure_mclk_as_sysclk(regmap);
2163		if (nau8825->mclk_freq) {
2164			clk_disable_unprepare(nau8825->mclk);
2165			nau8825->mclk_freq = 0;
2166		}
2167
2168		break;
2169	case NAU8825_CLK_MCLK:
2170		/* Acquire the semaphore to synchronize the playback and
2171		 * interrupt handler. In order to avoid the playback inter-
2172		 * fered by cross talk process, the driver make the playback
2173		 * preparation halted until cross talk process finish.
2174		 */
2175		nau8825_sema_acquire(nau8825, 3 * HZ);
2176		nau8825_configure_mclk_as_sysclk(regmap);
2177		/* MCLK not changed by clock tree */
2178		regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2179			NAU8825_CLK_MCLK_SRC_MASK, 0);
2180		/* Release the semaphore. */
2181		nau8825_sema_release(nau8825);
2182
2183		ret = nau8825_mclk_prepare(nau8825, freq);
2184		if (ret)
2185			return ret;
2186
2187		break;
2188	case NAU8825_CLK_INTERNAL:
2189		if (nau8825_is_jack_inserted(nau8825->regmap)) {
2190			regmap_update_bits(regmap, NAU8825_REG_FLL6,
2191				NAU8825_DCO_EN, NAU8825_DCO_EN);
2192			regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2193				NAU8825_CLK_SRC_MASK, NAU8825_CLK_SRC_VCO);
2194			/* Decrease the VCO frequency and make DSP operate
2195			 * as default setting for power saving.
2196			 */
2197			regmap_update_bits(regmap, NAU8825_REG_CLK_DIVIDER,
2198				NAU8825_CLK_MCLK_SRC_MASK, 0xf);
2199			regmap_update_bits(regmap, NAU8825_REG_FLL1,
2200				NAU8825_ICTRL_LATCH_MASK |
2201				NAU8825_FLL_RATIO_MASK, 0x10);
2202			regmap_update_bits(regmap, NAU8825_REG_FLL6,
2203				NAU8825_SDM_EN, NAU8825_SDM_EN);
2204		} else {
2205			/* The clock turns off intentionally for power saving
2206			 * when no headset connected.
2207			 */
2208			nau8825_configure_mclk_as_sysclk(regmap);
2209			dev_warn(nau8825->dev, "Disable clock for power saving when no headset connected\n");
2210		}
2211		if (nau8825->mclk_freq) {
2212			clk_disable_unprepare(nau8825->mclk);
2213			nau8825->mclk_freq = 0;
2214		}
2215
2216		break;
2217	case NAU8825_CLK_FLL_MCLK:
2218		/* Acquire the semaphore to synchronize the playback and
2219		 * interrupt handler. In order to avoid the playback inter-
2220		 * fered by cross talk process, the driver make the playback
2221		 * preparation halted until cross talk process finish.
2222		 */
2223		nau8825_sema_acquire(nau8825, 3 * HZ);
2224		/* Higher FLL reference input frequency can only set lower
2225		 * gain error, such as 0000 for input reference from MCLK
2226		 * 12.288Mhz.
2227		 */
2228		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2229			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2230			NAU8825_FLL_CLK_SRC_MCLK | 0);
2231		/* Release the semaphore. */
2232		nau8825_sema_release(nau8825);
2233
2234		ret = nau8825_mclk_prepare(nau8825, freq);
2235		if (ret)
2236			return ret;
2237
2238		break;
2239	case NAU8825_CLK_FLL_BLK:
2240		/* Acquire the semaphore to synchronize the playback and
2241		 * interrupt handler. In order to avoid the playback inter-
2242		 * fered by cross talk process, the driver make the playback
2243		 * preparation halted until cross talk process finish.
2244		 */
2245		nau8825_sema_acquire(nau8825, 3 * HZ);
2246		/* If FLL reference input is from low frequency source,
2247		 * higher error gain can apply such as 0xf which has
2248		 * the most sensitive gain error correction threshold,
2249		 * Therefore, FLL has the most accurate DCO to
2250		 * target frequency.
2251		 */
2252		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2253			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2254			NAU8825_FLL_CLK_SRC_BLK |
2255			(0xf << NAU8825_GAIN_ERR_SFT));
2256		/* Release the semaphore. */
2257		nau8825_sema_release(nau8825);
2258
2259		if (nau8825->mclk_freq) {
2260			clk_disable_unprepare(nau8825->mclk);
2261			nau8825->mclk_freq = 0;
2262		}
2263
2264		break;
2265	case NAU8825_CLK_FLL_FS:
2266		/* Acquire the semaphore to synchronize the playback and
2267		 * interrupt handler. In order to avoid the playback inter-
2268		 * fered by cross talk process, the driver make the playback
2269		 * preparation halted until cross talk process finish.
2270		 */
2271		nau8825_sema_acquire(nau8825, 3 * HZ);
2272		/* If FLL reference input is from low frequency source,
2273		 * higher error gain can apply such as 0xf which has
2274		 * the most sensitive gain error correction threshold,
2275		 * Therefore, FLL has the most accurate DCO to
2276		 * target frequency.
2277		 */
2278		regmap_update_bits(regmap, NAU8825_REG_FLL3,
2279			NAU8825_FLL_CLK_SRC_MASK | NAU8825_GAIN_ERR_MASK,
2280			NAU8825_FLL_CLK_SRC_FS |
2281			(0xf << NAU8825_GAIN_ERR_SFT));
2282		/* Release the semaphore. */
2283		nau8825_sema_release(nau8825);
2284
2285		if (nau8825->mclk_freq) {
2286			clk_disable_unprepare(nau8825->mclk);
2287			nau8825->mclk_freq = 0;
2288		}
2289
2290		break;
2291	default:
2292		dev_err(nau8825->dev, "Invalid clock id (%d)\n", clk_id);
2293		return -EINVAL;
2294	}
2295
2296	dev_dbg(nau8825->dev, "Sysclk is %dHz and clock id is %d\n", freq,
2297		clk_id);
2298	return 0;
2299}
2300
2301static int nau8825_set_sysclk(struct snd_soc_component *component, int clk_id,
2302	int source, unsigned int freq, int dir)
2303{
2304	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2305
2306	return nau8825_configure_sysclk(nau8825, clk_id, freq);
2307}
2308
2309static int nau8825_resume_setup(struct nau8825 *nau8825)
2310{
2311	struct regmap *regmap = nau8825->regmap;
2312
2313	/* Close clock when jack type detection at manual mode */
2314	nau8825_configure_sysclk(nau8825, NAU8825_CLK_DIS, 0);
2315
2316	/* Clear all interruption status */
2317	nau8825_int_status_clear_all(regmap);
2318
2319	/* Enable both insertion and ejection interruptions, and then
2320	 * bypass de-bounce circuit.
2321	 */
2322	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_MASK,
2323		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_HEADSET_COMPLETE_EN |
2324		NAU8825_IRQ_EJECT_EN | NAU8825_IRQ_INSERT_EN,
2325		NAU8825_IRQ_OUTPUT_EN | NAU8825_IRQ_HEADSET_COMPLETE_EN);
2326	regmap_update_bits(regmap, NAU8825_REG_JACK_DET_CTRL,
2327		NAU8825_JACK_DET_DB_BYPASS, NAU8825_JACK_DET_DB_BYPASS);
2328	regmap_update_bits(regmap, NAU8825_REG_INTERRUPT_DIS_CTRL,
2329		NAU8825_IRQ_INSERT_DIS | NAU8825_IRQ_EJECT_DIS, 0);
2330
2331	return 0;
2332}
2333
2334static int nau8825_set_bias_level(struct snd_soc_component *component,
2335				   enum snd_soc_bias_level level)
2336{
2337	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2338	int ret;
2339
2340	switch (level) {
2341	case SND_SOC_BIAS_ON:
2342		break;
2343
2344	case SND_SOC_BIAS_PREPARE:
2345		break;
2346
2347	case SND_SOC_BIAS_STANDBY:
2348		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
2349			if (nau8825->mclk_freq) {
2350				ret = clk_prepare_enable(nau8825->mclk);
2351				if (ret) {
2352					dev_err(nau8825->dev, "Unable to prepare component mclk\n");
2353					return ret;
2354				}
2355			}
2356			/* Setup codec configuration after resume */
2357			nau8825_resume_setup(nau8825);
2358		}
2359		break;
2360
2361	case SND_SOC_BIAS_OFF:
2362		/* Reset the configuration of jack type for detection */
2363		/* Detach 2kOhm Resistors from MICBIAS to MICGND1/2 */
2364		regmap_update_bits(nau8825->regmap, NAU8825_REG_MIC_BIAS,
2365			NAU8825_MICBIAS_JKSLV | NAU8825_MICBIAS_JKR2, 0);
2366		/* ground HPL/HPR, MICGRND1/2 */
2367		regmap_update_bits(nau8825->regmap,
2368			NAU8825_REG_HSD_CTRL, 0xf, 0xf);
2369		/* Cancel and reset cross talk detection funciton */
2370		nau8825_xtalk_cancel(nau8825);
2371		/* Turn off all interruptions before system shutdown. Keep the
2372		 * interruption quiet before resume setup completes.
2373		 */
2374		regmap_write(nau8825->regmap,
2375			NAU8825_REG_INTERRUPT_DIS_CTRL, 0xffff);
2376		/* Disable ADC needed for interruptions at audo mode */
2377		regmap_update_bits(nau8825->regmap, NAU8825_REG_ENA_CTRL,
2378			NAU8825_ENABLE_ADC, 0);
2379		if (nau8825->mclk_freq)
2380			clk_disable_unprepare(nau8825->mclk);
2381		break;
2382	}
2383	return 0;
2384}
2385
2386static int __maybe_unused nau8825_suspend(struct snd_soc_component *component)
2387{
2388	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2389
2390	disable_irq(nau8825->irq);
2391	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
2392	/* Power down codec power; don't suppoet button wakeup */
2393	snd_soc_dapm_disable_pin(nau8825->dapm, "SAR");
2394	snd_soc_dapm_disable_pin(nau8825->dapm, "MICBIAS");
2395	snd_soc_dapm_sync(nau8825->dapm);
2396	regcache_cache_only(nau8825->regmap, true);
2397	regcache_mark_dirty(nau8825->regmap);
2398
2399	return 0;
2400}
2401
2402static int __maybe_unused nau8825_resume(struct snd_soc_component *component)
2403{
2404	struct nau8825 *nau8825 = snd_soc_component_get_drvdata(component);
2405	int ret;
2406
2407	regcache_cache_only(nau8825->regmap, false);
2408	regcache_sync(nau8825->regmap);
2409	nau8825->xtalk_protect = true;
2410	ret = nau8825_sema_acquire(nau8825, 0);
2411	if (ret)
2412		nau8825->xtalk_protect = false;
2413	enable_irq(nau8825->irq);
2414
2415	return 0;
2416}
2417
 
 
 
 
 
 
2418static const struct snd_soc_component_driver nau8825_component_driver = {
2419	.probe			= nau8825_component_probe,
2420	.remove			= nau8825_component_remove,
2421	.set_sysclk		= nau8825_set_sysclk,
2422	.set_pll		= nau8825_set_pll,
2423	.set_bias_level		= nau8825_set_bias_level,
2424	.suspend		= nau8825_suspend,
2425	.resume			= nau8825_resume,
2426	.controls		= nau8825_controls,
2427	.num_controls		= ARRAY_SIZE(nau8825_controls),
2428	.dapm_widgets		= nau8825_dapm_widgets,
2429	.num_dapm_widgets	= ARRAY_SIZE(nau8825_dapm_widgets),
2430	.dapm_routes		= nau8825_dapm_routes,
2431	.num_dapm_routes	= ARRAY_SIZE(nau8825_dapm_routes),
 
2432	.suspend_bias_off	= 1,
2433	.idle_bias_on		= 1,
2434	.use_pmdown_time	= 1,
2435	.endianness		= 1,
2436	.non_legacy_dai_naming	= 1,
2437};
2438
2439static void nau8825_reset_chip(struct regmap *regmap)
2440{
2441	regmap_write(regmap, NAU8825_REG_RESET, 0x00);
2442	regmap_write(regmap, NAU8825_REG_RESET, 0x00);
2443}
2444
2445static void nau8825_print_device_properties(struct nau8825 *nau8825)
2446{
2447	int i;
2448	struct device *dev = nau8825->dev;
2449
2450	dev_dbg(dev, "jkdet-enable:         %d\n", nau8825->jkdet_enable);
2451	dev_dbg(dev, "jkdet-pull-enable:    %d\n", nau8825->jkdet_pull_enable);
2452	dev_dbg(dev, "jkdet-pull-up:        %d\n", nau8825->jkdet_pull_up);
2453	dev_dbg(dev, "jkdet-polarity:       %d\n", nau8825->jkdet_polarity);
2454	dev_dbg(dev, "micbias-voltage:      %d\n", nau8825->micbias_voltage);
2455	dev_dbg(dev, "vref-impedance:       %d\n", nau8825->vref_impedance);
2456
2457	dev_dbg(dev, "sar-threshold-num:    %d\n", nau8825->sar_threshold_num);
2458	for (i = 0; i < nau8825->sar_threshold_num; i++)
2459		dev_dbg(dev, "sar-threshold[%d]=%d\n", i,
2460				nau8825->sar_threshold[i]);
2461
2462	dev_dbg(dev, "sar-hysteresis:       %d\n", nau8825->sar_hysteresis);
2463	dev_dbg(dev, "sar-voltage:          %d\n", nau8825->sar_voltage);
2464	dev_dbg(dev, "sar-compare-time:     %d\n", nau8825->sar_compare_time);
2465	dev_dbg(dev, "sar-sampling-time:    %d\n", nau8825->sar_sampling_time);
2466	dev_dbg(dev, "short-key-debounce:   %d\n", nau8825->key_debounce);
2467	dev_dbg(dev, "jack-insert-debounce: %d\n",
2468			nau8825->jack_insert_debounce);
2469	dev_dbg(dev, "jack-eject-debounce:  %d\n",
2470			nau8825->jack_eject_debounce);
2471	dev_dbg(dev, "crosstalk-enable:     %d\n",
2472			nau8825->xtalk_enable);
 
 
2473}
2474
2475static int nau8825_read_device_properties(struct device *dev,
2476	struct nau8825 *nau8825) {
2477	int ret;
2478
2479	nau8825->jkdet_enable = device_property_read_bool(dev,
2480		"nuvoton,jkdet-enable");
2481	nau8825->jkdet_pull_enable = device_property_read_bool(dev,
2482		"nuvoton,jkdet-pull-enable");
2483	nau8825->jkdet_pull_up = device_property_read_bool(dev,
2484		"nuvoton,jkdet-pull-up");
2485	ret = device_property_read_u32(dev, "nuvoton,jkdet-polarity",
2486		&nau8825->jkdet_polarity);
2487	if (ret)
2488		nau8825->jkdet_polarity = 1;
2489	ret = device_property_read_u32(dev, "nuvoton,micbias-voltage",
2490		&nau8825->micbias_voltage);
2491	if (ret)
2492		nau8825->micbias_voltage = 6;
2493	ret = device_property_read_u32(dev, "nuvoton,vref-impedance",
2494		&nau8825->vref_impedance);
2495	if (ret)
2496		nau8825->vref_impedance = 2;
2497	ret = device_property_read_u32(dev, "nuvoton,sar-threshold-num",
2498		&nau8825->sar_threshold_num);
2499	if (ret)
2500		nau8825->sar_threshold_num = 4;
2501	ret = device_property_read_u32_array(dev, "nuvoton,sar-threshold",
2502		nau8825->sar_threshold, nau8825->sar_threshold_num);
2503	if (ret) {
2504		nau8825->sar_threshold[0] = 0x08;
2505		nau8825->sar_threshold[1] = 0x12;
2506		nau8825->sar_threshold[2] = 0x26;
2507		nau8825->sar_threshold[3] = 0x73;
2508	}
2509	ret = device_property_read_u32(dev, "nuvoton,sar-hysteresis",
2510		&nau8825->sar_hysteresis);
2511	if (ret)
2512		nau8825->sar_hysteresis = 0;
2513	ret = device_property_read_u32(dev, "nuvoton,sar-voltage",
2514		&nau8825->sar_voltage);
2515	if (ret)
2516		nau8825->sar_voltage = 6;
2517	ret = device_property_read_u32(dev, "nuvoton,sar-compare-time",
2518		&nau8825->sar_compare_time);
2519	if (ret)
2520		nau8825->sar_compare_time = 1;
2521	ret = device_property_read_u32(dev, "nuvoton,sar-sampling-time",
2522		&nau8825->sar_sampling_time);
2523	if (ret)
2524		nau8825->sar_sampling_time = 1;
2525	ret = device_property_read_u32(dev, "nuvoton,short-key-debounce",
2526		&nau8825->key_debounce);
2527	if (ret)
2528		nau8825->key_debounce = 3;
2529	ret = device_property_read_u32(dev, "nuvoton,jack-insert-debounce",
2530		&nau8825->jack_insert_debounce);
2531	if (ret)
2532		nau8825->jack_insert_debounce = 7;
2533	ret = device_property_read_u32(dev, "nuvoton,jack-eject-debounce",
2534		&nau8825->jack_eject_debounce);
2535	if (ret)
2536		nau8825->jack_eject_debounce = 0;
2537	nau8825->xtalk_enable = device_property_read_bool(dev,
2538		"nuvoton,crosstalk-enable");
2539
2540	nau8825->mclk = devm_clk_get(dev, "mclk");
2541	if (PTR_ERR(nau8825->mclk) == -EPROBE_DEFER) {
2542		return -EPROBE_DEFER;
2543	} else if (PTR_ERR(nau8825->mclk) == -ENOENT) {
 
 
 
 
 
 
2544		/* The MCLK is managed externally or not used at all */
2545		nau8825->mclk = NULL;
2546		dev_info(dev, "No 'mclk' clock found, assume MCLK is managed externally");
2547	} else if (IS_ERR(nau8825->mclk)) {
2548		return -EINVAL;
2549	}
2550
2551	return 0;
2552}
2553
2554static int nau8825_setup_irq(struct nau8825 *nau8825)
2555{
2556	int ret;
2557
2558	ret = devm_request_threaded_irq(nau8825->dev, nau8825->irq, NULL,
2559		nau8825_interrupt, IRQF_TRIGGER_LOW | IRQF_ONESHOT,
2560		"nau8825", nau8825);
2561
2562	if (ret) {
2563		dev_err(nau8825->dev, "Cannot request irq %d (%d)\n",
2564			nau8825->irq, ret);
2565		return ret;
2566	}
2567
2568	return 0;
2569}
2570
2571static int nau8825_i2c_probe(struct i2c_client *i2c,
2572	const struct i2c_device_id *id)
2573{
2574	struct device *dev = &i2c->dev;
2575	struct nau8825 *nau8825 = dev_get_platdata(&i2c->dev);
2576	int ret, value;
2577
2578	if (!nau8825) {
2579		nau8825 = devm_kzalloc(dev, sizeof(*nau8825), GFP_KERNEL);
2580		if (!nau8825)
2581			return -ENOMEM;
2582		ret = nau8825_read_device_properties(dev, nau8825);
2583		if (ret)
2584			return ret;
2585	}
2586
2587	i2c_set_clientdata(i2c, nau8825);
2588
2589	nau8825->regmap = devm_regmap_init_i2c(i2c, &nau8825_regmap_config);
2590	if (IS_ERR(nau8825->regmap))
2591		return PTR_ERR(nau8825->regmap);
2592	nau8825->dev = dev;
2593	nau8825->irq = i2c->irq;
2594	/* Initiate parameters, semaphore and work queue which are needed in
2595	 * cross talk suppression measurment function.
2596	 */
2597	nau8825->xtalk_state = NAU8825_XTALK_DONE;
2598	nau8825->xtalk_protect = false;
2599	nau8825->xtalk_baktab_initialized = false;
2600	sema_init(&nau8825->xtalk_sem, 1);
2601	INIT_WORK(&nau8825->xtalk_work, nau8825_xtalk_work);
2602
2603	nau8825_print_device_properties(nau8825);
2604
2605	nau8825_reset_chip(nau8825->regmap);
2606	ret = regmap_read(nau8825->regmap, NAU8825_REG_I2C_DEVICE_ID, &value);
2607	if (ret < 0) {
2608		dev_err(dev, "Failed to read device id from the NAU8825: %d\n",
2609			ret);
2610		return ret;
2611	}
2612	if ((value & NAU8825_SOFTWARE_ID_MASK) !=
2613			NAU8825_SOFTWARE_ID_NAU8825) {
 
 
 
 
 
 
 
 
 
 
 
2614		dev_err(dev, "Not a NAU8825 chip\n");
2615		return -ENODEV;
2616	}
2617
2618	nau8825_init_regs(nau8825);
2619
2620	if (i2c->irq)
2621		nau8825_setup_irq(nau8825);
2622
2623	return devm_snd_soc_register_component(&i2c->dev,
2624		&nau8825_component_driver,
2625		&nau8825_dai, 1);
2626}
2627
2628static int nau8825_i2c_remove(struct i2c_client *client)
2629{
2630	return 0;
2631}
2632
2633static const struct i2c_device_id nau8825_i2c_ids[] = {
2634	{ "nau8825", 0 },
2635	{ }
2636};
2637MODULE_DEVICE_TABLE(i2c, nau8825_i2c_ids);
2638
2639#ifdef CONFIG_OF
2640static const struct of_device_id nau8825_of_ids[] = {
2641	{ .compatible = "nuvoton,nau8825", },
2642	{}
2643};
2644MODULE_DEVICE_TABLE(of, nau8825_of_ids);
2645#endif
2646
2647#ifdef CONFIG_ACPI
2648static const struct acpi_device_id nau8825_acpi_match[] = {
2649	{ "10508825", 0 },
2650	{},
2651};
2652MODULE_DEVICE_TABLE(acpi, nau8825_acpi_match);
2653#endif
2654
2655static struct i2c_driver nau8825_driver = {
2656	.driver = {
2657		.name = "nau8825",
2658		.of_match_table = of_match_ptr(nau8825_of_ids),
2659		.acpi_match_table = ACPI_PTR(nau8825_acpi_match),
2660	},
2661	.probe = nau8825_i2c_probe,
2662	.remove = nau8825_i2c_remove,
2663	.id_table = nau8825_i2c_ids,
2664};
2665module_i2c_driver(nau8825_driver);
2666
2667MODULE_DESCRIPTION("ASoC nau8825 driver");
2668MODULE_AUTHOR("Anatol Pomozov <anatol@chromium.org>");
2669MODULE_LICENSE("GPL");