Merge branch 'topic/pcm-drain-nonblock' into for-linus
[pandora-kernel.git] / sound / soc / codecs / ak4535.c
1 /*
2  * ak4535.c  --  AK4535 ALSA Soc Audio driver
3  *
4  * Copyright 2005 Openedhand Ltd.
5  *
6  * Author: Richard Purdie <richard@openedhand.com>
7  *
8  * Based on wm8753.c by Liam Girdwood
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License version 2 as
12  * published by the Free Software Foundation.
13  */
14
15 #include <linux/module.h>
16 #include <linux/moduleparam.h>
17 #include <linux/init.h>
18 #include <linux/delay.h>
19 #include <linux/pm.h>
20 #include <linux/i2c.h>
21 #include <linux/platform_device.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/soc-dapm.h>
27 #include <sound/initval.h>
28
29 #include "ak4535.h"
30
31 #define AK4535_VERSION "0.3"
32
33 struct snd_soc_codec_device soc_codec_dev_ak4535;
34
35 /* codec private data */
36 struct ak4535_priv {
37         unsigned int sysclk;
38 };
39
40 /*
41  * ak4535 register cache
42  */
43 static const u16 ak4535_reg[AK4535_CACHEREGNUM] = {
44     0x0000, 0x0080, 0x0000, 0x0003,
45     0x0002, 0x0000, 0x0011, 0x0001,
46     0x0000, 0x0040, 0x0036, 0x0010,
47     0x0000, 0x0000, 0x0057, 0x0000,
48 };
49
50 /*
51  * read ak4535 register cache
52  */
53 static inline unsigned int ak4535_read_reg_cache(struct snd_soc_codec *codec,
54         unsigned int reg)
55 {
56         u16 *cache = codec->reg_cache;
57         if (reg >= AK4535_CACHEREGNUM)
58                 return -1;
59         return cache[reg];
60 }
61
62 /*
63  * write ak4535 register cache
64  */
65 static inline void ak4535_write_reg_cache(struct snd_soc_codec *codec,
66         u16 reg, unsigned int value)
67 {
68         u16 *cache = codec->reg_cache;
69         if (reg >= AK4535_CACHEREGNUM)
70                 return;
71         cache[reg] = value;
72 }
73
74 /*
75  * write to the AK4535 register space
76  */
77 static int ak4535_write(struct snd_soc_codec *codec, unsigned int reg,
78         unsigned int value)
79 {
80         u8 data[2];
81
82         /* data is
83          *   D15..D8 AK4535 register offset
84          *   D7...D0 register data
85          */
86         data[0] = reg & 0xff;
87         data[1] = value & 0xff;
88
89         ak4535_write_reg_cache(codec, reg, value);
90         if (codec->hw_write(codec->control_data, data, 2) == 2)
91                 return 0;
92         else
93                 return -EIO;
94 }
95
96 static int ak4535_sync(struct snd_soc_codec *codec)
97 {
98         u16 *cache = codec->reg_cache;
99         int i, r = 0;
100
101         for (i = 0; i < AK4535_CACHEREGNUM; i++)
102                 r |= ak4535_write(codec, i, cache[i]);
103
104         return r;
105 };
106
107 static const char *ak4535_mono_gain[] = {"+6dB", "-17dB"};
108 static const char *ak4535_mono_out[] = {"(L + R)/2", "Hi-Z"};
109 static const char *ak4535_hp_out[] = {"Stereo", "Mono"};
110 static const char *ak4535_deemp[] = {"44.1kHz", "Off", "48kHz", "32kHz"};
111 static const char *ak4535_mic_select[] = {"Internal", "External"};
112
113 static const struct soc_enum ak4535_enum[] = {
114         SOC_ENUM_SINGLE(AK4535_SIG1, 7, 2, ak4535_mono_gain),
115         SOC_ENUM_SINGLE(AK4535_SIG1, 6, 2, ak4535_mono_out),
116         SOC_ENUM_SINGLE(AK4535_MODE2, 2, 2, ak4535_hp_out),
117         SOC_ENUM_SINGLE(AK4535_DAC, 0, 4, ak4535_deemp),
118         SOC_ENUM_SINGLE(AK4535_MIC, 1, 2, ak4535_mic_select),
119 };
120
121 static const struct snd_kcontrol_new ak4535_snd_controls[] = {
122         SOC_SINGLE("ALC2 Switch", AK4535_SIG1, 1, 1, 0),
123         SOC_ENUM("Mono 1 Output", ak4535_enum[1]),
124         SOC_ENUM("Mono 1 Gain", ak4535_enum[0]),
125         SOC_ENUM("Headphone Output", ak4535_enum[2]),
126         SOC_ENUM("Playback Deemphasis", ak4535_enum[3]),
127         SOC_SINGLE("Bass Volume", AK4535_DAC, 2, 3, 0),
128         SOC_SINGLE("Mic Boost (+20dB) Switch", AK4535_MIC, 0, 1, 0),
129         SOC_ENUM("Mic Select", ak4535_enum[4]),
130         SOC_SINGLE("ALC Operation Time", AK4535_TIMER, 0, 3, 0),
131         SOC_SINGLE("ALC Recovery Time", AK4535_TIMER, 2, 3, 0),
132         SOC_SINGLE("ALC ZC Time", AK4535_TIMER, 4, 3, 0),
133         SOC_SINGLE("ALC 1 Switch", AK4535_ALC1, 5, 1, 0),
134         SOC_SINGLE("ALC 2 Switch", AK4535_ALC1, 6, 1, 0),
135         SOC_SINGLE("ALC Volume", AK4535_ALC2, 0, 127, 0),
136         SOC_SINGLE("Capture Volume", AK4535_PGA, 0, 127, 0),
137         SOC_SINGLE("Left Playback Volume", AK4535_LATT, 0, 127, 1),
138         SOC_SINGLE("Right Playback Volume", AK4535_RATT, 0, 127, 1),
139         SOC_SINGLE("AUX Bypass Volume", AK4535_VOL, 0, 15, 0),
140         SOC_SINGLE("Mic Sidetone Volume", AK4535_VOL, 4, 7, 0),
141 };
142
143 /* Mono 1 Mixer */
144 static const struct snd_kcontrol_new ak4535_mono1_mixer_controls[] = {
145         SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG1, 4, 1, 0),
146         SOC_DAPM_SINGLE("Mono Playback Switch", AK4535_SIG1, 5, 1, 0),
147 };
148
149 /* Stereo Mixer */
150 static const struct snd_kcontrol_new ak4535_stereo_mixer_controls[] = {
151         SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG2, 4, 1, 0),
152         SOC_DAPM_SINGLE("Playback Switch", AK4535_SIG2, 7, 1, 0),
153         SOC_DAPM_SINGLE("Aux Bypass Switch", AK4535_SIG2, 5, 1, 0),
154 };
155
156 /* Input Mixer */
157 static const struct snd_kcontrol_new ak4535_input_mixer_controls[] = {
158         SOC_DAPM_SINGLE("Mic Capture Switch", AK4535_MIC, 2, 1, 0),
159         SOC_DAPM_SINGLE("Aux Capture Switch", AK4535_MIC, 5, 1, 0),
160 };
161
162 /* Input mux */
163 static const struct snd_kcontrol_new ak4535_input_mux_control =
164         SOC_DAPM_ENUM("Input Select", ak4535_enum[4]);
165
166 /* HP L switch */
167 static const struct snd_kcontrol_new ak4535_hpl_control =
168         SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 1, 1, 1);
169
170 /* HP R switch */
171 static const struct snd_kcontrol_new ak4535_hpr_control =
172         SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 0, 1, 1);
173
174 /* mono 2 switch */
175 static const struct snd_kcontrol_new ak4535_mono2_control =
176         SOC_DAPM_SINGLE("Switch", AK4535_SIG1, 0, 1, 0);
177
178 /* Line out switch */
179 static const struct snd_kcontrol_new ak4535_line_control =
180         SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 6, 1, 0);
181
182 /* ak4535 dapm widgets */
183 static const struct snd_soc_dapm_widget ak4535_dapm_widgets[] = {
184         SND_SOC_DAPM_MIXER("Stereo Mixer", SND_SOC_NOPM, 0, 0,
185                 &ak4535_stereo_mixer_controls[0],
186                 ARRAY_SIZE(ak4535_stereo_mixer_controls)),
187         SND_SOC_DAPM_MIXER("Mono1 Mixer", SND_SOC_NOPM, 0, 0,
188                 &ak4535_mono1_mixer_controls[0],
189                 ARRAY_SIZE(ak4535_mono1_mixer_controls)),
190         SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0,
191                 &ak4535_input_mixer_controls[0],
192                 ARRAY_SIZE(ak4535_input_mixer_controls)),
193         SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0,
194                 &ak4535_input_mux_control),
195         SND_SOC_DAPM_DAC("DAC", "Playback", AK4535_PM2, 0, 0),
196         SND_SOC_DAPM_SWITCH("Mono 2 Enable", SND_SOC_NOPM, 0, 0,
197                 &ak4535_mono2_control),
198         /* speaker powersave bit */
199         SND_SOC_DAPM_PGA("Speaker Enable", AK4535_MODE2, 0, 0, NULL, 0),
200         SND_SOC_DAPM_SWITCH("Line Out Enable", SND_SOC_NOPM, 0, 0,
201                 &ak4535_line_control),
202         SND_SOC_DAPM_SWITCH("Left HP Enable", SND_SOC_NOPM, 0, 0,
203                 &ak4535_hpl_control),
204         SND_SOC_DAPM_SWITCH("Right HP Enable", SND_SOC_NOPM, 0, 0,
205                 &ak4535_hpr_control),
206         SND_SOC_DAPM_OUTPUT("LOUT"),
207         SND_SOC_DAPM_OUTPUT("HPL"),
208         SND_SOC_DAPM_OUTPUT("ROUT"),
209         SND_SOC_DAPM_OUTPUT("HPR"),
210         SND_SOC_DAPM_OUTPUT("SPP"),
211         SND_SOC_DAPM_OUTPUT("SPN"),
212         SND_SOC_DAPM_OUTPUT("MOUT1"),
213         SND_SOC_DAPM_OUTPUT("MOUT2"),
214         SND_SOC_DAPM_OUTPUT("MICOUT"),
215         SND_SOC_DAPM_ADC("ADC", "Capture", AK4535_PM1, 0, 0),
216         SND_SOC_DAPM_PGA("Spk Amp", AK4535_PM2, 3, 0, NULL, 0),
217         SND_SOC_DAPM_PGA("HP R Amp", AK4535_PM2, 1, 0, NULL, 0),
218         SND_SOC_DAPM_PGA("HP L Amp", AK4535_PM2, 2, 0, NULL, 0),
219         SND_SOC_DAPM_PGA("Mic", AK4535_PM1, 1, 0, NULL, 0),
220         SND_SOC_DAPM_PGA("Line Out", AK4535_PM1, 4, 0, NULL, 0),
221         SND_SOC_DAPM_PGA("Mono Out", AK4535_PM1, 3, 0, NULL, 0),
222         SND_SOC_DAPM_PGA("AUX In", AK4535_PM1, 2, 0, NULL, 0),
223
224         SND_SOC_DAPM_MICBIAS("Mic Int Bias", AK4535_MIC, 3, 0),
225         SND_SOC_DAPM_MICBIAS("Mic Ext Bias", AK4535_MIC, 4, 0),
226         SND_SOC_DAPM_INPUT("MICIN"),
227         SND_SOC_DAPM_INPUT("MICEXT"),
228         SND_SOC_DAPM_INPUT("AUX"),
229         SND_SOC_DAPM_INPUT("MIN"),
230         SND_SOC_DAPM_INPUT("AIN"),
231 };
232
233 static const struct snd_soc_dapm_route audio_map[] = {
234         /*stereo mixer */
235         {"Stereo Mixer", "Playback Switch", "DAC"},
236         {"Stereo Mixer", "Mic Sidetone Switch", "Mic"},
237         {"Stereo Mixer", "Aux Bypass Switch", "AUX In"},
238
239         /* mono1 mixer */
240         {"Mono1 Mixer", "Mic Sidetone Switch", "Mic"},
241         {"Mono1 Mixer", "Mono Playback Switch", "DAC"},
242
243         /* Mic */
244         {"Mic", NULL, "AIN"},
245         {"Input Mux", "Internal", "Mic Int Bias"},
246         {"Input Mux", "External", "Mic Ext Bias"},
247         {"Mic Int Bias", NULL, "MICIN"},
248         {"Mic Ext Bias", NULL, "MICEXT"},
249         {"MICOUT", NULL, "Input Mux"},
250
251         /* line out */
252         {"LOUT", NULL, "Line Out Enable"},
253         {"ROUT", NULL, "Line Out Enable"},
254         {"Line Out Enable", "Switch", "Line Out"},
255         {"Line Out", NULL, "Stereo Mixer"},
256
257         /* mono1 out */
258         {"MOUT1", NULL, "Mono Out"},
259         {"Mono Out", NULL, "Mono1 Mixer"},
260
261         /* left HP */
262         {"HPL", NULL, "Left HP Enable"},
263         {"Left HP Enable", "Switch", "HP L Amp"},
264         {"HP L Amp", NULL, "Stereo Mixer"},
265
266         /* right HP */
267         {"HPR", NULL, "Right HP Enable"},
268         {"Right HP Enable", "Switch", "HP R Amp"},
269         {"HP R Amp", NULL, "Stereo Mixer"},
270
271         /* speaker */
272         {"SPP", NULL, "Speaker Enable"},
273         {"SPN", NULL, "Speaker Enable"},
274         {"Speaker Enable", "Switch", "Spk Amp"},
275         {"Spk Amp", NULL, "MIN"},
276
277         /* mono 2 */
278         {"MOUT2", NULL, "Mono 2 Enable"},
279         {"Mono 2 Enable", "Switch", "Stereo Mixer"},
280
281         /* Aux In */
282         {"Aux In", NULL, "AUX"},
283
284         /* ADC */
285         {"ADC", NULL, "Input Mixer"},
286         {"Input Mixer", "Mic Capture Switch", "Mic"},
287         {"Input Mixer", "Aux Capture Switch", "Aux In"},
288 };
289
290 static int ak4535_add_widgets(struct snd_soc_codec *codec)
291 {
292         snd_soc_dapm_new_controls(codec, ak4535_dapm_widgets,
293                                   ARRAY_SIZE(ak4535_dapm_widgets));
294
295         snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
296
297         snd_soc_dapm_new_widgets(codec);
298         return 0;
299 }
300
301 static int ak4535_set_dai_sysclk(struct snd_soc_dai *codec_dai,
302         int clk_id, unsigned int freq, int dir)
303 {
304         struct snd_soc_codec *codec = codec_dai->codec;
305         struct ak4535_priv *ak4535 = codec->private_data;
306
307         ak4535->sysclk = freq;
308         return 0;
309 }
310
311 static int ak4535_hw_params(struct snd_pcm_substream *substream,
312                             struct snd_pcm_hw_params *params,
313                             struct snd_soc_dai *dai)
314 {
315         struct snd_soc_pcm_runtime *rtd = substream->private_data;
316         struct snd_soc_device *socdev = rtd->socdev;
317         struct snd_soc_codec *codec = socdev->card->codec;
318         struct ak4535_priv *ak4535 = codec->private_data;
319         u8 mode2 = ak4535_read_reg_cache(codec, AK4535_MODE2) & ~(0x3 << 5);
320         int rate = params_rate(params), fs = 256;
321
322         if (rate)
323                 fs = ak4535->sysclk / rate;
324
325         /* set fs */
326         switch (fs) {
327         case 1024:
328                 mode2 |= (0x2 << 5);
329                 break;
330         case 512:
331                 mode2 |= (0x1 << 5);
332                 break;
333         case 256:
334                 break;
335         }
336
337         /* set rate */
338         ak4535_write(codec, AK4535_MODE2, mode2);
339         return 0;
340 }
341
342 static int ak4535_set_dai_fmt(struct snd_soc_dai *codec_dai,
343                 unsigned int fmt)
344 {
345         struct snd_soc_codec *codec = codec_dai->codec;
346         u8 mode1 = 0;
347
348         /* interface format */
349         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
350         case SND_SOC_DAIFMT_I2S:
351                 mode1 = 0x0002;
352                 break;
353         case SND_SOC_DAIFMT_LEFT_J:
354                 mode1 = 0x0001;
355                 break;
356         default:
357                 return -EINVAL;
358         }
359
360         /* use 32 fs for BCLK to save power */
361         mode1 |= 0x4;
362
363         ak4535_write(codec, AK4535_MODE1, mode1);
364         return 0;
365 }
366
367 static int ak4535_mute(struct snd_soc_dai *dai, int mute)
368 {
369         struct snd_soc_codec *codec = dai->codec;
370         u16 mute_reg = ak4535_read_reg_cache(codec, AK4535_DAC) & 0xffdf;
371         if (!mute)
372                 ak4535_write(codec, AK4535_DAC, mute_reg);
373         else
374                 ak4535_write(codec, AK4535_DAC, mute_reg | 0x20);
375         return 0;
376 }
377
378 static int ak4535_set_bias_level(struct snd_soc_codec *codec,
379         enum snd_soc_bias_level level)
380 {
381         u16 i;
382
383         switch (level) {
384         case SND_SOC_BIAS_ON:
385                 ak4535_mute(codec->dai, 0);
386                 break;
387         case SND_SOC_BIAS_PREPARE:
388                 ak4535_mute(codec->dai, 1);
389                 break;
390         case SND_SOC_BIAS_STANDBY:
391                 i = ak4535_read_reg_cache(codec, AK4535_PM1);
392                 ak4535_write(codec, AK4535_PM1, i | 0x80);
393                 i = ak4535_read_reg_cache(codec, AK4535_PM2);
394                 ak4535_write(codec, AK4535_PM2, i & (~0x80));
395                 break;
396         case SND_SOC_BIAS_OFF:
397                 i = ak4535_read_reg_cache(codec, AK4535_PM1);
398                 ak4535_write(codec, AK4535_PM1, i & (~0x80));
399                 break;
400         }
401         codec->bias_level = level;
402         return 0;
403 }
404
405 #define AK4535_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
406                 SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
407                 SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)
408
409 static struct snd_soc_dai_ops ak4535_dai_ops = {
410         .hw_params      = ak4535_hw_params,
411         .set_fmt        = ak4535_set_dai_fmt,
412         .digital_mute   = ak4535_mute,
413         .set_sysclk     = ak4535_set_dai_sysclk,
414 };
415
416 struct snd_soc_dai ak4535_dai = {
417         .name = "AK4535",
418         .playback = {
419                 .stream_name = "Playback",
420                 .channels_min = 1,
421                 .channels_max = 2,
422                 .rates = AK4535_RATES,
423                 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
424         .capture = {
425                 .stream_name = "Capture",
426                 .channels_min = 1,
427                 .channels_max = 2,
428                 .rates = AK4535_RATES,
429                 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
430         .ops = &ak4535_dai_ops,
431 };
432 EXPORT_SYMBOL_GPL(ak4535_dai);
433
434 static int ak4535_suspend(struct platform_device *pdev, pm_message_t state)
435 {
436         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
437         struct snd_soc_codec *codec = socdev->card->codec;
438
439         ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);
440         return 0;
441 }
442
443 static int ak4535_resume(struct platform_device *pdev)
444 {
445         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
446         struct snd_soc_codec *codec = socdev->card->codec;
447         ak4535_sync(codec);
448         ak4535_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
449         ak4535_set_bias_level(codec, codec->suspend_bias_level);
450         return 0;
451 }
452
453 /*
454  * initialise the AK4535 driver
455  * register the mixer and dsp interfaces with the kernel
456  */
457 static int ak4535_init(struct snd_soc_device *socdev)
458 {
459         struct snd_soc_codec *codec = socdev->card->codec;
460         int ret = 0;
461
462         codec->name = "AK4535";
463         codec->owner = THIS_MODULE;
464         codec->read = ak4535_read_reg_cache;
465         codec->write = ak4535_write;
466         codec->set_bias_level = ak4535_set_bias_level;
467         codec->dai = &ak4535_dai;
468         codec->num_dai = 1;
469         codec->reg_cache_size = ARRAY_SIZE(ak4535_reg);
470         codec->reg_cache = kmemdup(ak4535_reg, sizeof(ak4535_reg), GFP_KERNEL);
471
472         if (codec->reg_cache == NULL)
473                 return -ENOMEM;
474
475         /* register pcms */
476         ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
477         if (ret < 0) {
478                 printk(KERN_ERR "ak4535: failed to create pcms\n");
479                 goto pcm_err;
480         }
481
482         /* power on device */
483         ak4535_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
484
485         snd_soc_add_controls(codec, ak4535_snd_controls,
486                                 ARRAY_SIZE(ak4535_snd_controls));
487         ak4535_add_widgets(codec);
488         ret = snd_soc_init_card(socdev);
489         if (ret < 0) {
490                 printk(KERN_ERR "ak4535: failed to register card\n");
491                 goto card_err;
492         }
493
494         return ret;
495
496 card_err:
497         snd_soc_free_pcms(socdev);
498         snd_soc_dapm_free(socdev);
499 pcm_err:
500         kfree(codec->reg_cache);
501
502         return ret;
503 }
504
505 static struct snd_soc_device *ak4535_socdev;
506
507 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
508
509 static int ak4535_i2c_probe(struct i2c_client *i2c,
510                             const struct i2c_device_id *id)
511 {
512         struct snd_soc_device *socdev = ak4535_socdev;
513         struct snd_soc_codec *codec = socdev->card->codec;
514         int ret;
515
516         i2c_set_clientdata(i2c, codec);
517         codec->control_data = i2c;
518
519         ret = ak4535_init(socdev);
520         if (ret < 0)
521                 printk(KERN_ERR "failed to initialise AK4535\n");
522
523         return ret;
524 }
525
526 static int ak4535_i2c_remove(struct i2c_client *client)
527 {
528         struct snd_soc_codec *codec = i2c_get_clientdata(client);
529         kfree(codec->reg_cache);
530         return 0;
531 }
532
533 static const struct i2c_device_id ak4535_i2c_id[] = {
534         { "ak4535", 0 },
535         { }
536 };
537 MODULE_DEVICE_TABLE(i2c, ak4535_i2c_id);
538
539 static struct i2c_driver ak4535_i2c_driver = {
540         .driver = {
541                 .name = "AK4535 I2C Codec",
542                 .owner = THIS_MODULE,
543         },
544         .probe =    ak4535_i2c_probe,
545         .remove =   ak4535_i2c_remove,
546         .id_table = ak4535_i2c_id,
547 };
548
549 static int ak4535_add_i2c_device(struct platform_device *pdev,
550                                  const struct ak4535_setup_data *setup)
551 {
552         struct i2c_board_info info;
553         struct i2c_adapter *adapter;
554         struct i2c_client *client;
555         int ret;
556
557         ret = i2c_add_driver(&ak4535_i2c_driver);
558         if (ret != 0) {
559                 dev_err(&pdev->dev, "can't add i2c driver\n");
560                 return ret;
561         }
562
563         memset(&info, 0, sizeof(struct i2c_board_info));
564         info.addr = setup->i2c_address;
565         strlcpy(info.type, "ak4535", I2C_NAME_SIZE);
566
567         adapter = i2c_get_adapter(setup->i2c_bus);
568         if (!adapter) {
569                 dev_err(&pdev->dev, "can't get i2c adapter %d\n",
570                         setup->i2c_bus);
571                 goto err_driver;
572         }
573
574         client = i2c_new_device(adapter, &info);
575         i2c_put_adapter(adapter);
576         if (!client) {
577                 dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
578                         (unsigned int)info.addr);
579                 goto err_driver;
580         }
581
582         return 0;
583
584 err_driver:
585         i2c_del_driver(&ak4535_i2c_driver);
586         return -ENODEV;
587 }
588 #endif
589
590 static int ak4535_probe(struct platform_device *pdev)
591 {
592         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
593         struct ak4535_setup_data *setup;
594         struct snd_soc_codec *codec;
595         struct ak4535_priv *ak4535;
596         int ret;
597
598         printk(KERN_INFO "AK4535 Audio Codec %s", AK4535_VERSION);
599
600         setup = socdev->codec_data;
601         codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
602         if (codec == NULL)
603                 return -ENOMEM;
604
605         ak4535 = kzalloc(sizeof(struct ak4535_priv), GFP_KERNEL);
606         if (ak4535 == NULL) {
607                 kfree(codec);
608                 return -ENOMEM;
609         }
610
611         codec->private_data = ak4535;
612         socdev->card->codec = codec;
613         mutex_init(&codec->mutex);
614         INIT_LIST_HEAD(&codec->dapm_widgets);
615         INIT_LIST_HEAD(&codec->dapm_paths);
616
617         ak4535_socdev = socdev;
618         ret = -ENODEV;
619
620 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
621         if (setup->i2c_address) {
622                 codec->hw_write = (hw_write_t)i2c_master_send;
623                 ret = ak4535_add_i2c_device(pdev, setup);
624         }
625 #endif
626
627         if (ret != 0) {
628                 kfree(codec->private_data);
629                 kfree(codec);
630         }
631         return ret;
632 }
633
634 /* power down chip */
635 static int ak4535_remove(struct platform_device *pdev)
636 {
637         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
638         struct snd_soc_codec *codec = socdev->card->codec;
639
640         if (codec->control_data)
641                 ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);
642
643         snd_soc_free_pcms(socdev);
644         snd_soc_dapm_free(socdev);
645 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
646         if (codec->control_data)
647                 i2c_unregister_device(codec->control_data);
648         i2c_del_driver(&ak4535_i2c_driver);
649 #endif
650         kfree(codec->private_data);
651         kfree(codec);
652
653         return 0;
654 }
655
656 struct snd_soc_codec_device soc_codec_dev_ak4535 = {
657         .probe =        ak4535_probe,
658         .remove =       ak4535_remove,
659         .suspend =      ak4535_suspend,
660         .resume =       ak4535_resume,
661 };
662 EXPORT_SYMBOL_GPL(soc_codec_dev_ak4535);
663
664 static int __init ak4535_modinit(void)
665 {
666         return snd_soc_register_dai(&ak4535_dai);
667 }
668 module_init(ak4535_modinit);
669
670 static void __exit ak4535_exit(void)
671 {
672         snd_soc_unregister_dai(&ak4535_dai);
673 }
674 module_exit(ak4535_exit);
675
676 MODULE_DESCRIPTION("Soc AK4535 driver");
677 MODULE_AUTHOR("Richard Purdie");
678 MODULE_LICENSE("GPL");