xref: /openbmc/linux/sound/soc/codecs/tlv320aic23.c (revision a7dca707)
1c1f27190SArun KS /*
2c1f27190SArun KS  * ALSA SoC TLV320AIC23 codec driver
3c1f27190SArun KS  *
4c1f27190SArun KS  * Author:      Arun KS, <arunks@mistralsolutions.com>
5c1f27190SArun KS  * Copyright:   (C) 2008 Mistral Solutions Pvt Ltd.,
6c1f27190SArun KS  *
7c1f27190SArun KS  * Based on sound/soc/codecs/wm8731.c by Richard Purdie
8c1f27190SArun KS  *
9c1f27190SArun KS  * This program is free software; you can redistribute it and/or modify
10c1f27190SArun KS  * it under the terms of the GNU General Public License version 2 as
11c1f27190SArun KS  * published by the Free Software Foundation.
12c1f27190SArun KS  *
13c1f27190SArun KS  * Notes:
14c1f27190SArun KS  *  The AIC23 is a driver for a low power stereo audio
15c1f27190SArun KS  *  codec tlv320aic23
16c1f27190SArun KS  *
17c1f27190SArun KS  *  The machine layer should disable unsupported inputs/outputs by
18c1f27190SArun KS  *  snd_soc_dapm_disable_pin(codec, "LHPOUT"), etc.
19c1f27190SArun KS  */
20c1f27190SArun KS 
21c1f27190SArun KS #include <linux/module.h>
22c1f27190SArun KS #include <linux/moduleparam.h>
23c1f27190SArun KS #include <linux/init.h>
24c1f27190SArun KS #include <linux/delay.h>
25c1f27190SArun KS #include <linux/pm.h>
26c1f27190SArun KS #include <linux/i2c.h>
27c1f27190SArun KS #include <linux/platform_device.h>
285a0e3ad6STejun Heo #include <linux/slab.h>
29c1f27190SArun KS #include <sound/core.h>
30c1f27190SArun KS #include <sound/pcm.h>
31c1f27190SArun KS #include <sound/pcm_params.h>
32c1f27190SArun KS #include <sound/soc.h>
33c1f27190SArun KS #include <sound/tlv.h>
34c1f27190SArun KS #include <sound/initval.h>
35c1f27190SArun KS 
36c1f27190SArun KS #include "tlv320aic23.h"
37c1f27190SArun KS 
38c1f27190SArun KS #define AIC23_VERSION "0.1"
39c1f27190SArun KS 
40c1f27190SArun KS /*
41c1f27190SArun KS  * AIC23 register cache
42c1f27190SArun KS  */
43c1f27190SArun KS static const u16 tlv320aic23_reg[] = {
44c1f27190SArun KS 	0x0097, 0x0097, 0x00F9, 0x00F9,	/* 0 */
45c1f27190SArun KS 	0x001A, 0x0004, 0x0007, 0x0001,	/* 4 */
46c1f27190SArun KS 	0x0020, 0x0000, 0x0000, 0x0000,	/* 8 */
47c1f27190SArun KS 	0x0000, 0x0000, 0x0000, 0x0000,	/* 12 */
48c1f27190SArun KS };
49c1f27190SArun KS 
50c1f27190SArun KS /*
51c1f27190SArun KS  * read tlv320aic23 register cache
52c1f27190SArun KS  */
53c1f27190SArun KS static inline unsigned int tlv320aic23_read_reg_cache(struct snd_soc_codec
54c1f27190SArun KS 						      *codec, unsigned int reg)
55c1f27190SArun KS {
56c1f27190SArun KS 	u16 *cache = codec->reg_cache;
57c1f27190SArun KS 	if (reg >= ARRAY_SIZE(tlv320aic23_reg))
58c1f27190SArun KS 		return -1;
59c1f27190SArun KS 	return cache[reg];
60c1f27190SArun KS }
61c1f27190SArun KS 
62c1f27190SArun KS /*
63c1f27190SArun KS  * write tlv320aic23 register cache
64c1f27190SArun KS  */
65c1f27190SArun KS static inline void tlv320aic23_write_reg_cache(struct snd_soc_codec *codec,
66c1f27190SArun KS 					       u8 reg, u16 value)
67c1f27190SArun KS {
68c1f27190SArun KS 	u16 *cache = codec->reg_cache;
69c1f27190SArun KS 	if (reg >= ARRAY_SIZE(tlv320aic23_reg))
70c1f27190SArun KS 		return;
71c1f27190SArun KS 	cache[reg] = value;
72c1f27190SArun KS }
73c1f27190SArun KS 
74c1f27190SArun KS /*
75c1f27190SArun KS  * write to the tlv320aic23 register space
76c1f27190SArun KS  */
77c1f27190SArun KS static int tlv320aic23_write(struct snd_soc_codec *codec, unsigned int reg,
78c1f27190SArun KS 			     unsigned int value)
79c1f27190SArun KS {
80c1f27190SArun KS 
814aa02396SArun KS 	u8 data[2];
82c1f27190SArun KS 
83c1f27190SArun KS 	/* TLV320AIC23 has 7 bit address and 9 bits of data
84c1f27190SArun KS 	 * so we need to switch one data bit into reg and rest
85c1f27190SArun KS 	 * of data into val
86c1f27190SArun KS 	 */
87c1f27190SArun KS 
8884ed1a19SRoel Kluin 	if (reg > 9 && reg != 15) {
89449bd54dSRoel Kluin 		printk(KERN_WARNING "%s Invalid register R%u\n", __func__, reg);
90c1f27190SArun KS 		return -1;
91c1f27190SArun KS 	}
92c1f27190SArun KS 
934aa02396SArun KS 	data[0] = (reg << 1) | (value >> 8 & 0x01);
944aa02396SArun KS 	data[1] = value & 0xff;
95c1f27190SArun KS 
96c1f27190SArun KS 	tlv320aic23_write_reg_cache(codec, reg, value);
97c1f27190SArun KS 
984aa02396SArun KS 	if (codec->hw_write(codec->control_data, data, 2) == 2)
99c1f27190SArun KS 		return 0;
100c1f27190SArun KS 
101449bd54dSRoel Kluin 	printk(KERN_ERR "%s cannot write %03x to register R%u\n", __func__,
102c1f27190SArun KS 	       value, reg);
103c1f27190SArun KS 
104c1f27190SArun KS 	return -EIO;
105c1f27190SArun KS }
106c1f27190SArun KS 
107c1f27190SArun KS static const char *rec_src_text[] = { "Line", "Mic" };
108c1f27190SArun KS static const char *deemph_text[] = {"None", "32Khz", "44.1Khz", "48Khz"};
109c1f27190SArun KS 
110c1f27190SArun KS static const struct soc_enum rec_src_enum =
111c1f27190SArun KS 	SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
112c1f27190SArun KS 
113c1f27190SArun KS static const struct snd_kcontrol_new tlv320aic23_rec_src_mux_controls =
114c1f27190SArun KS SOC_DAPM_ENUM("Input Select", rec_src_enum);
115c1f27190SArun KS 
116c1f27190SArun KS static const struct soc_enum tlv320aic23_rec_src =
117c1f27190SArun KS 	SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
118c1f27190SArun KS static const struct soc_enum tlv320aic23_deemph =
119c1f27190SArun KS 	SOC_ENUM_SINGLE(TLV320AIC23_DIGT, 1, 4, deemph_text);
120c1f27190SArun KS 
121c1f27190SArun KS static const DECLARE_TLV_DB_SCALE(out_gain_tlv, -12100, 100, 0);
122c1f27190SArun KS static const DECLARE_TLV_DB_SCALE(input_gain_tlv, -1725, 75, 0);
123df91ddf1SArun KS static const DECLARE_TLV_DB_SCALE(sidetone_vol_tlv, -1800, 300, 0);
124df91ddf1SArun KS 
125df91ddf1SArun KS static int snd_soc_tlv320aic23_put_volsw(struct snd_kcontrol *kcontrol,
126df91ddf1SArun KS 	struct snd_ctl_elem_value *ucontrol)
127df91ddf1SArun KS {
128df91ddf1SArun KS 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
129df91ddf1SArun KS 	u16 val, reg;
130df91ddf1SArun KS 
131df91ddf1SArun KS 	val = (ucontrol->value.integer.value[0] & 0x07);
132df91ddf1SArun KS 
133df91ddf1SArun KS 	/* linear conversion to userspace
134df91ddf1SArun KS 	* 000	=	-6db
135df91ddf1SArun KS 	* 001	=	-9db
136df91ddf1SArun KS 	* 010	=	-12db
137df91ddf1SArun KS 	* 011	=	-18db (Min)
138df91ddf1SArun KS 	* 100	=	0db (Max)
139df91ddf1SArun KS 	*/
140df91ddf1SArun KS 	val = (val >= 4) ? 4  : (3 - val);
141df91ddf1SArun KS 
142df91ddf1SArun KS 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (~0x1C0);
143df91ddf1SArun KS 	tlv320aic23_write(codec, TLV320AIC23_ANLG, reg | (val << 6));
144df91ddf1SArun KS 
145df91ddf1SArun KS 	return 0;
146df91ddf1SArun KS }
147df91ddf1SArun KS 
148df91ddf1SArun KS static int snd_soc_tlv320aic23_get_volsw(struct snd_kcontrol *kcontrol,
149df91ddf1SArun KS 	struct snd_ctl_elem_value *ucontrol)
150df91ddf1SArun KS {
151df91ddf1SArun KS 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
152df91ddf1SArun KS 	u16 val;
153df91ddf1SArun KS 
154df91ddf1SArun KS 	val = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (0x1C0);
155df91ddf1SArun KS 	val = val >> 6;
156df91ddf1SArun KS 	val = (val >= 4) ? 4  : (3 -  val);
157df91ddf1SArun KS 	ucontrol->value.integer.value[0] = val;
158df91ddf1SArun KS 	return 0;
159df91ddf1SArun KS 
160df91ddf1SArun KS }
161df91ddf1SArun KS 
162df91ddf1SArun KS #define SOC_TLV320AIC23_SINGLE_TLV(xname, reg, shift, max, invert, tlv_array) \
163df91ddf1SArun KS {	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
164df91ddf1SArun KS 	.access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
165df91ddf1SArun KS 		 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
166df91ddf1SArun KS 	.tlv.p = (tlv_array), \
167df91ddf1SArun KS 	.info = snd_soc_info_volsw, .get = snd_soc_tlv320aic23_get_volsw,\
168df91ddf1SArun KS 	.put = snd_soc_tlv320aic23_put_volsw, \
169df91ddf1SArun KS 	.private_value =  SOC_SINGLE_VALUE(reg, shift, max, invert) }
170c1f27190SArun KS 
171c1f27190SArun KS static const struct snd_kcontrol_new tlv320aic23_snd_controls[] = {
172c1f27190SArun KS 	SOC_DOUBLE_R_TLV("Digital Playback Volume", TLV320AIC23_LCHNVOL,
173c1f27190SArun KS 			 TLV320AIC23_RCHNVOL, 0, 127, 0, out_gain_tlv),
174c1f27190SArun KS 	SOC_SINGLE("Digital Playback Switch", TLV320AIC23_DIGT, 3, 1, 1),
175c1f27190SArun KS 	SOC_DOUBLE_R("Line Input Switch", TLV320AIC23_LINVOL,
176c1f27190SArun KS 		     TLV320AIC23_RINVOL, 7, 1, 0),
177c1f27190SArun KS 	SOC_DOUBLE_R_TLV("Line Input Volume", TLV320AIC23_LINVOL,
178c1f27190SArun KS 			 TLV320AIC23_RINVOL, 0, 31, 0, input_gain_tlv),
179c1f27190SArun KS 	SOC_SINGLE("Mic Input Switch", TLV320AIC23_ANLG, 1, 1, 1),
180c1f27190SArun KS 	SOC_SINGLE("Mic Booster Switch", TLV320AIC23_ANLG, 0, 1, 0),
181df91ddf1SArun KS 	SOC_TLV320AIC23_SINGLE_TLV("Sidetone Volume", TLV320AIC23_ANLG,
182df91ddf1SArun KS 				  6, 4, 0, sidetone_vol_tlv),
183c1f27190SArun KS 	SOC_ENUM("Playback De-emphasis", tlv320aic23_deemph),
184c1f27190SArun KS };
185c1f27190SArun KS 
186c1f27190SArun KS /* PGA Mixer controls for Line and Mic switch */
187c1f27190SArun KS static const struct snd_kcontrol_new tlv320aic23_output_mixer_controls[] = {
188c1f27190SArun KS 	SOC_DAPM_SINGLE("Line Bypass Switch", TLV320AIC23_ANLG, 3, 1, 0),
189c1f27190SArun KS 	SOC_DAPM_SINGLE("Mic Sidetone Switch", TLV320AIC23_ANLG, 5, 1, 0),
190c1f27190SArun KS 	SOC_DAPM_SINGLE("Playback Switch", TLV320AIC23_ANLG, 4, 1, 0),
191c1f27190SArun KS };
192c1f27190SArun KS 
193c1f27190SArun KS static const struct snd_soc_dapm_widget tlv320aic23_dapm_widgets[] = {
194c1f27190SArun KS 	SND_SOC_DAPM_DAC("DAC", "Playback", TLV320AIC23_PWR, 3, 1),
195c1f27190SArun KS 	SND_SOC_DAPM_ADC("ADC", "Capture", TLV320AIC23_PWR, 2, 1),
196c1f27190SArun KS 	SND_SOC_DAPM_MUX("Capture Source", SND_SOC_NOPM, 0, 0,
197c1f27190SArun KS 			 &tlv320aic23_rec_src_mux_controls),
198c1f27190SArun KS 	SND_SOC_DAPM_MIXER("Output Mixer", TLV320AIC23_PWR, 4, 1,
199c1f27190SArun KS 			   &tlv320aic23_output_mixer_controls[0],
200c1f27190SArun KS 			   ARRAY_SIZE(tlv320aic23_output_mixer_controls)),
201c1f27190SArun KS 	SND_SOC_DAPM_PGA("Line Input", TLV320AIC23_PWR, 0, 1, NULL, 0),
202c1f27190SArun KS 	SND_SOC_DAPM_PGA("Mic Input", TLV320AIC23_PWR, 1, 1, NULL, 0),
203c1f27190SArun KS 
204c1f27190SArun KS 	SND_SOC_DAPM_OUTPUT("LHPOUT"),
205c1f27190SArun KS 	SND_SOC_DAPM_OUTPUT("RHPOUT"),
206c1f27190SArun KS 	SND_SOC_DAPM_OUTPUT("LOUT"),
207c1f27190SArun KS 	SND_SOC_DAPM_OUTPUT("ROUT"),
208c1f27190SArun KS 
209c1f27190SArun KS 	SND_SOC_DAPM_INPUT("LLINEIN"),
210c1f27190SArun KS 	SND_SOC_DAPM_INPUT("RLINEIN"),
211c1f27190SArun KS 
212c1f27190SArun KS 	SND_SOC_DAPM_INPUT("MICIN"),
213c1f27190SArun KS };
214c1f27190SArun KS 
215a7dca707SLu Guanqun static const struct snd_soc_dapm_route tlv320aic23_intercon[] = {
216c1f27190SArun KS 	/* Output Mixer */
217c1f27190SArun KS 	{"Output Mixer", "Line Bypass Switch", "Line Input"},
218c1f27190SArun KS 	{"Output Mixer", "Playback Switch", "DAC"},
219c1f27190SArun KS 	{"Output Mixer", "Mic Sidetone Switch", "Mic Input"},
220c1f27190SArun KS 
221c1f27190SArun KS 	/* Outputs */
222c1f27190SArun KS 	{"RHPOUT", NULL, "Output Mixer"},
223c1f27190SArun KS 	{"LHPOUT", NULL, "Output Mixer"},
224c1f27190SArun KS 	{"LOUT", NULL, "Output Mixer"},
225c1f27190SArun KS 	{"ROUT", NULL, "Output Mixer"},
226c1f27190SArun KS 
227c1f27190SArun KS 	/* Inputs */
228c1f27190SArun KS 	{"Line Input", "NULL", "LLINEIN"},
229c1f27190SArun KS 	{"Line Input", "NULL", "RLINEIN"},
230c1f27190SArun KS 
231c1f27190SArun KS 	{"Mic Input", "NULL", "MICIN"},
232c1f27190SArun KS 
233c1f27190SArun KS 	/* input mux */
234c1f27190SArun KS 	{"Capture Source", "Line", "Line Input"},
235c1f27190SArun KS 	{"Capture Source", "Mic", "Mic Input"},
236c1f27190SArun KS 	{"ADC", NULL, "Capture Source"},
237c1f27190SArun KS 
238c1f27190SArun KS };
239c1f27190SArun KS 
24026df91c3STroy Kisky /* AIC23 driver data */
24126df91c3STroy Kisky struct aic23 {
242f0fba2adSLiam Girdwood 	enum snd_soc_control_type control_type;
243f0fba2adSLiam Girdwood 	void *control_data;
24426df91c3STroy Kisky 	int mclk;
24526df91c3STroy Kisky 	int requested_adc;
24626df91c3STroy Kisky 	int requested_dac;
247c1f27190SArun KS };
248c1f27190SArun KS 
24926df91c3STroy Kisky /*
25026df91c3STroy Kisky  * Common Crystals used
25126df91c3STroy Kisky  * 11.2896 Mhz /128 = *88.2k  /192 = 58.8k
25226df91c3STroy Kisky  * 12.0000 Mhz /125 = *96k    /136 = 88.235K
25326df91c3STroy Kisky  * 12.2880 Mhz /128 = *96k    /192 = 64k
25426df91c3STroy Kisky  * 16.9344 Mhz /128 = 132.3k /192 = *88.2k
25526df91c3STroy Kisky  * 18.4320 Mhz /128 = 144k   /192 = *96k
25626df91c3STroy Kisky  */
25726df91c3STroy Kisky 
25826df91c3STroy Kisky /*
25926df91c3STroy Kisky  * Normal BOSR 0-256/2 = 128, 1-384/2 = 192
26026df91c3STroy Kisky  * USB BOSR 0-250/2 = 125, 1-272/2 = 136
26126df91c3STroy Kisky  */
26226df91c3STroy Kisky static const int bosr_usb_divisor_table[] = {
26326df91c3STroy Kisky 	128, 125, 192, 136
26426df91c3STroy Kisky };
26526df91c3STroy Kisky #define LOWER_GROUP ((1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<6) | (1<<7))
26626df91c3STroy Kisky #define UPPER_GROUP ((1<<8) | (1<<9) | (1<<10) | (1<<11)        | (1<<15))
26726df91c3STroy Kisky static const unsigned short sr_valid_mask[] = {
26826df91c3STroy Kisky 	LOWER_GROUP|UPPER_GROUP,	/* Normal, bosr - 0*/
26926df91c3STroy Kisky 	LOWER_GROUP,			/* Usb, bosr - 0*/
270bab02124STroy Kisky 	LOWER_GROUP|UPPER_GROUP,	/* Normal, bosr - 1*/
27126df91c3STroy Kisky 	UPPER_GROUP,			/* Usb, bosr - 1*/
27226df91c3STroy Kisky };
27326df91c3STroy Kisky /*
27426df91c3STroy Kisky  * Every divisor is a factor of 11*12
27526df91c3STroy Kisky  */
27626df91c3STroy Kisky #define SR_MULT (11*12)
277ccff4b15STroy Kisky #define A(x) (SR_MULT/x)
27826df91c3STroy Kisky static const unsigned char sr_adc_mult_table[] = {
279ccff4b15STroy Kisky 	A(2), A(2), A(12), A(12),  0, 0, A(3), A(1),
280ccff4b15STroy Kisky 	A(2), A(2), A(11), A(11),  0, 0, 0, A(1)
28126df91c3STroy Kisky };
28226df91c3STroy Kisky static const unsigned char sr_dac_mult_table[] = {
283ccff4b15STroy Kisky 	A(2), A(12), A(2), A(12),  0, 0, A(3), A(1),
284ccff4b15STroy Kisky 	A(2), A(11), A(2), A(11),  0, 0, 0, A(1)
28526df91c3STroy Kisky };
28626df91c3STroy Kisky 
28726df91c3STroy Kisky static unsigned get_score(int adc, int adc_l, int adc_h, int need_adc,
28826df91c3STroy Kisky 		int dac, int dac_l, int dac_h, int need_dac)
28926df91c3STroy Kisky {
29026df91c3STroy Kisky 	if ((adc >= adc_l) && (adc <= adc_h) &&
29126df91c3STroy Kisky 			(dac >= dac_l) && (dac <= dac_h)) {
29226df91c3STroy Kisky 		int diff_adc = need_adc - adc;
29326df91c3STroy Kisky 		int diff_dac = need_dac - dac;
29426df91c3STroy Kisky 		return abs(diff_adc) + abs(diff_dac);
29526df91c3STroy Kisky 	}
29626df91c3STroy Kisky 	return UINT_MAX;
29726df91c3STroy Kisky }
29826df91c3STroy Kisky 
29926df91c3STroy Kisky static int find_rate(int mclk, u32 need_adc, u32 need_dac)
30026df91c3STroy Kisky {
30126df91c3STroy Kisky 	int i, j;
30226df91c3STroy Kisky 	int best_i = -1;
30326df91c3STroy Kisky 	int best_j = -1;
30426df91c3STroy Kisky 	int best_div = 0;
30526df91c3STroy Kisky 	unsigned best_score = UINT_MAX;
30626df91c3STroy Kisky 	int adc_l, adc_h, dac_l, dac_h;
30726df91c3STroy Kisky 
30826df91c3STroy Kisky 	need_adc *= SR_MULT;
30926df91c3STroy Kisky 	need_dac *= SR_MULT;
31026df91c3STroy Kisky 	/*
31126df91c3STroy Kisky 	 * rates given are +/- 1/32
31226df91c3STroy Kisky 	 */
31326df91c3STroy Kisky 	adc_l = need_adc - (need_adc >> 5);
31426df91c3STroy Kisky 	adc_h = need_adc + (need_adc >> 5);
31526df91c3STroy Kisky 	dac_l = need_dac - (need_dac >> 5);
31626df91c3STroy Kisky 	dac_h = need_dac + (need_dac >> 5);
3178d702f23SMark Brown 	for (i = 0; i < ARRAY_SIZE(bosr_usb_divisor_table); i++) {
31826df91c3STroy Kisky 		int base = mclk / bosr_usb_divisor_table[i];
31926df91c3STroy Kisky 		int mask = sr_valid_mask[i];
3208d702f23SMark Brown 		for (j = 0; j < ARRAY_SIZE(sr_adc_mult_table);
3218d702f23SMark Brown 				j++, mask >>= 1) {
32226df91c3STroy Kisky 			int adc;
32326df91c3STroy Kisky 			int dac;
32426df91c3STroy Kisky 			int score;
32526df91c3STroy Kisky 			if ((mask & 1) == 0)
32626df91c3STroy Kisky 				continue;
32726df91c3STroy Kisky 			adc = base * sr_adc_mult_table[j];
32826df91c3STroy Kisky 			dac = base * sr_dac_mult_table[j];
32926df91c3STroy Kisky 			score = get_score(adc, adc_l, adc_h, need_adc,
33026df91c3STroy Kisky 					dac, dac_l, dac_h, need_dac);
33126df91c3STroy Kisky 			if (best_score > score) {
33226df91c3STroy Kisky 				best_score = score;
33326df91c3STroy Kisky 				best_i = i;
33426df91c3STroy Kisky 				best_j = j;
33526df91c3STroy Kisky 				best_div = 0;
33626df91c3STroy Kisky 			}
33726df91c3STroy Kisky 			score = get_score((adc >> 1), adc_l, adc_h, need_adc,
33826df91c3STroy Kisky 					(dac >> 1), dac_l, dac_h, need_dac);
33926df91c3STroy Kisky 			/* prefer to have a /2 */
34026df91c3STroy Kisky 			if ((score != UINT_MAX) && (best_score >= score)) {
34126df91c3STroy Kisky 				best_score = score;
34226df91c3STroy Kisky 				best_i = i;
34326df91c3STroy Kisky 				best_j = j;
34426df91c3STroy Kisky 				best_div = 1;
34526df91c3STroy Kisky 			}
34626df91c3STroy Kisky 		}
34726df91c3STroy Kisky 	}
34826df91c3STroy Kisky 	return (best_j << 2) | best_i | (best_div << TLV320AIC23_CLKIN_SHIFT);
34926df91c3STroy Kisky }
35026df91c3STroy Kisky 
3518d702f23SMark Brown #ifdef DEBUG
35226df91c3STroy Kisky static void get_current_sample_rates(struct snd_soc_codec *codec, int mclk,
35326df91c3STroy Kisky 		u32 *sample_rate_adc, u32 *sample_rate_dac)
35426df91c3STroy Kisky {
35526df91c3STroy Kisky 	int src = tlv320aic23_read_reg_cache(codec, TLV320AIC23_SRATE);
35626df91c3STroy Kisky 	int sr = (src >> 2) & 0x0f;
35726df91c3STroy Kisky 	int val = (mclk / bosr_usb_divisor_table[src & 3]);
35826df91c3STroy Kisky 	int adc = (val * sr_adc_mult_table[sr]) / SR_MULT;
35926df91c3STroy Kisky 	int dac = (val * sr_dac_mult_table[sr]) / SR_MULT;
36026df91c3STroy Kisky 	if (src & TLV320AIC23_CLKIN_HALF) {
36126df91c3STroy Kisky 		adc >>= 1;
36226df91c3STroy Kisky 		dac >>= 1;
36326df91c3STroy Kisky 	}
36426df91c3STroy Kisky 	*sample_rate_adc = adc;
36526df91c3STroy Kisky 	*sample_rate_dac = dac;
36626df91c3STroy Kisky }
3678d702f23SMark Brown #endif
36826df91c3STroy Kisky 
36926df91c3STroy Kisky static int set_sample_rate_control(struct snd_soc_codec *codec, int mclk,
37026df91c3STroy Kisky 		u32 sample_rate_adc, u32 sample_rate_dac)
37126df91c3STroy Kisky {
37226df91c3STroy Kisky 	/* Search for the right sample rate */
37326df91c3STroy Kisky 	int data = find_rate(mclk, sample_rate_adc, sample_rate_dac);
37426df91c3STroy Kisky 	if (data < 0) {
37526df91c3STroy Kisky 		printk(KERN_ERR "%s:Invalid rate %u,%u requested\n",
37626df91c3STroy Kisky 				__func__, sample_rate_adc, sample_rate_dac);
37726df91c3STroy Kisky 		return -EINVAL;
37826df91c3STroy Kisky 	}
37926df91c3STroy Kisky 	tlv320aic23_write(codec, TLV320AIC23_SRATE, data);
3808d702f23SMark Brown #ifdef DEBUG
3818d702f23SMark Brown 	{
3828d702f23SMark Brown 		u32 adc, dac;
38326df91c3STroy Kisky 		get_current_sample_rates(codec, mclk, &adc, &dac);
38426df91c3STroy Kisky 		printk(KERN_DEBUG "actual samplerate = %u,%u reg=%x\n",
38526df91c3STroy Kisky 			adc, dac, data);
38626df91c3STroy Kisky 	}
3878d702f23SMark Brown #endif
38826df91c3STroy Kisky 	return 0;
38926df91c3STroy Kisky }
39026df91c3STroy Kisky 
391c1f27190SArun KS static int tlv320aic23_hw_params(struct snd_pcm_substream *substream,
392dee89c4dSMark Brown 				 struct snd_pcm_hw_params *params,
393dee89c4dSMark Brown 				 struct snd_soc_dai *dai)
394c1f27190SArun KS {
395c1f27190SArun KS 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
396f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
39726df91c3STroy Kisky 	u16 iface_reg;
39826df91c3STroy Kisky 	int ret;
399f0fba2adSLiam Girdwood 	struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
40026df91c3STroy Kisky 	u32 sample_rate_adc = aic23->requested_adc;
40126df91c3STroy Kisky 	u32 sample_rate_dac = aic23->requested_dac;
40226df91c3STroy Kisky 	u32 sample_rate = params_rate(params);
40326df91c3STroy Kisky 
40426df91c3STroy Kisky 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
40526df91c3STroy Kisky 		aic23->requested_dac = sample_rate_dac = sample_rate;
40626df91c3STroy Kisky 		if (!sample_rate_adc)
40726df91c3STroy Kisky 			sample_rate_adc = sample_rate;
40826df91c3STroy Kisky 	} else {
40926df91c3STroy Kisky 		aic23->requested_adc = sample_rate_adc = sample_rate;
41026df91c3STroy Kisky 		if (!sample_rate_dac)
41126df91c3STroy Kisky 			sample_rate_dac = sample_rate;
41226df91c3STroy Kisky 	}
41326df91c3STroy Kisky 	ret = set_sample_rate_control(codec, aic23->mclk, sample_rate_adc,
41426df91c3STroy Kisky 			sample_rate_dac);
41526df91c3STroy Kisky 	if (ret < 0)
41626df91c3STroy Kisky 		return ret;
417c1f27190SArun KS 
418c1f27190SArun KS 	iface_reg =
419c1f27190SArun KS 	    tlv320aic23_read_reg_cache(codec,
420c1f27190SArun KS 				       TLV320AIC23_DIGT_FMT) & ~(0x03 << 2);
421c1f27190SArun KS 	switch (params_format(params)) {
422c1f27190SArun KS 	case SNDRV_PCM_FORMAT_S16_LE:
423c1f27190SArun KS 		break;
424c1f27190SArun KS 	case SNDRV_PCM_FORMAT_S20_3LE:
425c1f27190SArun KS 		iface_reg |= (0x01 << 2);
426c1f27190SArun KS 		break;
427c1f27190SArun KS 	case SNDRV_PCM_FORMAT_S24_LE:
428c1f27190SArun KS 		iface_reg |= (0x02 << 2);
429c1f27190SArun KS 		break;
430c1f27190SArun KS 	case SNDRV_PCM_FORMAT_S32_LE:
431c1f27190SArun KS 		iface_reg |= (0x03 << 2);
432c1f27190SArun KS 		break;
433c1f27190SArun KS 	}
434c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
435c1f27190SArun KS 
436c1f27190SArun KS 	return 0;
437c1f27190SArun KS }
438c1f27190SArun KS 
439dee89c4dSMark Brown static int tlv320aic23_pcm_prepare(struct snd_pcm_substream *substream,
440dee89c4dSMark Brown 				   struct snd_soc_dai *dai)
441c1f27190SArun KS {
442c1f27190SArun KS 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
443f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
444c1f27190SArun KS 
445c1f27190SArun KS 	/* set active */
446c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0001);
447c1f27190SArun KS 
448c1f27190SArun KS 	return 0;
449c1f27190SArun KS }
450c1f27190SArun KS 
451dee89c4dSMark Brown static void tlv320aic23_shutdown(struct snd_pcm_substream *substream,
452dee89c4dSMark Brown 				 struct snd_soc_dai *dai)
453c1f27190SArun KS {
454c1f27190SArun KS 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
455f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
456f0fba2adSLiam Girdwood 	struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
457c1f27190SArun KS 
458c1f27190SArun KS 	/* deactivate */
459c1f27190SArun KS 	if (!codec->active) {
460c1f27190SArun KS 		udelay(50);
461c1f27190SArun KS 		tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
462c1f27190SArun KS 	}
46326df91c3STroy Kisky 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
46426df91c3STroy Kisky 		aic23->requested_dac = 0;
46526df91c3STroy Kisky 	else
46626df91c3STroy Kisky 		aic23->requested_adc = 0;
467c1f27190SArun KS }
468c1f27190SArun KS 
469c1f27190SArun KS static int tlv320aic23_mute(struct snd_soc_dai *dai, int mute)
470c1f27190SArun KS {
471c1f27190SArun KS 	struct snd_soc_codec *codec = dai->codec;
472c1f27190SArun KS 	u16 reg;
473c1f27190SArun KS 
474c1f27190SArun KS 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT);
475c1f27190SArun KS 	if (mute)
476c1f27190SArun KS 		reg |= TLV320AIC23_DACM_MUTE;
477c1f27190SArun KS 
478c1f27190SArun KS 	else
479c1f27190SArun KS 		reg &= ~TLV320AIC23_DACM_MUTE;
480c1f27190SArun KS 
481c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_DIGT, reg);
482c1f27190SArun KS 
483c1f27190SArun KS 	return 0;
484c1f27190SArun KS }
485c1f27190SArun KS 
486c1f27190SArun KS static int tlv320aic23_set_dai_fmt(struct snd_soc_dai *codec_dai,
487c1f27190SArun KS 				   unsigned int fmt)
488c1f27190SArun KS {
489c1f27190SArun KS 	struct snd_soc_codec *codec = codec_dai->codec;
490c1f27190SArun KS 	u16 iface_reg;
491c1f27190SArun KS 
492c1f27190SArun KS 	iface_reg =
493c1f27190SArun KS 	    tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT_FMT) & (~0x03);
494c1f27190SArun KS 
495c1f27190SArun KS 	/* set master/slave audio interface */
496c1f27190SArun KS 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
497c1f27190SArun KS 	case SND_SOC_DAIFMT_CBM_CFM:
498c1f27190SArun KS 		iface_reg |= TLV320AIC23_MS_MASTER;
499c1f27190SArun KS 		break;
500c1f27190SArun KS 	case SND_SOC_DAIFMT_CBS_CFS:
501c1f27190SArun KS 		break;
502c1f27190SArun KS 	default:
503c1f27190SArun KS 		return -EINVAL;
504c1f27190SArun KS 
505c1f27190SArun KS 	}
506c1f27190SArun KS 
507c1f27190SArun KS 	/* interface format */
508c1f27190SArun KS 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
509c1f27190SArun KS 	case SND_SOC_DAIFMT_I2S:
510c1f27190SArun KS 		iface_reg |= TLV320AIC23_FOR_I2S;
511c1f27190SArun KS 		break;
512894bf92fSPeter Ujfalusi 	case SND_SOC_DAIFMT_DSP_A:
513894bf92fSPeter Ujfalusi 		iface_reg |= TLV320AIC23_LRP_ON;
514bd25867aSJarkko Nikula 	case SND_SOC_DAIFMT_DSP_B:
515c1f27190SArun KS 		iface_reg |= TLV320AIC23_FOR_DSP;
516c1f27190SArun KS 		break;
517c1f27190SArun KS 	case SND_SOC_DAIFMT_RIGHT_J:
518c1f27190SArun KS 		break;
519c1f27190SArun KS 	case SND_SOC_DAIFMT_LEFT_J:
520c1f27190SArun KS 		iface_reg |= TLV320AIC23_FOR_LJUST;
521c1f27190SArun KS 		break;
522c1f27190SArun KS 	default:
523c1f27190SArun KS 		return -EINVAL;
524c1f27190SArun KS 
525c1f27190SArun KS 	}
526c1f27190SArun KS 
527c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
528c1f27190SArun KS 
529c1f27190SArun KS 	return 0;
530c1f27190SArun KS }
531c1f27190SArun KS 
532c1f27190SArun KS static int tlv320aic23_set_dai_sysclk(struct snd_soc_dai *codec_dai,
533c1f27190SArun KS 				      int clk_id, unsigned int freq, int dir)
534c1f27190SArun KS {
535f0fba2adSLiam Girdwood 	struct aic23 *aic23 = snd_soc_dai_get_drvdata(codec_dai);
53626df91c3STroy Kisky 	aic23->mclk = freq;
537c1f27190SArun KS 	return 0;
538c1f27190SArun KS }
539c1f27190SArun KS 
540c1f27190SArun KS static int tlv320aic23_set_bias_level(struct snd_soc_codec *codec,
541c1f27190SArun KS 				      enum snd_soc_bias_level level)
542c1f27190SArun KS {
543c1f27190SArun KS 	u16 reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_PWR) & 0xff7f;
544c1f27190SArun KS 
545c1f27190SArun KS 	switch (level) {
546c1f27190SArun KS 	case SND_SOC_BIAS_ON:
547c1f27190SArun KS 		/* vref/mid, osc on, dac unmute */
5483d5a4516SEric Bénard 		reg &= ~(TLV320AIC23_DEVICE_PWR_OFF | TLV320AIC23_OSC_OFF | \
5493d5a4516SEric Bénard 			TLV320AIC23_DAC_OFF);
550c1f27190SArun KS 		tlv320aic23_write(codec, TLV320AIC23_PWR, reg);
551c1f27190SArun KS 		break;
552c1f27190SArun KS 	case SND_SOC_BIAS_PREPARE:
553c1f27190SArun KS 		break;
554c1f27190SArun KS 	case SND_SOC_BIAS_STANDBY:
555c1f27190SArun KS 		/* everything off except vref/vmid, */
5563d5a4516SEric Bénard 		tlv320aic23_write(codec, TLV320AIC23_PWR, reg | \
5573d5a4516SEric Bénard 			TLV320AIC23_CLK_OFF);
558c1f27190SArun KS 		break;
559c1f27190SArun KS 	case SND_SOC_BIAS_OFF:
560c1f27190SArun KS 		/* everything off, dac mute, inactive */
561c1f27190SArun KS 		tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
562c1f27190SArun KS 		tlv320aic23_write(codec, TLV320AIC23_PWR, 0xffff);
563c1f27190SArun KS 		break;
564c1f27190SArun KS 	}
565ce6120ccSLiam Girdwood 	codec->dapm.bias_level = level;
566c1f27190SArun KS 	return 0;
567c1f27190SArun KS }
568c1f27190SArun KS 
569c1f27190SArun KS #define AIC23_RATES	SNDRV_PCM_RATE_8000_96000
570c1f27190SArun KS #define AIC23_FORMATS	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
571c1f27190SArun KS 			 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
572c1f27190SArun KS 
5736335d055SEric Miao static struct snd_soc_dai_ops tlv320aic23_dai_ops = {
5746335d055SEric Miao 	.prepare	= tlv320aic23_pcm_prepare,
5756335d055SEric Miao 	.hw_params	= tlv320aic23_hw_params,
5766335d055SEric Miao 	.shutdown	= tlv320aic23_shutdown,
5776335d055SEric Miao 	.digital_mute	= tlv320aic23_mute,
5786335d055SEric Miao 	.set_fmt	= tlv320aic23_set_dai_fmt,
5796335d055SEric Miao 	.set_sysclk	= tlv320aic23_set_dai_sysclk,
5806335d055SEric Miao };
5816335d055SEric Miao 
582f0fba2adSLiam Girdwood static struct snd_soc_dai_driver tlv320aic23_dai = {
583f0fba2adSLiam Girdwood 	.name = "tlv320aic23-hifi",
584c1f27190SArun KS 	.playback = {
585c1f27190SArun KS 		     .stream_name = "Playback",
586c1f27190SArun KS 		     .channels_min = 2,
587c1f27190SArun KS 		     .channels_max = 2,
588c1f27190SArun KS 		     .rates = AIC23_RATES,
589c1f27190SArun KS 		     .formats = AIC23_FORMATS,},
590c1f27190SArun KS 	.capture = {
591c1f27190SArun KS 		    .stream_name = "Capture",
592c1f27190SArun KS 		    .channels_min = 2,
593c1f27190SArun KS 		    .channels_max = 2,
594c1f27190SArun KS 		    .rates = AIC23_RATES,
595c1f27190SArun KS 		    .formats = AIC23_FORMATS,},
5966335d055SEric Miao 	.ops = &tlv320aic23_dai_ops,
597c1f27190SArun KS };
598c1f27190SArun KS 
599f0fba2adSLiam Girdwood static int tlv320aic23_suspend(struct snd_soc_codec *codec,
600c1f27190SArun KS 			       pm_message_t state)
601c1f27190SArun KS {
602c1f27190SArun KS 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
603c1f27190SArun KS 
604c1f27190SArun KS 	return 0;
605c1f27190SArun KS }
606c1f27190SArun KS 
607f0fba2adSLiam Girdwood static int tlv320aic23_resume(struct snd_soc_codec *codec)
608c1f27190SArun KS {
609c1f27190SArun KS 	u16 reg;
610c1f27190SArun KS 
611c1f27190SArun KS 	/* Sync reg_cache with the hardware */
6123e59aaa7SAnuj Aggarwal 	for (reg = 0; reg <= TLV320AIC23_ACTIVE; reg++) {
613c1f27190SArun KS 		u16 val = tlv320aic23_read_reg_cache(codec, reg);
614c1f27190SArun KS 		tlv320aic23_write(codec, reg, val);
615c1f27190SArun KS 	}
616c1f27190SArun KS 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
617c1f27190SArun KS 
618c1f27190SArun KS 	return 0;
619c1f27190SArun KS }
620c1f27190SArun KS 
621f0fba2adSLiam Girdwood static int tlv320aic23_probe(struct snd_soc_codec *codec)
622c1f27190SArun KS {
623f0fba2adSLiam Girdwood 	struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
624f0fba2adSLiam Girdwood 	int reg;
625c1f27190SArun KS 
626f0fba2adSLiam Girdwood 	printk(KERN_INFO "AIC23 Audio Codec %s\n", AIC23_VERSION);
627f0fba2adSLiam Girdwood 	codec->control_data = aic23->control_data;
628f0fba2adSLiam Girdwood 	codec->hw_write = (hw_write_t)i2c_master_send;
629f0fba2adSLiam Girdwood 	codec->hw_read = NULL;
630c1f27190SArun KS 
631c1f27190SArun KS 	/* Reset codec */
632c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_RESET, 0);
633c1f27190SArun KS 
634c1f27190SArun KS 	/* power on device */
635c1f27190SArun KS 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
636c1f27190SArun KS 
637c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_DIGT, TLV320AIC23_DEEMP_44K);
638c1f27190SArun KS 
639c1f27190SArun KS 	/* Unmute input */
640c1f27190SArun KS 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_LINVOL);
641c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_LINVOL,
642c1f27190SArun KS 			  (reg & (~TLV320AIC23_LIM_MUTED)) |
643c1f27190SArun KS 			  (TLV320AIC23_LRS_ENABLED));
644c1f27190SArun KS 
645c1f27190SArun KS 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_RINVOL);
646c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_RINVOL,
647c1f27190SArun KS 			  (reg & (~TLV320AIC23_LIM_MUTED)) |
648c1f27190SArun KS 			  TLV320AIC23_LRS_ENABLED);
649c1f27190SArun KS 
650c1f27190SArun KS 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG);
651c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_ANLG,
652c1f27190SArun KS 			 (reg) & (~TLV320AIC23_BYPASS_ON) &
653c1f27190SArun KS 			 (~TLV320AIC23_MICM_MUTED));
654c1f27190SArun KS 
655c1f27190SArun KS 	/* Default output volume */
656c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_LCHNVOL,
657c1f27190SArun KS 			  TLV320AIC23_DEFAULT_OUT_VOL &
658c1f27190SArun KS 			  TLV320AIC23_OUT_VOL_MASK);
659c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_RCHNVOL,
660c1f27190SArun KS 			  TLV320AIC23_DEFAULT_OUT_VOL &
661c1f27190SArun KS 			  TLV320AIC23_OUT_VOL_MASK);
662c1f27190SArun KS 
663c1f27190SArun KS 	tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x1);
664c1f27190SArun KS 
6653e8e1952SIan Molton 	snd_soc_add_controls(codec, tlv320aic23_snd_controls,
6663e8e1952SIan Molton 				ARRAY_SIZE(tlv320aic23_snd_controls));
667c1f27190SArun KS 
668f0fba2adSLiam Girdwood 	return 0;
669c1f27190SArun KS }
670f0fba2adSLiam Girdwood 
671f0fba2adSLiam Girdwood static int tlv320aic23_remove(struct snd_soc_codec *codec)
672f0fba2adSLiam Girdwood {
673f0fba2adSLiam Girdwood 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
674f0fba2adSLiam Girdwood 	return 0;
675f0fba2adSLiam Girdwood }
676f0fba2adSLiam Girdwood 
677f0fba2adSLiam Girdwood static struct snd_soc_codec_driver soc_codec_dev_tlv320aic23 = {
678f0fba2adSLiam Girdwood 	.reg_cache_size = ARRAY_SIZE(tlv320aic23_reg),
679f0fba2adSLiam Girdwood 	.reg_word_size = sizeof(u16),
680f0fba2adSLiam Girdwood 	.reg_cache_default = tlv320aic23_reg,
681f0fba2adSLiam Girdwood 	.probe = tlv320aic23_probe,
682f0fba2adSLiam Girdwood 	.remove = tlv320aic23_remove,
683f0fba2adSLiam Girdwood 	.suspend = tlv320aic23_suspend,
684f0fba2adSLiam Girdwood 	.resume = tlv320aic23_resume,
685f0fba2adSLiam Girdwood 	.read = tlv320aic23_read_reg_cache,
686f0fba2adSLiam Girdwood 	.write = tlv320aic23_write,
687f0fba2adSLiam Girdwood 	.set_bias_level = tlv320aic23_set_bias_level,
688a7dca707SLu Guanqun 	.dapm_widgets = tlv320aic23_dapm_widgets,
689a7dca707SLu Guanqun 	.num_dapm_widgets = ARRAY_SIZE(tlv320aic23_dapm_widgets),
690a7dca707SLu Guanqun 	.dapm_routes = tlv320aic23_intercon,
691a7dca707SLu Guanqun 	.num_dapm_routes = ARRAY_SIZE(tlv320aic23_intercon),
692f0fba2adSLiam Girdwood };
693c1f27190SArun KS 
694c1f27190SArun KS #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
695c1f27190SArun KS /*
696c1f27190SArun KS  * If the i2c layer weren't so broken, we could pass this kind of data
697c1f27190SArun KS  * around
698c1f27190SArun KS  */
699c1f27190SArun KS static int tlv320aic23_codec_probe(struct i2c_client *i2c,
700c1f27190SArun KS 				   const struct i2c_device_id *i2c_id)
701c1f27190SArun KS {
702f0fba2adSLiam Girdwood 	struct aic23 *aic23;
703c1f27190SArun KS 	int ret;
704c1f27190SArun KS 
705c1f27190SArun KS 	if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
706c1f27190SArun KS 		return -EINVAL;
707c1f27190SArun KS 
708f0fba2adSLiam Girdwood 	aic23 = kzalloc(sizeof(struct aic23), GFP_KERNEL);
709f0fba2adSLiam Girdwood 	if (aic23 == NULL)
710f0fba2adSLiam Girdwood 		return -ENOMEM;
711c1f27190SArun KS 
712f0fba2adSLiam Girdwood 	i2c_set_clientdata(i2c, aic23);
713f0fba2adSLiam Girdwood 	aic23->control_data = i2c;
714f0fba2adSLiam Girdwood 	aic23->control_type = SND_SOC_I2C;
715c1f27190SArun KS 
716f0fba2adSLiam Girdwood 	ret =  snd_soc_register_codec(&i2c->dev,
717f0fba2adSLiam Girdwood 			&soc_codec_dev_tlv320aic23, &tlv320aic23_dai, 1);
718f0fba2adSLiam Girdwood 	if (ret < 0)
719f0fba2adSLiam Girdwood 		kfree(aic23);
720c1f27190SArun KS 	return ret;
721c1f27190SArun KS }
722c1f27190SArun KS static int __exit tlv320aic23_i2c_remove(struct i2c_client *i2c)
723c1f27190SArun KS {
724f0fba2adSLiam Girdwood 	snd_soc_unregister_codec(&i2c->dev);
725f0fba2adSLiam Girdwood 	kfree(i2c_get_clientdata(i2c));
726c1f27190SArun KS 	return 0;
727c1f27190SArun KS }
728c1f27190SArun KS 
729c1f27190SArun KS static const struct i2c_device_id tlv320aic23_id[] = {
730c1f27190SArun KS 	{"tlv320aic23", 0},
731c1f27190SArun KS 	{}
732c1f27190SArun KS };
733c1f27190SArun KS 
734c1f27190SArun KS MODULE_DEVICE_TABLE(i2c, tlv320aic23_id);
735c1f27190SArun KS 
736c1f27190SArun KS static struct i2c_driver tlv320aic23_i2c_driver = {
737c1f27190SArun KS 	.driver = {
738f0fba2adSLiam Girdwood 		   .name = "tlv320aic23-codec",
739c1f27190SArun KS 		   },
740c1f27190SArun KS 	.probe = tlv320aic23_codec_probe,
741c1f27190SArun KS 	.remove = __exit_p(tlv320aic23_i2c_remove),
742c1f27190SArun KS 	.id_table = tlv320aic23_id,
743c1f27190SArun KS };
744c1f27190SArun KS 
745c1f27190SArun KS #endif
746c1f27190SArun KS 
747c9b3a40fSTakashi Iwai static int __init tlv320aic23_modinit(void)
74864089b84SMark Brown {
749f0fba2adSLiam Girdwood 	int ret;
750f0fba2adSLiam Girdwood #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
751f0fba2adSLiam Girdwood 	ret = i2c_add_driver(&tlv320aic23_i2c_driver);
752f0fba2adSLiam Girdwood 	if (ret != 0) {
753f0fba2adSLiam Girdwood 		printk(KERN_ERR "Failed to register TLV320AIC23 I2C driver: %d\n",
754f0fba2adSLiam Girdwood 		       ret);
755f0fba2adSLiam Girdwood 	}
756f0fba2adSLiam Girdwood #endif
757f0fba2adSLiam Girdwood 	return ret;
75864089b84SMark Brown }
75964089b84SMark Brown module_init(tlv320aic23_modinit);
76064089b84SMark Brown 
76164089b84SMark Brown static void __exit tlv320aic23_exit(void)
76264089b84SMark Brown {
763f0fba2adSLiam Girdwood #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
764f0fba2adSLiam Girdwood 	i2c_del_driver(&tlv320aic23_i2c_driver);
765f0fba2adSLiam Girdwood #endif
76664089b84SMark Brown }
76764089b84SMark Brown module_exit(tlv320aic23_exit);
76864089b84SMark Brown 
769c1f27190SArun KS MODULE_DESCRIPTION("ASoC TLV320AIC23 codec driver");
770c1f27190SArun KS MODULE_AUTHOR("Arun KS <arunks@mistralsolutions.com>");
771c1f27190SArun KS MODULE_LICENSE("GPL");
772