Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
awilliam
GitHub Repository: awilliam/linux-vfio
Path: blob/master/sound/soc/codecs/da7210.c
10817 views
1
/*
2
* DA7210 ALSA Soc codec driver
3
*
4
* Copyright (c) 2009 Dialog Semiconductor
5
* Written by David Chen <[email protected]>
6
*
7
* Copyright (C) 2009 Renesas Solutions Corp.
8
* Cleanups by Kuninori Morimoto <[email protected]>
9
*
10
* Tested on SuperH Ecovec24 board with S16/S24 LE in 48KHz using I2S
11
*
12
* This program is free software; you can redistribute it and/or modify it
13
* under the terms of the GNU General Public License as published by the
14
* Free Software Foundation; either version 2 of the License, or (at your
15
* option) any later version.
16
*/
17
18
#include <linux/delay.h>
19
#include <linux/i2c.h>
20
#include <linux/platform_device.h>
21
#include <linux/slab.h>
22
#include <sound/pcm.h>
23
#include <sound/pcm_params.h>
24
#include <sound/soc.h>
25
#include <sound/initval.h>
26
#include <sound/tlv.h>
27
28
/* DA7210 register space */
29
#define DA7210_STATUS 0x02
30
#define DA7210_STARTUP1 0x03
31
#define DA7210_MIC_L 0x07
32
#define DA7210_MIC_R 0x08
33
#define DA7210_INMIX_L 0x0D
34
#define DA7210_INMIX_R 0x0E
35
#define DA7210_ADC_HPF 0x0F
36
#define DA7210_ADC 0x10
37
#define DA7210_DAC_HPF 0x14
38
#define DA7210_DAC_L 0x15
39
#define DA7210_DAC_R 0x16
40
#define DA7210_DAC_SEL 0x17
41
#define DA7210_OUTMIX_L 0x1C
42
#define DA7210_OUTMIX_R 0x1D
43
#define DA7210_HP_L_VOL 0x21
44
#define DA7210_HP_R_VOL 0x22
45
#define DA7210_HP_CFG 0x23
46
#define DA7210_DAI_SRC_SEL 0x25
47
#define DA7210_DAI_CFG1 0x26
48
#define DA7210_DAI_CFG3 0x28
49
#define DA7210_PLL_DIV1 0x29
50
#define DA7210_PLL_DIV2 0x2A
51
#define DA7210_PLL_DIV3 0x2B
52
#define DA7210_PLL 0x2C
53
#define DA7210_A_HID_UNLOCK 0x8A
54
#define DA7210_A_TEST_UNLOCK 0x8B
55
#define DA7210_A_PLL1 0x90
56
#define DA7210_A_CP_MODE 0xA7
57
58
/* STARTUP1 bit fields */
59
#define DA7210_SC_MST_EN (1 << 0)
60
61
/* MIC_L bit fields */
62
#define DA7210_MICBIAS_EN (1 << 6)
63
#define DA7210_MIC_L_EN (1 << 7)
64
65
/* MIC_R bit fields */
66
#define DA7210_MIC_R_EN (1 << 7)
67
68
/* INMIX_L bit fields */
69
#define DA7210_IN_L_EN (1 << 7)
70
71
/* INMIX_R bit fields */
72
#define DA7210_IN_R_EN (1 << 7)
73
74
/* ADC bit fields */
75
#define DA7210_ADC_L_EN (1 << 3)
76
#define DA7210_ADC_R_EN (1 << 7)
77
78
/* DAC/ADC HPF fields */
79
#define DA7210_VOICE_F0_MASK (0x7 << 4)
80
#define DA7210_VOICE_F0_25 (1 << 4)
81
#define DA7210_VOICE_EN (1 << 7)
82
83
/* DAC_SEL bit fields */
84
#define DA7210_DAC_L_SRC_DAI_L (4 << 0)
85
#define DA7210_DAC_L_EN (1 << 3)
86
#define DA7210_DAC_R_SRC_DAI_R (5 << 4)
87
#define DA7210_DAC_R_EN (1 << 7)
88
89
/* OUTMIX_L bit fields */
90
#define DA7210_OUT_L_EN (1 << 7)
91
92
/* OUTMIX_R bit fields */
93
#define DA7210_OUT_R_EN (1 << 7)
94
95
/* HP_CFG bit fields */
96
#define DA7210_HP_2CAP_MODE (1 << 1)
97
#define DA7210_HP_SENSE_EN (1 << 2)
98
#define DA7210_HP_L_EN (1 << 3)
99
#define DA7210_HP_MODE (1 << 6)
100
#define DA7210_HP_R_EN (1 << 7)
101
102
/* DAI_SRC_SEL bit fields */
103
#define DA7210_DAI_OUT_L_SRC (6 << 0)
104
#define DA7210_DAI_OUT_R_SRC (7 << 4)
105
106
/* DAI_CFG1 bit fields */
107
#define DA7210_DAI_WORD_S16_LE (0 << 0)
108
#define DA7210_DAI_WORD_S24_LE (2 << 0)
109
#define DA7210_DAI_FLEN_64BIT (1 << 2)
110
#define DA7210_DAI_MODE_MASTER (1 << 7)
111
112
/* DAI_CFG3 bit fields */
113
#define DA7210_DAI_FORMAT_I2SMODE (0 << 0)
114
#define DA7210_DAI_OE (1 << 3)
115
#define DA7210_DAI_EN (1 << 7)
116
117
/*PLL_DIV3 bit fields */
118
#define DA7210_MCLK_RANGE_10_20_MHZ (1 << 4)
119
#define DA7210_PLL_BYP (1 << 6)
120
121
/* PLL bit fields */
122
#define DA7210_PLL_FS_MASK (0xF << 0)
123
#define DA7210_PLL_FS_8000 (0x1 << 0)
124
#define DA7210_PLL_FS_11025 (0x2 << 0)
125
#define DA7210_PLL_FS_12000 (0x3 << 0)
126
#define DA7210_PLL_FS_16000 (0x5 << 0)
127
#define DA7210_PLL_FS_22050 (0x6 << 0)
128
#define DA7210_PLL_FS_24000 (0x7 << 0)
129
#define DA7210_PLL_FS_32000 (0x9 << 0)
130
#define DA7210_PLL_FS_44100 (0xA << 0)
131
#define DA7210_PLL_FS_48000 (0xB << 0)
132
#define DA7210_PLL_FS_88200 (0xE << 0)
133
#define DA7210_PLL_FS_96000 (0xF << 0)
134
#define DA7210_PLL_EN (0x1 << 7)
135
136
#define DA7210_VERSION "0.0.1"
137
138
/*
139
* Playback Volume
140
*
141
* max : 0x3F (+15.0 dB)
142
* (1.5 dB step)
143
* min : 0x11 (-54.0 dB)
144
* mute : 0x10
145
* reserved : 0x00 - 0x0F
146
*
147
* ** FIXME **
148
*
149
* Reserved area are considered as "mute".
150
* -> min = -79.5 dB
151
*/
152
static const DECLARE_TLV_DB_SCALE(hp_out_tlv, -7950, 150, 1);
153
154
static const struct snd_kcontrol_new da7210_snd_controls[] = {
155
156
SOC_DOUBLE_R_TLV("HeadPhone Playback Volume",
157
DA7210_HP_L_VOL, DA7210_HP_R_VOL,
158
0, 0x3F, 0, hp_out_tlv),
159
};
160
161
/* Codec private data */
162
struct da7210_priv {
163
enum snd_soc_control_type control_type;
164
void *control_data;
165
};
166
167
/*
168
* Register cache
169
*/
170
static const u8 da7210_reg[] = {
171
0x00, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R0 - R7 */
172
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, /* R8 - RF */
173
0x00, 0x00, 0x00, 0x00, 0x08, 0x10, 0x10, 0x54, /* R10 - R17 */
174
0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R18 - R1F */
175
0x00, 0x00, 0x00, 0x02, 0x00, 0x76, 0x00, 0x00, /* R20 - R27 */
176
0x04, 0x00, 0x00, 0x30, 0x2A, 0x00, 0x40, 0x00, /* R28 - R2F */
177
0x40, 0x00, 0x40, 0x00, 0x40, 0x00, 0x40, 0x00, /* R30 - R37 */
178
0x40, 0x00, 0x40, 0x00, 0x40, 0x00, 0x00, 0x00, /* R38 - R3F */
179
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R40 - R4F */
180
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R48 - R4F */
181
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R50 - R57 */
182
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R58 - R5F */
183
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R60 - R67 */
184
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R68 - R6F */
185
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* R70 - R77 */
186
0x00, 0x00, 0x00, 0x00, 0x00, 0x54, 0x54, 0x00, /* R78 - R7F */
187
0x00, 0x00, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, /* R80 - R87 */
188
0x00, /* R88 */
189
};
190
191
/*
192
* Read da7210 register cache
193
*/
194
static inline u32 da7210_read_reg_cache(struct snd_soc_codec *codec, u32 reg)
195
{
196
u8 *cache = codec->reg_cache;
197
BUG_ON(reg >= ARRAY_SIZE(da7210_reg));
198
return cache[reg];
199
}
200
201
/*
202
* Write to the da7210 register space
203
*/
204
static int da7210_write(struct snd_soc_codec *codec, u32 reg, u32 value)
205
{
206
u8 *cache = codec->reg_cache;
207
u8 data[2];
208
209
BUG_ON(codec->driver->volatile_register);
210
211
data[0] = reg & 0xff;
212
data[1] = value & 0xff;
213
214
if (reg >= codec->driver->reg_cache_size)
215
return -EIO;
216
217
if (2 != codec->hw_write(codec->control_data, data, 2))
218
return -EIO;
219
220
cache[reg] = value;
221
return 0;
222
}
223
224
/*
225
* Read from the da7210 register space.
226
*/
227
static inline u32 da7210_read(struct snd_soc_codec *codec, u32 reg)
228
{
229
if (DA7210_STATUS == reg)
230
return i2c_smbus_read_byte_data(codec->control_data, reg);
231
232
return da7210_read_reg_cache(codec, reg);
233
}
234
235
static int da7210_startup(struct snd_pcm_substream *substream,
236
struct snd_soc_dai *dai)
237
{
238
int is_play = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
239
struct snd_soc_codec *codec = dai->codec;
240
241
if (is_play) {
242
/* Enable Out */
243
snd_soc_update_bits(codec, DA7210_OUTMIX_L, 0x1F, 0x10);
244
snd_soc_update_bits(codec, DA7210_OUTMIX_R, 0x1F, 0x10);
245
246
} else {
247
/* Volume 7 */
248
snd_soc_update_bits(codec, DA7210_MIC_L, 0x7, 0x7);
249
snd_soc_update_bits(codec, DA7210_MIC_R, 0x7, 0x7);
250
251
/* Enable Mic */
252
snd_soc_update_bits(codec, DA7210_INMIX_L, 0x1F, 0x1);
253
snd_soc_update_bits(codec, DA7210_INMIX_R, 0x1F, 0x1);
254
}
255
256
return 0;
257
}
258
259
/*
260
* Set PCM DAI word length.
261
*/
262
static int da7210_hw_params(struct snd_pcm_substream *substream,
263
struct snd_pcm_hw_params *params,
264
struct snd_soc_dai *dai)
265
{
266
struct snd_soc_pcm_runtime *rtd = substream->private_data;
267
struct snd_soc_codec *codec = rtd->codec;
268
u32 dai_cfg1;
269
u32 hpf_reg, hpf_mask, hpf_value;
270
u32 fs, bypass;
271
272
/* set DAI source to Left and Right ADC */
273
da7210_write(codec, DA7210_DAI_SRC_SEL,
274
DA7210_DAI_OUT_R_SRC | DA7210_DAI_OUT_L_SRC);
275
276
/* Enable DAI */
277
da7210_write(codec, DA7210_DAI_CFG3, DA7210_DAI_OE | DA7210_DAI_EN);
278
279
dai_cfg1 = 0xFC & da7210_read(codec, DA7210_DAI_CFG1);
280
281
switch (params_format(params)) {
282
case SNDRV_PCM_FORMAT_S16_LE:
283
dai_cfg1 |= DA7210_DAI_WORD_S16_LE;
284
break;
285
case SNDRV_PCM_FORMAT_S24_LE:
286
dai_cfg1 |= DA7210_DAI_WORD_S24_LE;
287
break;
288
default:
289
return -EINVAL;
290
}
291
292
da7210_write(codec, DA7210_DAI_CFG1, dai_cfg1);
293
294
hpf_reg = (SNDRV_PCM_STREAM_PLAYBACK == substream->stream) ?
295
DA7210_DAC_HPF : DA7210_ADC_HPF;
296
297
switch (params_rate(params)) {
298
case 8000:
299
fs = DA7210_PLL_FS_8000;
300
hpf_mask = DA7210_VOICE_F0_MASK | DA7210_VOICE_EN;
301
hpf_value = DA7210_VOICE_F0_25 | DA7210_VOICE_EN;
302
bypass = DA7210_PLL_BYP;
303
break;
304
case 11025:
305
fs = DA7210_PLL_FS_11025;
306
hpf_mask = DA7210_VOICE_F0_MASK | DA7210_VOICE_EN;
307
hpf_value = DA7210_VOICE_F0_25 | DA7210_VOICE_EN;
308
bypass = 0;
309
break;
310
case 12000:
311
fs = DA7210_PLL_FS_12000;
312
hpf_mask = DA7210_VOICE_F0_MASK | DA7210_VOICE_EN;
313
hpf_value = DA7210_VOICE_F0_25 | DA7210_VOICE_EN;
314
bypass = DA7210_PLL_BYP;
315
break;
316
case 16000:
317
fs = DA7210_PLL_FS_16000;
318
hpf_mask = DA7210_VOICE_F0_MASK | DA7210_VOICE_EN;
319
hpf_value = DA7210_VOICE_F0_25 | DA7210_VOICE_EN;
320
bypass = DA7210_PLL_BYP;
321
break;
322
case 22050:
323
fs = DA7210_PLL_FS_22050;
324
hpf_mask = DA7210_VOICE_EN;
325
hpf_value = 0;
326
bypass = 0;
327
break;
328
case 32000:
329
fs = DA7210_PLL_FS_32000;
330
hpf_mask = DA7210_VOICE_EN;
331
hpf_value = 0;
332
bypass = DA7210_PLL_BYP;
333
break;
334
case 44100:
335
fs = DA7210_PLL_FS_44100;
336
hpf_mask = DA7210_VOICE_EN;
337
hpf_value = 0;
338
bypass = 0;
339
break;
340
case 48000:
341
fs = DA7210_PLL_FS_48000;
342
hpf_mask = DA7210_VOICE_EN;
343
hpf_value = 0;
344
bypass = DA7210_PLL_BYP;
345
break;
346
case 88200:
347
fs = DA7210_PLL_FS_88200;
348
hpf_mask = DA7210_VOICE_EN;
349
hpf_value = 0;
350
bypass = 0;
351
break;
352
case 96000:
353
fs = DA7210_PLL_FS_96000;
354
hpf_mask = DA7210_VOICE_EN;
355
hpf_value = 0;
356
bypass = DA7210_PLL_BYP;
357
break;
358
default:
359
return -EINVAL;
360
}
361
362
/* Disable active mode */
363
snd_soc_update_bits(codec, DA7210_STARTUP1, DA7210_SC_MST_EN, 0);
364
365
snd_soc_update_bits(codec, hpf_reg, hpf_mask, hpf_value);
366
snd_soc_update_bits(codec, DA7210_PLL, DA7210_PLL_FS_MASK, fs);
367
snd_soc_update_bits(codec, DA7210_PLL_DIV3, DA7210_PLL_BYP, bypass);
368
369
/* Enable active mode */
370
snd_soc_update_bits(codec, DA7210_STARTUP1,
371
DA7210_SC_MST_EN, DA7210_SC_MST_EN);
372
373
return 0;
374
}
375
376
/*
377
* Set DAI mode and Format
378
*/
379
static int da7210_set_dai_fmt(struct snd_soc_dai *codec_dai, u32 fmt)
380
{
381
struct snd_soc_codec *codec = codec_dai->codec;
382
u32 dai_cfg1;
383
u32 dai_cfg3;
384
385
dai_cfg1 = 0x7f & da7210_read(codec, DA7210_DAI_CFG1);
386
dai_cfg3 = 0xfc & da7210_read(codec, DA7210_DAI_CFG3);
387
388
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
389
case SND_SOC_DAIFMT_CBM_CFM:
390
dai_cfg1 |= DA7210_DAI_MODE_MASTER;
391
break;
392
default:
393
return -EINVAL;
394
}
395
396
/* FIXME
397
*
398
* It support I2S only now
399
*/
400
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
401
case SND_SOC_DAIFMT_I2S:
402
dai_cfg3 |= DA7210_DAI_FORMAT_I2SMODE;
403
break;
404
default:
405
return -EINVAL;
406
}
407
408
/* FIXME
409
*
410
* It support 64bit data transmission only now
411
*/
412
dai_cfg1 |= DA7210_DAI_FLEN_64BIT;
413
414
da7210_write(codec, DA7210_DAI_CFG1, dai_cfg1);
415
da7210_write(codec, DA7210_DAI_CFG3, dai_cfg3);
416
417
return 0;
418
}
419
420
#define DA7210_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
421
422
/* DAI operations */
423
static struct snd_soc_dai_ops da7210_dai_ops = {
424
.startup = da7210_startup,
425
.hw_params = da7210_hw_params,
426
.set_fmt = da7210_set_dai_fmt,
427
};
428
429
static struct snd_soc_dai_driver da7210_dai = {
430
.name = "da7210-hifi",
431
/* playback capabilities */
432
.playback = {
433
.stream_name = "Playback",
434
.channels_min = 1,
435
.channels_max = 2,
436
.rates = SNDRV_PCM_RATE_8000_96000,
437
.formats = DA7210_FORMATS,
438
},
439
/* capture capabilities */
440
.capture = {
441
.stream_name = "Capture",
442
.channels_min = 1,
443
.channels_max = 2,
444
.rates = SNDRV_PCM_RATE_8000_96000,
445
.formats = DA7210_FORMATS,
446
},
447
.ops = &da7210_dai_ops,
448
.symmetric_rates = 1,
449
};
450
451
static int da7210_probe(struct snd_soc_codec *codec)
452
{
453
struct da7210_priv *da7210 = snd_soc_codec_get_drvdata(codec);
454
455
dev_info(codec->dev, "DA7210 Audio Codec %s\n", DA7210_VERSION);
456
457
codec->control_data = da7210->control_data;
458
codec->hw_write = (hw_write_t)i2c_master_send;
459
460
/* FIXME
461
*
462
* This driver use fixed value here
463
* And below settings expects MCLK = 12.288MHz
464
*
465
* When you select different MCLK, please check...
466
* DA7210_PLL_DIV1 val
467
* DA7210_PLL_DIV2 val
468
* DA7210_PLL_DIV3 val
469
* DA7210_PLL_DIV3 :: DA7210_MCLK_RANGExxx
470
*/
471
472
/*
473
* make sure that DA7210 use bypass mode before start up
474
*/
475
da7210_write(codec, DA7210_STARTUP1, 0);
476
da7210_write(codec, DA7210_PLL_DIV3,
477
DA7210_MCLK_RANGE_10_20_MHZ | DA7210_PLL_BYP);
478
479
/*
480
* ADC settings
481
*/
482
483
/* Enable Left & Right MIC PGA and Mic Bias */
484
da7210_write(codec, DA7210_MIC_L, DA7210_MIC_L_EN | DA7210_MICBIAS_EN);
485
da7210_write(codec, DA7210_MIC_R, DA7210_MIC_R_EN);
486
487
/* Enable Left and Right input PGA */
488
da7210_write(codec, DA7210_INMIX_L, DA7210_IN_L_EN);
489
da7210_write(codec, DA7210_INMIX_R, DA7210_IN_R_EN);
490
491
/* Enable Left and Right ADC */
492
da7210_write(codec, DA7210_ADC, DA7210_ADC_L_EN | DA7210_ADC_R_EN);
493
494
/*
495
* DAC settings
496
*/
497
498
/* Enable Left and Right DAC */
499
da7210_write(codec, DA7210_DAC_SEL,
500
DA7210_DAC_L_SRC_DAI_L | DA7210_DAC_L_EN |
501
DA7210_DAC_R_SRC_DAI_R | DA7210_DAC_R_EN);
502
503
/* Enable Left and Right out PGA */
504
da7210_write(codec, DA7210_OUTMIX_L, DA7210_OUT_L_EN);
505
da7210_write(codec, DA7210_OUTMIX_R, DA7210_OUT_R_EN);
506
507
/* Enable Left and Right HeadPhone PGA */
508
da7210_write(codec, DA7210_HP_CFG,
509
DA7210_HP_2CAP_MODE | DA7210_HP_SENSE_EN |
510
DA7210_HP_L_EN | DA7210_HP_MODE | DA7210_HP_R_EN);
511
512
/* Diable PLL and bypass it */
513
da7210_write(codec, DA7210_PLL, DA7210_PLL_FS_48000);
514
515
/*
516
* If 48kHz sound came, it use bypass mode,
517
* and when it is 44.1kHz, it use PLL.
518
*
519
* This time, this driver sets PLL always ON
520
* and controls bypass/PLL mode by switching
521
* DA7210_PLL_DIV3 :: DA7210_PLL_BYP bit.
522
* see da7210_hw_params
523
*/
524
da7210_write(codec, DA7210_PLL_DIV1, 0xE5); /* MCLK = 12.288MHz */
525
da7210_write(codec, DA7210_PLL_DIV2, 0x99);
526
da7210_write(codec, DA7210_PLL_DIV3, 0x0A |
527
DA7210_MCLK_RANGE_10_20_MHZ | DA7210_PLL_BYP);
528
snd_soc_update_bits(codec, DA7210_PLL, DA7210_PLL_EN, DA7210_PLL_EN);
529
530
/* As suggested by Dialog */
531
da7210_write(codec, DA7210_A_HID_UNLOCK, 0x8B); /* unlock */
532
da7210_write(codec, DA7210_A_TEST_UNLOCK, 0xB4);
533
da7210_write(codec, DA7210_A_PLL1, 0x01);
534
da7210_write(codec, DA7210_A_CP_MODE, 0x7C);
535
da7210_write(codec, DA7210_A_HID_UNLOCK, 0x00); /* re-lock */
536
da7210_write(codec, DA7210_A_TEST_UNLOCK, 0x00);
537
538
/* Activate all enabled subsystem */
539
da7210_write(codec, DA7210_STARTUP1, DA7210_SC_MST_EN);
540
541
snd_soc_add_controls(codec, da7210_snd_controls,
542
ARRAY_SIZE(da7210_snd_controls));
543
544
dev_info(codec->dev, "DA7210 Audio Codec %s\n", DA7210_VERSION);
545
546
return 0;
547
}
548
549
static struct snd_soc_codec_driver soc_codec_dev_da7210 = {
550
.probe = da7210_probe,
551
.read = da7210_read,
552
.write = da7210_write,
553
.reg_cache_size = ARRAY_SIZE(da7210_reg),
554
.reg_word_size = sizeof(u8),
555
.reg_cache_default = da7210_reg,
556
};
557
558
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
559
static int __devinit da7210_i2c_probe(struct i2c_client *i2c,
560
const struct i2c_device_id *id)
561
{
562
struct da7210_priv *da7210;
563
int ret;
564
565
da7210 = kzalloc(sizeof(struct da7210_priv), GFP_KERNEL);
566
if (!da7210)
567
return -ENOMEM;
568
569
i2c_set_clientdata(i2c, da7210);
570
da7210->control_data = i2c;
571
da7210->control_type = SND_SOC_I2C;
572
573
ret = snd_soc_register_codec(&i2c->dev,
574
&soc_codec_dev_da7210, &da7210_dai, 1);
575
if (ret < 0)
576
kfree(da7210);
577
578
return ret;
579
}
580
581
static int __devexit da7210_i2c_remove(struct i2c_client *client)
582
{
583
snd_soc_unregister_codec(&client->dev);
584
kfree(i2c_get_clientdata(client));
585
return 0;
586
}
587
588
static const struct i2c_device_id da7210_i2c_id[] = {
589
{ "da7210", 0 },
590
{ }
591
};
592
MODULE_DEVICE_TABLE(i2c, da7210_i2c_id);
593
594
/* I2C codec control layer */
595
static struct i2c_driver da7210_i2c_driver = {
596
.driver = {
597
.name = "da7210-codec",
598
.owner = THIS_MODULE,
599
},
600
.probe = da7210_i2c_probe,
601
.remove = __devexit_p(da7210_i2c_remove),
602
.id_table = da7210_i2c_id,
603
};
604
#endif
605
606
static int __init da7210_modinit(void)
607
{
608
int ret = 0;
609
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
610
ret = i2c_add_driver(&da7210_i2c_driver);
611
#endif
612
return ret;
613
}
614
module_init(da7210_modinit);
615
616
static void __exit da7210_exit(void)
617
{
618
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
619
i2c_del_driver(&da7210_i2c_driver);
620
#endif
621
}
622
module_exit(da7210_exit);
623
624
MODULE_DESCRIPTION("ASoC DA7210 driver");
625
MODULE_AUTHOR("David Chen, Kuninori Morimoto");
626
MODULE_LICENSE("GPL");
627
628