cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

nau8822.c (35939B)


      1// SPDX-License-Identifier: GPL-2.0
      2//
      3// nau8822.c  --  NAU8822 ALSA Soc Audio driver
      4//
      5// Copyright 2017 Nuvoton Technology Crop.
      6//
      7// Author: David Lin <ctlin0@nuvoton.com>
      8// Co-author: John Hsu <kchsu0@nuvoton.com>
      9// Co-author: Seven Li <wtli@nuvoton.com>
     10//
     11// Based on WM8974.c
     12
     13#include <linux/module.h>
     14#include <linux/moduleparam.h>
     15#include <linux/kernel.h>
     16#include <linux/init.h>
     17#include <linux/delay.h>
     18#include <linux/pm.h>
     19#include <linux/i2c.h>
     20#include <linux/regmap.h>
     21#include <linux/slab.h>
     22#include <sound/core.h>
     23#include <sound/pcm.h>
     24#include <sound/pcm_params.h>
     25#include <sound/soc.h>
     26#include <sound/initval.h>
     27#include <sound/tlv.h>
     28#include <asm/div64.h>
     29#include "nau8822.h"
     30
     31#define NAU_PLL_FREQ_MAX 100000000
     32#define NAU_PLL_FREQ_MIN 90000000
     33#define NAU_PLL_REF_MAX 33000000
     34#define NAU_PLL_REF_MIN 8000000
     35#define NAU_PLL_OPTOP_MIN 6
     36
     37static const int nau8822_mclk_scaler[] = { 10, 15, 20, 30, 40, 60, 80, 120 };
     38
     39static const struct reg_default nau8822_reg_defaults[] = {
     40	{ NAU8822_REG_POWER_MANAGEMENT_1, 0x0000 },
     41	{ NAU8822_REG_POWER_MANAGEMENT_2, 0x0000 },
     42	{ NAU8822_REG_POWER_MANAGEMENT_3, 0x0000 },
     43	{ NAU8822_REG_AUDIO_INTERFACE, 0x0050 },
     44	{ NAU8822_REG_COMPANDING_CONTROL, 0x0000 },
     45	{ NAU8822_REG_CLOCKING, 0x0140 },
     46	{ NAU8822_REG_ADDITIONAL_CONTROL, 0x0000 },
     47	{ NAU8822_REG_GPIO_CONTROL, 0x0000 },
     48	{ NAU8822_REG_JACK_DETECT_CONTROL_1, 0x0000 },
     49	{ NAU8822_REG_DAC_CONTROL, 0x0000 },
     50	{ NAU8822_REG_LEFT_DAC_DIGITAL_VOLUME, 0x00ff },
     51	{ NAU8822_REG_RIGHT_DAC_DIGITAL_VOLUME, 0x00ff },
     52	{ NAU8822_REG_JACK_DETECT_CONTROL_2, 0x0000 },
     53	{ NAU8822_REG_ADC_CONTROL, 0x0100 },
     54	{ NAU8822_REG_LEFT_ADC_DIGITAL_VOLUME, 0x00ff },
     55	{ NAU8822_REG_RIGHT_ADC_DIGITAL_VOLUME, 0x00ff },
     56	{ NAU8822_REG_EQ1, 0x012c },
     57	{ NAU8822_REG_EQ2, 0x002c },
     58	{ NAU8822_REG_EQ3, 0x002c },
     59	{ NAU8822_REG_EQ4, 0x002c },
     60	{ NAU8822_REG_EQ5, 0x002c },
     61	{ NAU8822_REG_DAC_LIMITER_1, 0x0032 },
     62	{ NAU8822_REG_DAC_LIMITER_2, 0x0000 },
     63	{ NAU8822_REG_NOTCH_FILTER_1, 0x0000 },
     64	{ NAU8822_REG_NOTCH_FILTER_2, 0x0000 },
     65	{ NAU8822_REG_NOTCH_FILTER_3, 0x0000 },
     66	{ NAU8822_REG_NOTCH_FILTER_4, 0x0000 },
     67	{ NAU8822_REG_ALC_CONTROL_1, 0x0038 },
     68	{ NAU8822_REG_ALC_CONTROL_2, 0x000b },
     69	{ NAU8822_REG_ALC_CONTROL_3, 0x0032 },
     70	{ NAU8822_REG_NOISE_GATE, 0x0010 },
     71	{ NAU8822_REG_PLL_N, 0x0008 },
     72	{ NAU8822_REG_PLL_K1, 0x000c },
     73	{ NAU8822_REG_PLL_K2, 0x0093 },
     74	{ NAU8822_REG_PLL_K3, 0x00e9 },
     75	{ NAU8822_REG_3D_CONTROL, 0x0000 },
     76	{ NAU8822_REG_RIGHT_SPEAKER_CONTROL, 0x0000 },
     77	{ NAU8822_REG_INPUT_CONTROL, 0x0033 },
     78	{ NAU8822_REG_LEFT_INP_PGA_CONTROL, 0x0010 },
     79	{ NAU8822_REG_RIGHT_INP_PGA_CONTROL, 0x0010 },
     80	{ NAU8822_REG_LEFT_ADC_BOOST_CONTROL, 0x0100 },
     81	{ NAU8822_REG_RIGHT_ADC_BOOST_CONTROL, 0x0100 },
     82	{ NAU8822_REG_OUTPUT_CONTROL, 0x0002 },
     83	{ NAU8822_REG_LEFT_MIXER_CONTROL, 0x0001 },
     84	{ NAU8822_REG_RIGHT_MIXER_CONTROL, 0x0001 },
     85	{ NAU8822_REG_LHP_VOLUME, 0x0039 },
     86	{ NAU8822_REG_RHP_VOLUME, 0x0039 },
     87	{ NAU8822_REG_LSPKOUT_VOLUME, 0x0039 },
     88	{ NAU8822_REG_RSPKOUT_VOLUME, 0x0039 },
     89	{ NAU8822_REG_AUX2_MIXER, 0x0001 },
     90	{ NAU8822_REG_AUX1_MIXER, 0x0001 },
     91	{ NAU8822_REG_POWER_MANAGEMENT_4, 0x0000 },
     92	{ NAU8822_REG_LEFT_TIME_SLOT, 0x0000 },
     93	{ NAU8822_REG_MISC, 0x0020 },
     94	{ NAU8822_REG_RIGHT_TIME_SLOT, 0x0000 },
     95	{ NAU8822_REG_DEVICE_REVISION, 0x007f },
     96	{ NAU8822_REG_DEVICE_ID, 0x001a },
     97	{ NAU8822_REG_DAC_DITHER, 0x0114 },
     98	{ NAU8822_REG_ALC_ENHANCE_1, 0x0000 },
     99	{ NAU8822_REG_ALC_ENHANCE_2, 0x0000 },
    100	{ NAU8822_REG_192KHZ_SAMPLING, 0x0008 },
    101	{ NAU8822_REG_MISC_CONTROL, 0x0000 },
    102	{ NAU8822_REG_INPUT_TIEOFF, 0x0000 },
    103	{ NAU8822_REG_POWER_REDUCTION, 0x0000 },
    104	{ NAU8822_REG_AGC_PEAK2PEAK, 0x0000 },
    105	{ NAU8822_REG_AGC_PEAK_DETECT, 0x0000 },
    106	{ NAU8822_REG_AUTOMUTE_CONTROL, 0x0000 },
    107	{ NAU8822_REG_OUTPUT_TIEOFF, 0x0000 },
    108};
    109
    110static bool nau8822_readable_reg(struct device *dev, unsigned int reg)
    111{
    112	switch (reg) {
    113	case NAU8822_REG_RESET ... NAU8822_REG_JACK_DETECT_CONTROL_1:
    114	case NAU8822_REG_DAC_CONTROL ... NAU8822_REG_LEFT_ADC_DIGITAL_VOLUME:
    115	case NAU8822_REG_RIGHT_ADC_DIGITAL_VOLUME:
    116	case NAU8822_REG_EQ1 ... NAU8822_REG_EQ5:
    117	case NAU8822_REG_DAC_LIMITER_1 ... NAU8822_REG_DAC_LIMITER_2:
    118	case NAU8822_REG_NOTCH_FILTER_1 ... NAU8822_REG_NOTCH_FILTER_4:
    119	case NAU8822_REG_ALC_CONTROL_1 ...NAU8822_REG_PLL_K3:
    120	case NAU8822_REG_3D_CONTROL:
    121	case NAU8822_REG_RIGHT_SPEAKER_CONTROL:
    122	case NAU8822_REG_INPUT_CONTROL ... NAU8822_REG_LEFT_ADC_BOOST_CONTROL:
    123	case NAU8822_REG_RIGHT_ADC_BOOST_CONTROL ... NAU8822_REG_AUX1_MIXER:
    124	case NAU8822_REG_POWER_MANAGEMENT_4 ... NAU8822_REG_DEVICE_ID:
    125	case NAU8822_REG_DAC_DITHER:
    126	case NAU8822_REG_ALC_ENHANCE_1 ... NAU8822_REG_MISC_CONTROL:
    127	case NAU8822_REG_INPUT_TIEOFF ... NAU8822_REG_OUTPUT_TIEOFF:
    128		return true;
    129	default:
    130		return false;
    131	}
    132}
    133
    134static bool nau8822_writeable_reg(struct device *dev, unsigned int reg)
    135{
    136	switch (reg) {
    137	case NAU8822_REG_RESET ... NAU8822_REG_JACK_DETECT_CONTROL_1:
    138	case NAU8822_REG_DAC_CONTROL ... NAU8822_REG_LEFT_ADC_DIGITAL_VOLUME:
    139	case NAU8822_REG_RIGHT_ADC_DIGITAL_VOLUME:
    140	case NAU8822_REG_EQ1 ... NAU8822_REG_EQ5:
    141	case NAU8822_REG_DAC_LIMITER_1 ... NAU8822_REG_DAC_LIMITER_2:
    142	case NAU8822_REG_NOTCH_FILTER_1 ... NAU8822_REG_NOTCH_FILTER_4:
    143	case NAU8822_REG_ALC_CONTROL_1 ...NAU8822_REG_PLL_K3:
    144	case NAU8822_REG_3D_CONTROL:
    145	case NAU8822_REG_RIGHT_SPEAKER_CONTROL:
    146	case NAU8822_REG_INPUT_CONTROL ... NAU8822_REG_LEFT_ADC_BOOST_CONTROL:
    147	case NAU8822_REG_RIGHT_ADC_BOOST_CONTROL ... NAU8822_REG_AUX1_MIXER:
    148	case NAU8822_REG_POWER_MANAGEMENT_4 ... NAU8822_REG_DEVICE_ID:
    149	case NAU8822_REG_DAC_DITHER:
    150	case NAU8822_REG_ALC_ENHANCE_1 ... NAU8822_REG_MISC_CONTROL:
    151	case NAU8822_REG_INPUT_TIEOFF ... NAU8822_REG_OUTPUT_TIEOFF:
    152		return true;
    153	default:
    154		return false;
    155	}
    156}
    157
    158static bool nau8822_volatile(struct device *dev, unsigned int reg)
    159{
    160	switch (reg) {
    161	case NAU8822_REG_RESET:
    162	case NAU8822_REG_DEVICE_REVISION:
    163	case NAU8822_REG_DEVICE_ID:
    164	case NAU8822_REG_AGC_PEAK2PEAK:
    165	case NAU8822_REG_AGC_PEAK_DETECT:
    166	case NAU8822_REG_AUTOMUTE_CONTROL:
    167		return true;
    168	default:
    169		return false;
    170	}
    171}
    172
    173/* The EQ parameters get function is to get the 5 band equalizer control.
    174 * The regmap raw read can't work here because regmap doesn't provide
    175 * value format for value width of 9 bits. Therefore, the driver reads data
    176 * from cache and makes value format according to the endianness of
    177 * bytes type control element.
    178 */
    179static int nau8822_eq_get(struct snd_kcontrol *kcontrol,
    180	struct snd_ctl_elem_value *ucontrol)
    181{
    182	struct snd_soc_component *component =
    183			snd_soc_kcontrol_component(kcontrol);
    184	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
    185	int i, reg;
    186	u16 reg_val, *val;
    187
    188	val = (u16 *)ucontrol->value.bytes.data;
    189	reg = NAU8822_REG_EQ1;
    190	for (i = 0; i < params->max / sizeof(u16); i++) {
    191		reg_val = snd_soc_component_read(component, reg + i);
    192		/* conversion of 16-bit integers between native CPU format
    193		 * and big endian format
    194		 */
    195		reg_val = cpu_to_be16(reg_val);
    196		memcpy(val + i, &reg_val, sizeof(reg_val));
    197	}
    198
    199	return 0;
    200}
    201
    202/* The EQ parameters put function is to make configuration of 5 band equalizer
    203 * control. These configuration includes central frequency, equalizer gain,
    204 * cut-off frequency, bandwidth control, and equalizer path.
    205 * The regmap raw write can't work here because regmap doesn't provide
    206 * register and value format for register with address 7 bits and value 9 bits.
    207 * Therefore, the driver makes value format according to the endianness of
    208 * bytes type control element and writes data to codec.
    209 */
    210static int nau8822_eq_put(struct snd_kcontrol *kcontrol,
    211	struct snd_ctl_elem_value *ucontrol)
    212{
    213	struct snd_soc_component *component =
    214			snd_soc_kcontrol_component(kcontrol);
    215	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
    216	void *data;
    217	u16 *val, value;
    218	int i, reg, ret;
    219
    220	data = kmemdup(ucontrol->value.bytes.data,
    221		params->max, GFP_KERNEL | GFP_DMA);
    222	if (!data)
    223		return -ENOMEM;
    224
    225	val = (u16 *)data;
    226	reg = NAU8822_REG_EQ1;
    227	for (i = 0; i < params->max / sizeof(u16); i++) {
    228		/* conversion of 16-bit integers between native CPU format
    229		 * and big endian format
    230		 */
    231		value = be16_to_cpu(*(val + i));
    232		ret = snd_soc_component_write(component, reg + i, value);
    233		if (ret) {
    234			dev_err(component->dev,
    235			    "EQ configuration fail, register: %x ret: %d\n",
    236			    reg + i, ret);
    237			kfree(data);
    238			return ret;
    239		}
    240	}
    241	kfree(data);
    242
    243	return 0;
    244}
    245
    246static const char * const nau8822_companding[] = {
    247	"Off", "NC", "u-law", "A-law"};
    248
    249static const struct soc_enum nau8822_companding_adc_enum =
    250	SOC_ENUM_SINGLE(NAU8822_REG_COMPANDING_CONTROL, NAU8822_ADCCM_SFT,
    251		ARRAY_SIZE(nau8822_companding), nau8822_companding);
    252
    253static const struct soc_enum nau8822_companding_dac_enum =
    254	SOC_ENUM_SINGLE(NAU8822_REG_COMPANDING_CONTROL, NAU8822_DACCM_SFT,
    255		ARRAY_SIZE(nau8822_companding), nau8822_companding);
    256
    257static const char * const nau8822_eqmode[] = {"Capture", "Playback"};
    258
    259static const struct soc_enum nau8822_eqmode_enum =
    260	SOC_ENUM_SINGLE(NAU8822_REG_EQ1, NAU8822_EQM_SFT,
    261		ARRAY_SIZE(nau8822_eqmode), nau8822_eqmode);
    262
    263static const char * const nau8822_alc1[] = {"Off", "Right", "Left", "Both"};
    264static const char * const nau8822_alc3[] = {"Normal", "Limiter"};
    265
    266static const struct soc_enum nau8822_alc_enable_enum =
    267	SOC_ENUM_SINGLE(NAU8822_REG_ALC_CONTROL_1, NAU8822_ALCEN_SFT,
    268		ARRAY_SIZE(nau8822_alc1), nau8822_alc1);
    269
    270static const struct soc_enum nau8822_alc_mode_enum =
    271	SOC_ENUM_SINGLE(NAU8822_REG_ALC_CONTROL_3, NAU8822_ALCM_SFT,
    272		ARRAY_SIZE(nau8822_alc3), nau8822_alc3);
    273
    274static const DECLARE_TLV_DB_SCALE(digital_tlv, -12750, 50, 1);
    275static const DECLARE_TLV_DB_SCALE(inpga_tlv, -1200, 75, 0);
    276static const DECLARE_TLV_DB_SCALE(spk_tlv, -5700, 100, 0);
    277static const DECLARE_TLV_DB_SCALE(pga_boost_tlv, 0, 2000, 0);
    278static const DECLARE_TLV_DB_SCALE(boost_tlv, -1500, 300, 1);
    279static const DECLARE_TLV_DB_SCALE(limiter_tlv, 0, 100, 0);
    280
    281static const struct snd_kcontrol_new nau8822_snd_controls[] = {
    282	SOC_ENUM("ADC Companding", nau8822_companding_adc_enum),
    283	SOC_ENUM("DAC Companding", nau8822_companding_dac_enum),
    284
    285	SOC_ENUM("EQ Function", nau8822_eqmode_enum),
    286	SND_SOC_BYTES_EXT("EQ Parameters", 10,
    287		  nau8822_eq_get, nau8822_eq_put),
    288
    289	SOC_DOUBLE("DAC Inversion Switch",
    290		NAU8822_REG_DAC_CONTROL, 0, 1, 1, 0),
    291	SOC_DOUBLE_R_TLV("PCM Volume",
    292		NAU8822_REG_LEFT_DAC_DIGITAL_VOLUME,
    293		NAU8822_REG_RIGHT_DAC_DIGITAL_VOLUME, 0, 255, 0, digital_tlv),
    294
    295	SOC_SINGLE("High Pass Filter Switch",
    296		NAU8822_REG_ADC_CONTROL, 8, 1, 0),
    297	SOC_SINGLE("High Pass Cut Off",
    298		NAU8822_REG_ADC_CONTROL, 4, 7, 0),
    299
    300	SOC_DOUBLE("ADC Inversion Switch",
    301		NAU8822_REG_ADC_CONTROL, 0, 1, 1, 0),
    302	SOC_DOUBLE_R_TLV("ADC Volume",
    303		NAU8822_REG_LEFT_ADC_DIGITAL_VOLUME,
    304		NAU8822_REG_RIGHT_ADC_DIGITAL_VOLUME, 0, 255, 0, digital_tlv),
    305
    306	SOC_SINGLE("DAC Limiter Switch",
    307		NAU8822_REG_DAC_LIMITER_1, 8, 1, 0),
    308	SOC_SINGLE("DAC Limiter Decay",
    309		NAU8822_REG_DAC_LIMITER_1, 4, 15, 0),
    310	SOC_SINGLE("DAC Limiter Attack",
    311		NAU8822_REG_DAC_LIMITER_1, 0, 15, 0),
    312	SOC_SINGLE("DAC Limiter Threshold",
    313		NAU8822_REG_DAC_LIMITER_2, 4, 7, 0),
    314	SOC_SINGLE_TLV("DAC Limiter Volume",
    315		NAU8822_REG_DAC_LIMITER_2, 0, 12, 0, limiter_tlv),
    316
    317	SOC_ENUM("ALC Mode", nau8822_alc_mode_enum),
    318	SOC_ENUM("ALC Enable Switch", nau8822_alc_enable_enum),
    319	SOC_SINGLE("ALC Min Gain",
    320		NAU8822_REG_ALC_CONTROL_1, 0, 7, 0),
    321	SOC_SINGLE("ALC Max Gain",
    322		NAU8822_REG_ALC_CONTROL_1, 3, 7, 0),
    323	SOC_SINGLE("ALC Hold",
    324		NAU8822_REG_ALC_CONTROL_2, 4, 10, 0),
    325	SOC_SINGLE("ALC Target",
    326		NAU8822_REG_ALC_CONTROL_2, 0, 15, 0),
    327	SOC_SINGLE("ALC Decay",
    328		NAU8822_REG_ALC_CONTROL_3, 4, 10, 0),
    329	SOC_SINGLE("ALC Attack",
    330		NAU8822_REG_ALC_CONTROL_3, 0, 10, 0),
    331	SOC_SINGLE("ALC Noise Gate Switch",
    332		NAU8822_REG_NOISE_GATE, 3, 1, 0),
    333	SOC_SINGLE("ALC Noise Gate Threshold",
    334		NAU8822_REG_NOISE_GATE, 0, 7, 0),
    335
    336	SOC_DOUBLE_R("PGA ZC Switch",
    337		NAU8822_REG_LEFT_INP_PGA_CONTROL,
    338		NAU8822_REG_RIGHT_INP_PGA_CONTROL,
    339		7, 1, 0),
    340	SOC_DOUBLE_R_TLV("PGA Volume",
    341		NAU8822_REG_LEFT_INP_PGA_CONTROL,
    342		NAU8822_REG_RIGHT_INP_PGA_CONTROL, 0, 63, 0, inpga_tlv),
    343
    344	SOC_DOUBLE_R("Headphone ZC Switch",
    345		NAU8822_REG_LHP_VOLUME,
    346		NAU8822_REG_RHP_VOLUME, 7, 1, 0),
    347	SOC_DOUBLE_R("Headphone Playback Switch",
    348		NAU8822_REG_LHP_VOLUME,
    349		NAU8822_REG_RHP_VOLUME, 6, 1, 1),
    350	SOC_DOUBLE_R_TLV("Headphone Volume",
    351		NAU8822_REG_LHP_VOLUME,
    352		NAU8822_REG_RHP_VOLUME,	0, 63, 0, spk_tlv),
    353
    354	SOC_DOUBLE_R("Speaker ZC Switch",
    355		NAU8822_REG_LSPKOUT_VOLUME,
    356		NAU8822_REG_RSPKOUT_VOLUME, 7, 1, 0),
    357	SOC_DOUBLE_R("Speaker Playback Switch",
    358		NAU8822_REG_LSPKOUT_VOLUME,
    359		NAU8822_REG_RSPKOUT_VOLUME, 6, 1, 1),
    360	SOC_DOUBLE_R_TLV("Speaker Volume",
    361		NAU8822_REG_LSPKOUT_VOLUME,
    362		NAU8822_REG_RSPKOUT_VOLUME, 0, 63, 0, spk_tlv),
    363
    364	SOC_DOUBLE_R("AUXOUT Playback Switch",
    365		NAU8822_REG_AUX2_MIXER,
    366		NAU8822_REG_AUX1_MIXER, 6, 1, 1),
    367
    368	SOC_DOUBLE_R_TLV("PGA Boost Volume",
    369		NAU8822_REG_LEFT_ADC_BOOST_CONTROL,
    370		NAU8822_REG_RIGHT_ADC_BOOST_CONTROL, 8, 1, 0, pga_boost_tlv),
    371	SOC_DOUBLE_R_TLV("L2/R2 Boost Volume",
    372		NAU8822_REG_LEFT_ADC_BOOST_CONTROL,
    373		NAU8822_REG_RIGHT_ADC_BOOST_CONTROL, 4, 7, 0, boost_tlv),
    374	SOC_DOUBLE_R_TLV("Aux Boost Volume",
    375		NAU8822_REG_LEFT_ADC_BOOST_CONTROL,
    376		NAU8822_REG_RIGHT_ADC_BOOST_CONTROL, 0, 7, 0, boost_tlv),
    377
    378	SOC_SINGLE("DAC 128x Oversampling Switch",
    379		NAU8822_REG_DAC_CONTROL, 5, 1, 0),
    380	SOC_SINGLE("ADC 128x Oversampling Switch",
    381		NAU8822_REG_ADC_CONTROL, 5, 1, 0),
    382};
    383
    384/* LMAIN and RMAIN Mixer */
    385static const struct snd_kcontrol_new nau8822_left_out_mixer[] = {
    386	SOC_DAPM_SINGLE("LINMIX Switch",
    387		NAU8822_REG_LEFT_MIXER_CONTROL, 1, 1, 0),
    388	SOC_DAPM_SINGLE("LAUX Switch",
    389		NAU8822_REG_LEFT_MIXER_CONTROL, 5, 1, 0),
    390	SOC_DAPM_SINGLE("LDAC Switch",
    391		NAU8822_REG_LEFT_MIXER_CONTROL, 0, 1, 0),
    392	SOC_DAPM_SINGLE("RDAC Switch",
    393		NAU8822_REG_OUTPUT_CONTROL, 5, 1, 0),
    394};
    395
    396static const struct snd_kcontrol_new nau8822_right_out_mixer[] = {
    397	SOC_DAPM_SINGLE("RINMIX Switch",
    398		NAU8822_REG_RIGHT_MIXER_CONTROL, 1, 1, 0),
    399	SOC_DAPM_SINGLE("RAUX Switch",
    400		NAU8822_REG_RIGHT_MIXER_CONTROL, 5, 1, 0),
    401	SOC_DAPM_SINGLE("RDAC Switch",
    402		NAU8822_REG_RIGHT_MIXER_CONTROL, 0, 1, 0),
    403	SOC_DAPM_SINGLE("LDAC Switch",
    404		NAU8822_REG_OUTPUT_CONTROL, 6, 1, 0),
    405};
    406
    407/* AUX1 and AUX2 Mixer */
    408static const struct snd_kcontrol_new nau8822_auxout1_mixer[] = {
    409	SOC_DAPM_SINGLE("RDAC Switch", NAU8822_REG_AUX1_MIXER, 0, 1, 0),
    410	SOC_DAPM_SINGLE("RMIX Switch", NAU8822_REG_AUX1_MIXER, 1, 1, 0),
    411	SOC_DAPM_SINGLE("RINMIX Switch", NAU8822_REG_AUX1_MIXER, 2, 1, 0),
    412	SOC_DAPM_SINGLE("LDAC Switch", NAU8822_REG_AUX1_MIXER, 3, 1, 0),
    413	SOC_DAPM_SINGLE("LMIX Switch", NAU8822_REG_AUX1_MIXER, 4, 1, 0),
    414};
    415
    416static const struct snd_kcontrol_new nau8822_auxout2_mixer[] = {
    417	SOC_DAPM_SINGLE("LDAC Switch", NAU8822_REG_AUX2_MIXER, 0, 1, 0),
    418	SOC_DAPM_SINGLE("LMIX Switch", NAU8822_REG_AUX2_MIXER, 1, 1, 0),
    419	SOC_DAPM_SINGLE("LINMIX Switch", NAU8822_REG_AUX2_MIXER, 2, 1, 0),
    420	SOC_DAPM_SINGLE("AUX1MIX Output Switch",
    421		NAU8822_REG_AUX2_MIXER, 3, 1, 0),
    422};
    423
    424/* Input PGA */
    425static const struct snd_kcontrol_new nau8822_left_input_mixer[] = {
    426	SOC_DAPM_SINGLE("L2 Switch", NAU8822_REG_INPUT_CONTROL, 2, 1, 0),
    427	SOC_DAPM_SINGLE("MicN Switch", NAU8822_REG_INPUT_CONTROL, 1, 1, 0),
    428	SOC_DAPM_SINGLE("MicP Switch", NAU8822_REG_INPUT_CONTROL, 0, 1, 0),
    429};
    430static const struct snd_kcontrol_new nau8822_right_input_mixer[] = {
    431	SOC_DAPM_SINGLE("R2 Switch", NAU8822_REG_INPUT_CONTROL, 6, 1, 0),
    432	SOC_DAPM_SINGLE("MicN Switch", NAU8822_REG_INPUT_CONTROL, 5, 1, 0),
    433	SOC_DAPM_SINGLE("MicP Switch", NAU8822_REG_INPUT_CONTROL, 4, 1, 0),
    434};
    435
    436/* Loopback Switch */
    437static const struct snd_kcontrol_new nau8822_loopback =
    438	SOC_DAPM_SINGLE("Switch", NAU8822_REG_COMPANDING_CONTROL,
    439		NAU8822_ADDAP_SFT, 1, 0);
    440
    441static int check_mclk_select_pll(struct snd_soc_dapm_widget *source,
    442			 struct snd_soc_dapm_widget *sink)
    443{
    444	struct snd_soc_component *component =
    445		snd_soc_dapm_to_component(source->dapm);
    446	unsigned int value;
    447
    448	value = snd_soc_component_read(component, NAU8822_REG_CLOCKING);
    449
    450	return (value & NAU8822_CLKM_MASK);
    451}
    452
    453static const struct snd_soc_dapm_widget nau8822_dapm_widgets[] = {
    454	SND_SOC_DAPM_DAC("Left DAC", "Left HiFi Playback",
    455		NAU8822_REG_POWER_MANAGEMENT_3, 0, 0),
    456	SND_SOC_DAPM_DAC("Right DAC", "Right HiFi Playback",
    457		NAU8822_REG_POWER_MANAGEMENT_3, 1, 0),
    458	SND_SOC_DAPM_ADC("Left ADC", "Left HiFi Capture",
    459		NAU8822_REG_POWER_MANAGEMENT_2, 0, 0),
    460	SND_SOC_DAPM_ADC("Right ADC", "Right HiFi Capture",
    461		NAU8822_REG_POWER_MANAGEMENT_2, 1, 0),
    462
    463	SOC_MIXER_ARRAY("Left Output Mixer",
    464		NAU8822_REG_POWER_MANAGEMENT_3, 2, 0, nau8822_left_out_mixer),
    465	SOC_MIXER_ARRAY("Right Output Mixer",
    466		NAU8822_REG_POWER_MANAGEMENT_3,	3, 0, nau8822_right_out_mixer),
    467	SOC_MIXER_ARRAY("AUX1 Output Mixer",
    468		NAU8822_REG_POWER_MANAGEMENT_1, 7, 0, nau8822_auxout1_mixer),
    469	SOC_MIXER_ARRAY("AUX2 Output Mixer",
    470		NAU8822_REG_POWER_MANAGEMENT_1,	6, 0, nau8822_auxout2_mixer),
    471
    472	SOC_MIXER_ARRAY("Left Input Mixer",
    473		NAU8822_REG_POWER_MANAGEMENT_2,
    474		2, 0, nau8822_left_input_mixer),
    475	SOC_MIXER_ARRAY("Right Input Mixer",
    476		NAU8822_REG_POWER_MANAGEMENT_2,
    477		3, 0, nau8822_right_input_mixer),
    478
    479	SND_SOC_DAPM_PGA("Left Boost Mixer",
    480		NAU8822_REG_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
    481	SND_SOC_DAPM_PGA("Right Boost Mixer",
    482		NAU8822_REG_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
    483
    484	SND_SOC_DAPM_PGA("Left Capture PGA",
    485		NAU8822_REG_LEFT_INP_PGA_CONTROL, 6, 1, NULL, 0),
    486	SND_SOC_DAPM_PGA("Right Capture PGA",
    487		NAU8822_REG_RIGHT_INP_PGA_CONTROL, 6, 1, NULL, 0),
    488
    489	SND_SOC_DAPM_PGA("Left Headphone Out",
    490		NAU8822_REG_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
    491	SND_SOC_DAPM_PGA("Right Headphone Out",
    492		NAU8822_REG_POWER_MANAGEMENT_2, 8, 0, NULL, 0),
    493
    494	SND_SOC_DAPM_PGA("Left Speaker Out",
    495		 NAU8822_REG_POWER_MANAGEMENT_3, 6, 0, NULL, 0),
    496	SND_SOC_DAPM_PGA("Right Speaker Out",
    497		NAU8822_REG_POWER_MANAGEMENT_3,	5, 0, NULL, 0),
    498
    499	SND_SOC_DAPM_PGA("AUX1 Out",
    500		NAU8822_REG_POWER_MANAGEMENT_3,	8, 0, NULL, 0),
    501	SND_SOC_DAPM_PGA("AUX2 Out",
    502		NAU8822_REG_POWER_MANAGEMENT_3,	7, 0, NULL, 0),
    503
    504	SND_SOC_DAPM_SUPPLY("Mic Bias",
    505		NAU8822_REG_POWER_MANAGEMENT_1,	4, 0, NULL, 0),
    506	SND_SOC_DAPM_SUPPLY("PLL",
    507		NAU8822_REG_POWER_MANAGEMENT_1,	5, 0, NULL, 0),
    508
    509	SND_SOC_DAPM_SWITCH("Digital Loopback", SND_SOC_NOPM, 0, 0,
    510		&nau8822_loopback),
    511
    512	SND_SOC_DAPM_INPUT("LMICN"),
    513	SND_SOC_DAPM_INPUT("LMICP"),
    514	SND_SOC_DAPM_INPUT("RMICN"),
    515	SND_SOC_DAPM_INPUT("RMICP"),
    516	SND_SOC_DAPM_INPUT("LAUX"),
    517	SND_SOC_DAPM_INPUT("RAUX"),
    518	SND_SOC_DAPM_INPUT("L2"),
    519	SND_SOC_DAPM_INPUT("R2"),
    520	SND_SOC_DAPM_OUTPUT("LHP"),
    521	SND_SOC_DAPM_OUTPUT("RHP"),
    522	SND_SOC_DAPM_OUTPUT("LSPK"),
    523	SND_SOC_DAPM_OUTPUT("RSPK"),
    524	SND_SOC_DAPM_OUTPUT("AUXOUT1"),
    525	SND_SOC_DAPM_OUTPUT("AUXOUT2"),
    526};
    527
    528static const struct snd_soc_dapm_route nau8822_dapm_routes[] = {
    529	{"Right DAC", NULL, "PLL", check_mclk_select_pll},
    530	{"Left DAC", NULL, "PLL", check_mclk_select_pll},
    531
    532	/* LMAIN and RMAIN Mixer */
    533	{"Right Output Mixer", "LDAC Switch", "Left DAC"},
    534	{"Right Output Mixer", "RDAC Switch", "Right DAC"},
    535	{"Right Output Mixer", "RAUX Switch", "RAUX"},
    536	{"Right Output Mixer", "RINMIX Switch", "Right Boost Mixer"},
    537
    538	{"Left Output Mixer", "LDAC Switch", "Left DAC"},
    539	{"Left Output Mixer", "RDAC Switch", "Right DAC"},
    540	{"Left Output Mixer", "LAUX Switch", "LAUX"},
    541	{"Left Output Mixer", "LINMIX Switch", "Left Boost Mixer"},
    542
    543	/* AUX1 and AUX2 Mixer */
    544	{"AUX1 Output Mixer", "RDAC Switch", "Right DAC"},
    545	{"AUX1 Output Mixer", "RMIX Switch", "Right Output Mixer"},
    546	{"AUX1 Output Mixer", "RINMIX Switch", "Right Boost Mixer"},
    547	{"AUX1 Output Mixer", "LDAC Switch", "Left DAC"},
    548	{"AUX1 Output Mixer", "LMIX Switch", "Left Output Mixer"},
    549
    550	{"AUX2 Output Mixer", "LDAC Switch", "Left DAC"},
    551	{"AUX2 Output Mixer", "LMIX Switch", "Left Output Mixer"},
    552	{"AUX2 Output Mixer", "LINMIX Switch", "Left Boost Mixer"},
    553	{"AUX2 Output Mixer", "AUX1MIX Output Switch", "AUX1 Output Mixer"},
    554
    555	/* Outputs */
    556	{"Right Headphone Out", NULL, "Right Output Mixer"},
    557	{"RHP", NULL, "Right Headphone Out"},
    558
    559	{"Left Headphone Out", NULL, "Left Output Mixer"},
    560	{"LHP", NULL, "Left Headphone Out"},
    561
    562	{"Right Speaker Out", NULL, "Right Output Mixer"},
    563	{"RSPK", NULL, "Right Speaker Out"},
    564
    565	{"Left Speaker Out", NULL, "Left Output Mixer"},
    566	{"LSPK", NULL, "Left Speaker Out"},
    567
    568	{"AUX1 Out", NULL, "AUX1 Output Mixer"},
    569	{"AUX2 Out", NULL, "AUX2 Output Mixer"},
    570	{"AUXOUT1", NULL, "AUX1 Out"},
    571	{"AUXOUT2", NULL, "AUX2 Out"},
    572
    573	/* Boost Mixer */
    574	{"Right ADC", NULL, "PLL", check_mclk_select_pll},
    575	{"Left ADC", NULL, "PLL", check_mclk_select_pll},
    576
    577	{"Right ADC", NULL, "Right Boost Mixer"},
    578
    579	{"Right Boost Mixer", NULL, "RAUX"},
    580	{"Right Boost Mixer", NULL, "Right Capture PGA"},
    581	{"Right Boost Mixer", NULL, "R2"},
    582
    583	{"Left ADC", NULL, "Left Boost Mixer"},
    584
    585	{"Left Boost Mixer", NULL, "LAUX"},
    586	{"Left Boost Mixer", NULL, "Left Capture PGA"},
    587	{"Left Boost Mixer", NULL, "L2"},
    588
    589	/* Input PGA */
    590	{"Right Capture PGA", NULL, "Right Input Mixer"},
    591	{"Left Capture PGA", NULL, "Left Input Mixer"},
    592
    593	/* Enable Microphone Power */
    594	{"Right Capture PGA", NULL, "Mic Bias"},
    595	{"Left Capture PGA", NULL, "Mic Bias"},
    596
    597	{"Right Input Mixer", "R2 Switch", "R2"},
    598	{"Right Input Mixer", "MicN Switch", "RMICN"},
    599	{"Right Input Mixer", "MicP Switch", "RMICP"},
    600
    601	{"Left Input Mixer", "L2 Switch", "L2"},
    602	{"Left Input Mixer", "MicN Switch", "LMICN"},
    603	{"Left Input Mixer", "MicP Switch", "LMICP"},
    604
    605	/* Digital Loopback */
    606	{"Digital Loopback", "Switch", "Left ADC"},
    607	{"Digital Loopback", "Switch", "Right ADC"},
    608	{"Left DAC", NULL, "Digital Loopback"},
    609	{"Right DAC", NULL, "Digital Loopback"},
    610};
    611
    612static int nau8822_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id,
    613				 unsigned int freq, int dir)
    614{
    615	struct snd_soc_component *component = dai->component;
    616	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
    617
    618	nau8822->div_id = clk_id;
    619	nau8822->sysclk = freq;
    620	dev_dbg(component->dev, "master sysclk %dHz, source %s\n", freq,
    621		clk_id == NAU8822_CLK_PLL ? "PLL" : "MCLK");
    622
    623	return 0;
    624}
    625
    626static int nau8822_calc_pll(unsigned int pll_in, unsigned int fs,
    627				struct nau8822_pll *pll_param)
    628{
    629	u64 f2, f2_max, pll_ratio;
    630	int i, scal_sel;
    631
    632	if (pll_in > NAU_PLL_REF_MAX || pll_in < NAU_PLL_REF_MIN)
    633		return -EINVAL;
    634	f2_max = 0;
    635	scal_sel = ARRAY_SIZE(nau8822_mclk_scaler);
    636
    637	for (i = 0; i < scal_sel; i++) {
    638		f2 = 256 * fs * 4 * nau8822_mclk_scaler[i] / 10;
    639		if (f2 > NAU_PLL_FREQ_MIN && f2 < NAU_PLL_FREQ_MAX &&
    640			f2_max < f2) {
    641			f2_max = f2;
    642			scal_sel = i;
    643		}
    644	}
    645
    646	if (ARRAY_SIZE(nau8822_mclk_scaler) == scal_sel)
    647		return -EINVAL;
    648	pll_param->mclk_scaler = scal_sel;
    649	f2 = f2_max;
    650
    651	/* Calculate the PLL 4-bit integer input and the PLL 24-bit fractional
    652	 * input; round up the 24+4bit.
    653	 */
    654	pll_ratio = div_u64(f2 << 28, pll_in);
    655	pll_param->pre_factor = 0;
    656	if (((pll_ratio >> 28) & 0xF) < NAU_PLL_OPTOP_MIN) {
    657		pll_ratio <<= 1;
    658		pll_param->pre_factor = 1;
    659	}
    660	pll_param->pll_int = (pll_ratio >> 28) & 0xF;
    661	pll_param->pll_frac = ((pll_ratio & 0xFFFFFFF) >> 4);
    662
    663	return 0;
    664}
    665
    666static int nau8822_config_clkdiv(struct snd_soc_dai *dai, int div, int rate)
    667{
    668	struct snd_soc_component *component = dai->component;
    669	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
    670	struct nau8822_pll *pll = &nau8822->pll;
    671	int i, sclk, imclk;
    672
    673	switch (nau8822->div_id) {
    674	case NAU8822_CLK_MCLK:
    675		/* Configure the master clock prescaler div to make system
    676		 * clock to approximate the internal master clock (IMCLK);
    677		 * and large or equal to IMCLK.
    678		 */
    679		div = 0;
    680		imclk = rate * 256;
    681		for (i = 1; i < ARRAY_SIZE(nau8822_mclk_scaler); i++) {
    682			sclk = (nau8822->sysclk * 10) /	nau8822_mclk_scaler[i];
    683			if (sclk < imclk)
    684				break;
    685			div = i;
    686		}
    687		dev_dbg(component->dev, "master clock prescaler %x for fs %d\n",
    688			div, rate);
    689
    690		/* master clock from MCLK and disable PLL */
    691		snd_soc_component_update_bits(component,
    692			NAU8822_REG_CLOCKING, NAU8822_MCLKSEL_MASK,
    693			(div << NAU8822_MCLKSEL_SFT));
    694		snd_soc_component_update_bits(component,
    695			NAU8822_REG_CLOCKING, NAU8822_CLKM_MASK,
    696			NAU8822_CLKM_MCLK);
    697		break;
    698
    699	case NAU8822_CLK_PLL:
    700		/* master clock from PLL and enable PLL */
    701		if (pll->mclk_scaler != div) {
    702			dev_err(component->dev,
    703			"master clock prescaler not meet PLL parameters\n");
    704			return -EINVAL;
    705		}
    706		snd_soc_component_update_bits(component,
    707			NAU8822_REG_CLOCKING, NAU8822_MCLKSEL_MASK,
    708			(div << NAU8822_MCLKSEL_SFT));
    709		snd_soc_component_update_bits(component,
    710			NAU8822_REG_CLOCKING, NAU8822_CLKM_MASK,
    711			NAU8822_CLKM_PLL);
    712		break;
    713
    714	default:
    715		return -EINVAL;
    716	}
    717
    718	return 0;
    719}
    720
    721static int nau8822_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
    722				unsigned int freq_in, unsigned int freq_out)
    723{
    724	struct snd_soc_component *component = dai->component;
    725	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
    726	struct nau8822_pll *pll_param = &nau8822->pll;
    727	int ret, fs;
    728
    729	fs = freq_out / 256;
    730
    731	ret = nau8822_calc_pll(freq_in, fs, pll_param);
    732	if (ret < 0) {
    733		dev_err(component->dev, "Unsupported input clock %d\n",
    734			freq_in);
    735		return ret;
    736	}
    737
    738	dev_info(component->dev,
    739		"pll_int=%x pll_frac=%x mclk_scaler=%x pre_factor=%x\n",
    740		pll_param->pll_int, pll_param->pll_frac,
    741		pll_param->mclk_scaler, pll_param->pre_factor);
    742
    743	snd_soc_component_update_bits(component,
    744		NAU8822_REG_POWER_MANAGEMENT_1, NAU8822_PLL_EN_MASK, NAU8822_PLL_OFF);
    745	snd_soc_component_update_bits(component,
    746		NAU8822_REG_PLL_N, NAU8822_PLLMCLK_DIV2 | NAU8822_PLLN_MASK,
    747		(pll_param->pre_factor ? NAU8822_PLLMCLK_DIV2 : 0) |
    748		pll_param->pll_int);
    749	snd_soc_component_write(component,
    750		NAU8822_REG_PLL_K1, (pll_param->pll_frac >> NAU8822_PLLK1_SFT) &
    751		NAU8822_PLLK1_MASK);
    752	snd_soc_component_write(component,
    753		NAU8822_REG_PLL_K2, (pll_param->pll_frac >> NAU8822_PLLK2_SFT) &
    754		NAU8822_PLLK2_MASK);
    755	snd_soc_component_write(component,
    756		NAU8822_REG_PLL_K3, pll_param->pll_frac & NAU8822_PLLK3_MASK);
    757	snd_soc_component_update_bits(component,
    758		NAU8822_REG_CLOCKING, NAU8822_MCLKSEL_MASK,
    759		pll_param->mclk_scaler << NAU8822_MCLKSEL_SFT);
    760	snd_soc_component_update_bits(component,
    761		NAU8822_REG_CLOCKING, NAU8822_CLKM_MASK, NAU8822_CLKM_PLL);
    762	snd_soc_component_update_bits(component,
    763		NAU8822_REG_POWER_MANAGEMENT_1, NAU8822_PLL_EN_MASK, NAU8822_PLL_ON);
    764
    765	return 0;
    766}
    767
    768static int nau8822_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
    769{
    770	struct snd_soc_component *component = dai->component;
    771	u16 ctrl1_val = 0, ctrl2_val = 0;
    772
    773	dev_dbg(component->dev, "%s\n", __func__);
    774
    775	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
    776	case SND_SOC_DAIFMT_CBM_CFM:
    777		ctrl2_val |= 1;
    778		break;
    779	case SND_SOC_DAIFMT_CBS_CFS:
    780		ctrl2_val &= ~1;
    781		break;
    782	default:
    783		return -EINVAL;
    784	}
    785
    786	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
    787	case SND_SOC_DAIFMT_I2S:
    788		ctrl1_val |= 0x10;
    789		break;
    790	case SND_SOC_DAIFMT_RIGHT_J:
    791		break;
    792	case SND_SOC_DAIFMT_LEFT_J:
    793		ctrl1_val |= 0x8;
    794		break;
    795	case SND_SOC_DAIFMT_DSP_A:
    796		ctrl1_val |= 0x18;
    797		break;
    798	default:
    799		return -EINVAL;
    800	}
    801
    802	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
    803	case SND_SOC_DAIFMT_NB_NF:
    804		break;
    805	case SND_SOC_DAIFMT_IB_IF:
    806		ctrl1_val |= 0x180;
    807		break;
    808	case SND_SOC_DAIFMT_IB_NF:
    809		ctrl1_val |= 0x100;
    810		break;
    811	case SND_SOC_DAIFMT_NB_IF:
    812		ctrl1_val |= 0x80;
    813		break;
    814	default:
    815		return -EINVAL;
    816	}
    817
    818	snd_soc_component_update_bits(component,
    819		NAU8822_REG_AUDIO_INTERFACE,
    820		NAU8822_AIFMT_MASK | NAU8822_LRP_MASK | NAU8822_BCLKP_MASK,
    821		ctrl1_val);
    822	snd_soc_component_update_bits(component,
    823		NAU8822_REG_CLOCKING, NAU8822_CLKIOEN_MASK, ctrl2_val);
    824
    825	return 0;
    826}
    827
    828static int nau8822_hw_params(struct snd_pcm_substream *substream,
    829			    struct snd_pcm_hw_params *params,
    830			    struct snd_soc_dai *dai)
    831{
    832	struct snd_soc_component *component = dai->component;
    833	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
    834	int val_len = 0, val_rate = 0;
    835	unsigned int ctrl_val, bclk_fs, bclk_div;
    836
    837	/* make BCLK and LRC divide configuration if the codec as master. */
    838	ctrl_val = snd_soc_component_read(component, NAU8822_REG_CLOCKING);
    839	if (ctrl_val & NAU8822_CLK_MASTER) {
    840		/* get the bclk and fs ratio */
    841		bclk_fs = snd_soc_params_to_bclk(params) / params_rate(params);
    842		if (bclk_fs <= 32)
    843			bclk_div = NAU8822_BCLKDIV_8;
    844		else if (bclk_fs <= 64)
    845			bclk_div = NAU8822_BCLKDIV_4;
    846		else if (bclk_fs <= 128)
    847			bclk_div = NAU8822_BCLKDIV_2;
    848		else
    849			return -EINVAL;
    850		snd_soc_component_update_bits(component, NAU8822_REG_CLOCKING,
    851				NAU8822_BCLKSEL_MASK, bclk_div);
    852	}
    853
    854	switch (params_format(params)) {
    855	case SNDRV_PCM_FORMAT_S16_LE:
    856		break;
    857	case SNDRV_PCM_FORMAT_S20_3LE:
    858		val_len |= NAU8822_WLEN_20;
    859		break;
    860	case SNDRV_PCM_FORMAT_S24_LE:
    861		val_len |= NAU8822_WLEN_24;
    862		break;
    863	case SNDRV_PCM_FORMAT_S32_LE:
    864		val_len |= NAU8822_WLEN_32;
    865		break;
    866	default:
    867		return -EINVAL;
    868	}
    869
    870	switch (params_rate(params)) {
    871	case 8000:
    872		val_rate |= NAU8822_SMPLR_8K;
    873		break;
    874	case 11025:
    875		val_rate |= NAU8822_SMPLR_12K;
    876		break;
    877	case 16000:
    878		val_rate |= NAU8822_SMPLR_16K;
    879		break;
    880	case 22050:
    881		val_rate |= NAU8822_SMPLR_24K;
    882		break;
    883	case 32000:
    884		val_rate |= NAU8822_SMPLR_32K;
    885		break;
    886	case 44100:
    887	case 48000:
    888		break;
    889	default:
    890		return -EINVAL;
    891	}
    892
    893	snd_soc_component_update_bits(component,
    894		NAU8822_REG_AUDIO_INTERFACE, NAU8822_WLEN_MASK, val_len);
    895	snd_soc_component_update_bits(component,
    896		NAU8822_REG_ADDITIONAL_CONTROL, NAU8822_SMPLR_MASK, val_rate);
    897
    898	/* If the master clock is from MCLK, provide the runtime FS for driver
    899	 * to get the master clock prescaler configuration.
    900	 */
    901	if (nau8822->div_id == NAU8822_CLK_MCLK)
    902		nau8822_config_clkdiv(dai, 0, params_rate(params));
    903
    904	return 0;
    905}
    906
    907static int nau8822_mute(struct snd_soc_dai *dai, int mute, int direction)
    908{
    909	struct snd_soc_component *component = dai->component;
    910
    911	dev_dbg(component->dev, "%s: %d\n", __func__, mute);
    912
    913	if (mute)
    914		snd_soc_component_update_bits(component,
    915			NAU8822_REG_DAC_CONTROL, 0x40, 0x40);
    916	else
    917		snd_soc_component_update_bits(component,
    918			NAU8822_REG_DAC_CONTROL, 0x40, 0);
    919
    920	return 0;
    921}
    922
    923static int nau8822_set_bias_level(struct snd_soc_component *component,
    924				 enum snd_soc_bias_level level)
    925{
    926	switch (level) {
    927	case SND_SOC_BIAS_ON:
    928	case SND_SOC_BIAS_PREPARE:
    929		snd_soc_component_update_bits(component,
    930			NAU8822_REG_POWER_MANAGEMENT_1,
    931			NAU8822_REFIMP_MASK, NAU8822_REFIMP_80K);
    932		break;
    933
    934	case SND_SOC_BIAS_STANDBY:
    935		snd_soc_component_update_bits(component,
    936			NAU8822_REG_POWER_MANAGEMENT_1,
    937			NAU8822_IOBUF_EN | NAU8822_ABIAS_EN,
    938			NAU8822_IOBUF_EN | NAU8822_ABIAS_EN);
    939
    940		if (snd_soc_component_get_bias_level(component) ==
    941			SND_SOC_BIAS_OFF) {
    942			snd_soc_component_update_bits(component,
    943				NAU8822_REG_POWER_MANAGEMENT_1,
    944				NAU8822_REFIMP_MASK, NAU8822_REFIMP_3K);
    945			mdelay(100);
    946		}
    947		snd_soc_component_update_bits(component,
    948			NAU8822_REG_POWER_MANAGEMENT_1,
    949			NAU8822_REFIMP_MASK, NAU8822_REFIMP_300K);
    950		break;
    951
    952	case SND_SOC_BIAS_OFF:
    953		snd_soc_component_write(component,
    954			NAU8822_REG_POWER_MANAGEMENT_1, 0);
    955		snd_soc_component_write(component,
    956			NAU8822_REG_POWER_MANAGEMENT_2, 0);
    957		snd_soc_component_write(component,
    958			NAU8822_REG_POWER_MANAGEMENT_3, 0);
    959		break;
    960	}
    961
    962	dev_dbg(component->dev, "%s: %d\n", __func__, level);
    963
    964	return 0;
    965}
    966
    967#define NAU8822_RATES (SNDRV_PCM_RATE_8000_48000)
    968
    969#define NAU8822_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
    970	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
    971
    972static const struct snd_soc_dai_ops nau8822_dai_ops = {
    973	.hw_params	= nau8822_hw_params,
    974	.mute_stream	= nau8822_mute,
    975	.set_fmt	= nau8822_set_dai_fmt,
    976	.set_sysclk	= nau8822_set_dai_sysclk,
    977	.set_pll	= nau8822_set_pll,
    978	.no_capture_mute = 1,
    979};
    980
    981static struct snd_soc_dai_driver nau8822_dai = {
    982	.name = "nau8822-hifi",
    983	.playback = {
    984		.stream_name = "Playback",
    985		.channels_min = 1,
    986		.channels_max = 2,
    987		.rates = NAU8822_RATES,
    988		.formats = NAU8822_FORMATS,
    989	},
    990	.capture = {
    991		.stream_name = "Capture",
    992		.channels_min = 1,
    993		.channels_max = 2,
    994		.rates = NAU8822_RATES,
    995		.formats = NAU8822_FORMATS,
    996	},
    997	.ops = &nau8822_dai_ops,
    998	.symmetric_rate = 1,
    999};
   1000
   1001static int nau8822_suspend(struct snd_soc_component *component)
   1002{
   1003	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
   1004
   1005	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
   1006
   1007	regcache_mark_dirty(nau8822->regmap);
   1008
   1009	return 0;
   1010}
   1011
   1012static int nau8822_resume(struct snd_soc_component *component)
   1013{
   1014	struct nau8822 *nau8822 = snd_soc_component_get_drvdata(component);
   1015
   1016	regcache_sync(nau8822->regmap);
   1017
   1018	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_STANDBY);
   1019
   1020	return 0;
   1021}
   1022
   1023/*
   1024 * These registers contain an "update" bit - bit 8. This means, for example,
   1025 * that one can write new DAC digital volume for both channels, but only when
   1026 * the update bit is set, will also the volume be updated - simultaneously for
   1027 * both channels.
   1028 */
   1029static const int update_reg[] = {
   1030	NAU8822_REG_LEFT_DAC_DIGITAL_VOLUME,
   1031	NAU8822_REG_RIGHT_DAC_DIGITAL_VOLUME,
   1032	NAU8822_REG_LEFT_ADC_DIGITAL_VOLUME,
   1033	NAU8822_REG_RIGHT_ADC_DIGITAL_VOLUME,
   1034	NAU8822_REG_LEFT_INP_PGA_CONTROL,
   1035	NAU8822_REG_RIGHT_INP_PGA_CONTROL,
   1036	NAU8822_REG_LHP_VOLUME,
   1037	NAU8822_REG_RHP_VOLUME,
   1038	NAU8822_REG_LSPKOUT_VOLUME,
   1039	NAU8822_REG_RSPKOUT_VOLUME,
   1040};
   1041
   1042static int nau8822_probe(struct snd_soc_component *component)
   1043{
   1044	int i;
   1045
   1046	/*
   1047	 * Set the update bit in all registers, that have one. This way all
   1048	 * writes to those registers will also cause the update bit to be
   1049	 * written.
   1050	 */
   1051	for (i = 0; i < ARRAY_SIZE(update_reg); i++)
   1052		snd_soc_component_update_bits(component,
   1053			update_reg[i], 0x100, 0x100);
   1054
   1055	return 0;
   1056}
   1057
   1058static const struct snd_soc_component_driver soc_component_dev_nau8822 = {
   1059	.probe				= nau8822_probe,
   1060	.suspend			= nau8822_suspend,
   1061	.resume				= nau8822_resume,
   1062	.set_bias_level			= nau8822_set_bias_level,
   1063	.controls			= nau8822_snd_controls,
   1064	.num_controls			= ARRAY_SIZE(nau8822_snd_controls),
   1065	.dapm_widgets			= nau8822_dapm_widgets,
   1066	.num_dapm_widgets		= ARRAY_SIZE(nau8822_dapm_widgets),
   1067	.dapm_routes			= nau8822_dapm_routes,
   1068	.num_dapm_routes		= ARRAY_SIZE(nau8822_dapm_routes),
   1069	.idle_bias_on			= 1,
   1070	.use_pmdown_time		= 1,
   1071	.endianness			= 1,
   1072	.non_legacy_dai_naming		= 1,
   1073};
   1074
   1075static const struct regmap_config nau8822_regmap_config = {
   1076	.reg_bits = 7,
   1077	.val_bits = 9,
   1078
   1079	.max_register = NAU8822_REG_MAX_REGISTER,
   1080	.volatile_reg = nau8822_volatile,
   1081
   1082	.readable_reg = nau8822_readable_reg,
   1083	.writeable_reg = nau8822_writeable_reg,
   1084
   1085	.cache_type = REGCACHE_RBTREE,
   1086	.reg_defaults = nau8822_reg_defaults,
   1087	.num_reg_defaults = ARRAY_SIZE(nau8822_reg_defaults),
   1088};
   1089
   1090static int nau8822_i2c_probe(struct i2c_client *i2c)
   1091{
   1092	struct device *dev = &i2c->dev;
   1093	struct nau8822 *nau8822 = dev_get_platdata(dev);
   1094	int ret;
   1095
   1096	if (!nau8822) {
   1097		nau8822 = devm_kzalloc(dev, sizeof(*nau8822), GFP_KERNEL);
   1098		if (nau8822 == NULL)
   1099			return -ENOMEM;
   1100	}
   1101	i2c_set_clientdata(i2c, nau8822);
   1102
   1103	nau8822->regmap = devm_regmap_init_i2c(i2c, &nau8822_regmap_config);
   1104	if (IS_ERR(nau8822->regmap)) {
   1105		ret = PTR_ERR(nau8822->regmap);
   1106		dev_err(&i2c->dev, "Failed to allocate regmap: %d\n", ret);
   1107		return ret;
   1108	}
   1109	nau8822->dev = dev;
   1110
   1111	/* Reset the codec */
   1112	ret = regmap_write(nau8822->regmap, NAU8822_REG_RESET, 0x00);
   1113	if (ret != 0) {
   1114		dev_err(&i2c->dev, "Failed to issue reset: %d\n", ret);
   1115		return ret;
   1116	}
   1117
   1118	ret = devm_snd_soc_register_component(dev, &soc_component_dev_nau8822,
   1119						&nau8822_dai, 1);
   1120	if (ret != 0) {
   1121		dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
   1122		return ret;
   1123	}
   1124
   1125	return 0;
   1126}
   1127
   1128static const struct i2c_device_id nau8822_i2c_id[] = {
   1129	{ "nau8822", 0 },
   1130	{ }
   1131};
   1132MODULE_DEVICE_TABLE(i2c, nau8822_i2c_id);
   1133
   1134#ifdef CONFIG_OF
   1135static const struct of_device_id nau8822_of_match[] = {
   1136	{ .compatible = "nuvoton,nau8822", },
   1137	{ }
   1138};
   1139MODULE_DEVICE_TABLE(of, nau8822_of_match);
   1140#endif
   1141
   1142static struct i2c_driver nau8822_i2c_driver = {
   1143	.driver = {
   1144		.name = "nau8822",
   1145		.of_match_table = of_match_ptr(nau8822_of_match),
   1146	},
   1147	.probe_new = nau8822_i2c_probe,
   1148	.id_table = nau8822_i2c_id,
   1149};
   1150module_i2c_driver(nau8822_i2c_driver);
   1151
   1152MODULE_DESCRIPTION("ASoC NAU8822 codec driver");
   1153MODULE_AUTHOR("David Lin <ctlin0@nuvoton.com>");
   1154MODULE_LICENSE("GPL v2");