• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  *  Routines for control of the AK4114 via I2C and 4-wire serial interface
3  *  IEC958 (S/PDIF) receiver by Asahi Kasei
4  *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
5  *
6  *
7  *   This program is free software; you can redistribute it and/or modify
8  *   it under the terms of the GNU General Public License as published by
9  *   the Free Software Foundation; either version 2 of the License, or
10  *   (at your option) any later version.
11  *
12  *   This program is distributed in the hope that it will be useful,
13  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *   GNU General Public License for more details.
16  *
17  *   You should have received a copy of the GNU General Public License
18  *   along with this program; if not, write to the Free Software
19  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
20  *
21  */
22 
23 #include <linux/slab.h>
24 #include <linux/delay.h>
25 #include <linux/module.h>
26 #include <sound/core.h>
27 #include <sound/control.h>
28 #include <sound/pcm.h>
29 #include <sound/ak4114.h>
30 #include <sound/asoundef.h>
31 #include <sound/info.h>
32 
33 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
34 MODULE_DESCRIPTION("AK4114 IEC958 (S/PDIF) receiver by Asahi Kasei");
35 MODULE_LICENSE("GPL");
36 
37 #define AK4114_ADDR			0x00 /* fixed address */
38 
39 static void ak4114_stats(struct work_struct *work);
40 static void ak4114_init_regs(struct ak4114 *chip);
41 
reg_write(struct ak4114 * ak4114,unsigned char reg,unsigned char val)42 static void reg_write(struct ak4114 *ak4114, unsigned char reg, unsigned char val)
43 {
44 	ak4114->write(ak4114->private_data, reg, val);
45 	if (reg <= AK4114_REG_INT1_MASK)
46 		ak4114->regmap[reg] = val;
47 	else if (reg >= AK4114_REG_TXCSB0 && reg <= AK4114_REG_TXCSB4)
48 		ak4114->txcsb[reg-AK4114_REG_TXCSB0] = val;
49 }
50 
reg_read(struct ak4114 * ak4114,unsigned char reg)51 static inline unsigned char reg_read(struct ak4114 *ak4114, unsigned char reg)
52 {
53 	return ak4114->read(ak4114->private_data, reg);
54 }
55 
56 #if 0
57 static void reg_dump(struct ak4114 *ak4114)
58 {
59 	int i;
60 
61 	printk(KERN_DEBUG "AK4114 REG DUMP:\n");
62 	for (i = 0; i < 0x20; i++)
63 		printk(KERN_DEBUG "reg[%02x] = %02x (%02x)\n", i, reg_read(ak4114, i), i < ARRAY_SIZE(ak4114->regmap) ? ak4114->regmap[i] : 0);
64 }
65 #endif
66 
snd_ak4114_free(struct ak4114 * chip)67 static void snd_ak4114_free(struct ak4114 *chip)
68 {
69 	atomic_inc(&chip->wq_processing);	/* don't schedule new work */
70 	cancel_delayed_work_sync(&chip->work);
71 	kfree(chip);
72 }
73 
snd_ak4114_dev_free(struct snd_device * device)74 static int snd_ak4114_dev_free(struct snd_device *device)
75 {
76 	struct ak4114 *chip = device->device_data;
77 	snd_ak4114_free(chip);
78 	return 0;
79 }
80 
snd_ak4114_create(struct snd_card * card,ak4114_read_t * read,ak4114_write_t * write,const unsigned char pgm[6],const unsigned char txcsb[5],void * private_data,struct ak4114 ** r_ak4114)81 int snd_ak4114_create(struct snd_card *card,
82 		      ak4114_read_t *read, ak4114_write_t *write,
83 		      const unsigned char pgm[6], const unsigned char txcsb[5],
84 		      void *private_data, struct ak4114 **r_ak4114)
85 {
86 	struct ak4114 *chip;
87 	int err = 0;
88 	unsigned char reg;
89 	static struct snd_device_ops ops = {
90 		.dev_free =     snd_ak4114_dev_free,
91 	};
92 
93 	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
94 	if (chip == NULL)
95 		return -ENOMEM;
96 	spin_lock_init(&chip->lock);
97 	chip->card = card;
98 	chip->read = read;
99 	chip->write = write;
100 	chip->private_data = private_data;
101 	INIT_DELAYED_WORK(&chip->work, ak4114_stats);
102 	atomic_set(&chip->wq_processing, 0);
103 
104 	for (reg = 0; reg < 6; reg++)
105 		chip->regmap[reg] = pgm[reg];
106 	for (reg = 0; reg < 5; reg++)
107 		chip->txcsb[reg] = txcsb[reg];
108 
109 	ak4114_init_regs(chip);
110 
111 	chip->rcs0 = reg_read(chip, AK4114_REG_RCS0) & ~(AK4114_QINT | AK4114_CINT);
112 	chip->rcs1 = reg_read(chip, AK4114_REG_RCS1);
113 
114 	if ((err = snd_device_new(card, SNDRV_DEV_CODEC, chip, &ops)) < 0)
115 		goto __fail;
116 
117 	if (r_ak4114)
118 		*r_ak4114 = chip;
119 	return 0;
120 
121       __fail:
122 	snd_ak4114_free(chip);
123 	return err < 0 ? err : -EIO;
124 }
125 
snd_ak4114_reg_write(struct ak4114 * chip,unsigned char reg,unsigned char mask,unsigned char val)126 void snd_ak4114_reg_write(struct ak4114 *chip, unsigned char reg, unsigned char mask, unsigned char val)
127 {
128 	if (reg <= AK4114_REG_INT1_MASK)
129 		reg_write(chip, reg, (chip->regmap[reg] & ~mask) | val);
130 	else if (reg >= AK4114_REG_TXCSB0 && reg <= AK4114_REG_TXCSB4)
131 		reg_write(chip, reg,
132 			  (chip->txcsb[reg-AK4114_REG_TXCSB0] & ~mask) | val);
133 }
134 
ak4114_init_regs(struct ak4114 * chip)135 static void ak4114_init_regs(struct ak4114 *chip)
136 {
137 	unsigned char old = chip->regmap[AK4114_REG_PWRDN], reg;
138 
139 	/* bring the chip to reset state and powerdown state */
140 	reg_write(chip, AK4114_REG_PWRDN, old & ~(AK4114_RST|AK4114_PWN));
141 	udelay(200);
142 	/* release reset, but leave powerdown */
143 	reg_write(chip, AK4114_REG_PWRDN, (old | AK4114_RST) & ~AK4114_PWN);
144 	udelay(200);
145 	for (reg = 1; reg < 6; reg++)
146 		reg_write(chip, reg, chip->regmap[reg]);
147 	for (reg = 0; reg < 5; reg++)
148 		reg_write(chip, reg + AK4114_REG_TXCSB0, chip->txcsb[reg]);
149 	/* release powerdown, everything is initialized now */
150 	reg_write(chip, AK4114_REG_PWRDN, old | AK4114_RST | AK4114_PWN);
151 }
152 
snd_ak4114_reinit(struct ak4114 * chip)153 void snd_ak4114_reinit(struct ak4114 *chip)
154 {
155 	if (atomic_inc_return(&chip->wq_processing) == 1)
156 		cancel_delayed_work_sync(&chip->work);
157 	ak4114_init_regs(chip);
158 	/* bring up statistics / event queing */
159 	if (atomic_dec_and_test(&chip->wq_processing))
160 		schedule_delayed_work(&chip->work, HZ / 10);
161 }
162 
external_rate(unsigned char rcs1)163 static unsigned int external_rate(unsigned char rcs1)
164 {
165 	switch (rcs1 & (AK4114_FS0|AK4114_FS1|AK4114_FS2|AK4114_FS3)) {
166 	case AK4114_FS_32000HZ: return 32000;
167 	case AK4114_FS_44100HZ: return 44100;
168 	case AK4114_FS_48000HZ: return 48000;
169 	case AK4114_FS_88200HZ: return 88200;
170 	case AK4114_FS_96000HZ: return 96000;
171 	case AK4114_FS_176400HZ: return 176400;
172 	case AK4114_FS_192000HZ: return 192000;
173 	default:		return 0;
174 	}
175 }
176 
snd_ak4114_in_error_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)177 static int snd_ak4114_in_error_info(struct snd_kcontrol *kcontrol,
178 				    struct snd_ctl_elem_info *uinfo)
179 {
180 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
181 	uinfo->count = 1;
182 	uinfo->value.integer.min = 0;
183 	uinfo->value.integer.max = LONG_MAX;
184 	return 0;
185 }
186 
snd_ak4114_in_error_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)187 static int snd_ak4114_in_error_get(struct snd_kcontrol *kcontrol,
188 				   struct snd_ctl_elem_value *ucontrol)
189 {
190 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
191 	long *ptr;
192 
193 	spin_lock_irq(&chip->lock);
194 	ptr = (long *)(((char *)chip) + kcontrol->private_value);
195 	ucontrol->value.integer.value[0] = *ptr;
196 	*ptr = 0;
197 	spin_unlock_irq(&chip->lock);
198 	return 0;
199 }
200 
201 #define snd_ak4114_in_bit_info		snd_ctl_boolean_mono_info
202 
snd_ak4114_in_bit_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)203 static int snd_ak4114_in_bit_get(struct snd_kcontrol *kcontrol,
204 				 struct snd_ctl_elem_value *ucontrol)
205 {
206 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
207 	unsigned char reg = kcontrol->private_value & 0xff;
208 	unsigned char bit = (kcontrol->private_value >> 8) & 0xff;
209 	unsigned char inv = (kcontrol->private_value >> 31) & 1;
210 
211 	ucontrol->value.integer.value[0] = ((reg_read(chip, reg) & (1 << bit)) ? 1 : 0) ^ inv;
212 	return 0;
213 }
214 
snd_ak4114_rate_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)215 static int snd_ak4114_rate_info(struct snd_kcontrol *kcontrol,
216 				struct snd_ctl_elem_info *uinfo)
217 {
218 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
219 	uinfo->count = 1;
220 	uinfo->value.integer.min = 0;
221 	uinfo->value.integer.max = 192000;
222 	return 0;
223 }
224 
snd_ak4114_rate_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)225 static int snd_ak4114_rate_get(struct snd_kcontrol *kcontrol,
226 			       struct snd_ctl_elem_value *ucontrol)
227 {
228 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
229 
230 	ucontrol->value.integer.value[0] = external_rate(reg_read(chip, AK4114_REG_RCS1));
231 	return 0;
232 }
233 
snd_ak4114_spdif_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)234 static int snd_ak4114_spdif_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
235 {
236 	uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
237 	uinfo->count = 1;
238 	return 0;
239 }
240 
snd_ak4114_spdif_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)241 static int snd_ak4114_spdif_get(struct snd_kcontrol *kcontrol,
242 				struct snd_ctl_elem_value *ucontrol)
243 {
244 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
245 	unsigned i;
246 
247 	for (i = 0; i < AK4114_REG_RXCSB_SIZE; i++)
248 		ucontrol->value.iec958.status[i] = reg_read(chip, AK4114_REG_RXCSB0 + i);
249 	return 0;
250 }
251 
snd_ak4114_spdif_playback_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)252 static int snd_ak4114_spdif_playback_get(struct snd_kcontrol *kcontrol,
253 					 struct snd_ctl_elem_value *ucontrol)
254 {
255 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
256 	unsigned i;
257 
258 	for (i = 0; i < AK4114_REG_TXCSB_SIZE; i++)
259 		ucontrol->value.iec958.status[i] = chip->txcsb[i];
260 	return 0;
261 }
262 
snd_ak4114_spdif_playback_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)263 static int snd_ak4114_spdif_playback_put(struct snd_kcontrol *kcontrol,
264 					 struct snd_ctl_elem_value *ucontrol)
265 {
266 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
267 	unsigned i;
268 
269 	for (i = 0; i < AK4114_REG_TXCSB_SIZE; i++)
270 		reg_write(chip, AK4114_REG_TXCSB0 + i, ucontrol->value.iec958.status[i]);
271 	return 0;
272 }
273 
snd_ak4114_spdif_mask_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)274 static int snd_ak4114_spdif_mask_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
275 {
276 	uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
277 	uinfo->count = 1;
278 	return 0;
279 }
280 
snd_ak4114_spdif_mask_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)281 static int snd_ak4114_spdif_mask_get(struct snd_kcontrol *kcontrol,
282 				      struct snd_ctl_elem_value *ucontrol)
283 {
284 	memset(ucontrol->value.iec958.status, 0xff, AK4114_REG_RXCSB_SIZE);
285 	return 0;
286 }
287 
snd_ak4114_spdif_pinfo(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)288 static int snd_ak4114_spdif_pinfo(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
289 {
290 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
291 	uinfo->value.integer.min = 0;
292 	uinfo->value.integer.max = 0xffff;
293 	uinfo->count = 4;
294 	return 0;
295 }
296 
snd_ak4114_spdif_pget(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)297 static int snd_ak4114_spdif_pget(struct snd_kcontrol *kcontrol,
298 				 struct snd_ctl_elem_value *ucontrol)
299 {
300 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
301 	unsigned short tmp;
302 
303 	ucontrol->value.integer.value[0] = 0xf8f2;
304 	ucontrol->value.integer.value[1] = 0x4e1f;
305 	tmp = reg_read(chip, AK4114_REG_Pc0) | (reg_read(chip, AK4114_REG_Pc1) << 8);
306 	ucontrol->value.integer.value[2] = tmp;
307 	tmp = reg_read(chip, AK4114_REG_Pd0) | (reg_read(chip, AK4114_REG_Pd1) << 8);
308 	ucontrol->value.integer.value[3] = tmp;
309 	return 0;
310 }
311 
snd_ak4114_spdif_qinfo(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)312 static int snd_ak4114_spdif_qinfo(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
313 {
314 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
315 	uinfo->count = AK4114_REG_QSUB_SIZE;
316 	return 0;
317 }
318 
snd_ak4114_spdif_qget(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)319 static int snd_ak4114_spdif_qget(struct snd_kcontrol *kcontrol,
320 				 struct snd_ctl_elem_value *ucontrol)
321 {
322 	struct ak4114 *chip = snd_kcontrol_chip(kcontrol);
323 	unsigned i;
324 
325 	for (i = 0; i < AK4114_REG_QSUB_SIZE; i++)
326 		ucontrol->value.bytes.data[i] = reg_read(chip, AK4114_REG_QSUB_ADDR + i);
327 	return 0;
328 }
329 
330 /* Don't forget to change AK4114_CONTROLS define!!! */
331 static struct snd_kcontrol_new snd_ak4114_iec958_controls[] = {
332 {
333 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
334 	.name =		"IEC958 Parity Errors",
335 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
336 	.info =		snd_ak4114_in_error_info,
337 	.get =		snd_ak4114_in_error_get,
338 	.private_value = offsetof(struct ak4114, parity_errors),
339 },
340 {
341 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
342 	.name =		"IEC958 V-Bit Errors",
343 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
344 	.info =		snd_ak4114_in_error_info,
345 	.get =		snd_ak4114_in_error_get,
346 	.private_value = offsetof(struct ak4114, v_bit_errors),
347 },
348 {
349 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
350 	.name =		"IEC958 C-CRC Errors",
351 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
352 	.info =		snd_ak4114_in_error_info,
353 	.get =		snd_ak4114_in_error_get,
354 	.private_value = offsetof(struct ak4114, ccrc_errors),
355 },
356 {
357 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
358 	.name =		"IEC958 Q-CRC Errors",
359 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
360 	.info =		snd_ak4114_in_error_info,
361 	.get =		snd_ak4114_in_error_get,
362 	.private_value = offsetof(struct ak4114, qcrc_errors),
363 },
364 {
365 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
366 	.name =		"IEC958 External Rate",
367 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
368 	.info =		snd_ak4114_rate_info,
369 	.get =		snd_ak4114_rate_get,
370 },
371 {
372 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
373 	.name =		SNDRV_CTL_NAME_IEC958("",PLAYBACK,MASK),
374 	.access =	SNDRV_CTL_ELEM_ACCESS_READ,
375 	.info =		snd_ak4114_spdif_mask_info,
376 	.get =		snd_ak4114_spdif_mask_get,
377 },
378 {
379 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
380 	.name =		SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
381 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
382 	.info =		snd_ak4114_spdif_info,
383 	.get =		snd_ak4114_spdif_playback_get,
384 	.put =		snd_ak4114_spdif_playback_put,
385 },
386 {
387 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
388 	.name =		SNDRV_CTL_NAME_IEC958("",CAPTURE,MASK),
389 	.access =	SNDRV_CTL_ELEM_ACCESS_READ,
390 	.info =		snd_ak4114_spdif_mask_info,
391 	.get =		snd_ak4114_spdif_mask_get,
392 },
393 {
394 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
395 	.name =		SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
396 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
397 	.info =		snd_ak4114_spdif_info,
398 	.get =		snd_ak4114_spdif_get,
399 },
400 {
401 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
402 	.name =		"IEC958 Preamble Capture Default",
403 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
404 	.info =		snd_ak4114_spdif_pinfo,
405 	.get =		snd_ak4114_spdif_pget,
406 },
407 {
408 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
409 	.name =		"IEC958 Q-subcode Capture Default",
410 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
411 	.info =		snd_ak4114_spdif_qinfo,
412 	.get =		snd_ak4114_spdif_qget,
413 },
414 {
415 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
416 	.name =		"IEC958 Audio",
417 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
418 	.info =		snd_ak4114_in_bit_info,
419 	.get =		snd_ak4114_in_bit_get,
420 	.private_value = (1<<31) | (1<<8) | AK4114_REG_RCS0,
421 },
422 {
423 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
424 	.name =		"IEC958 Non-PCM Bitstream",
425 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
426 	.info =		snd_ak4114_in_bit_info,
427 	.get =		snd_ak4114_in_bit_get,
428 	.private_value = (6<<8) | AK4114_REG_RCS0,
429 },
430 {
431 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
432 	.name =		"IEC958 DTS Bitstream",
433 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
434 	.info =		snd_ak4114_in_bit_info,
435 	.get =		snd_ak4114_in_bit_get,
436 	.private_value = (3<<8) | AK4114_REG_RCS0,
437 },
438 {
439 	.iface =	SNDRV_CTL_ELEM_IFACE_PCM,
440 	.name =		"IEC958 PPL Lock Status",
441 	.access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
442 	.info =		snd_ak4114_in_bit_info,
443 	.get =		snd_ak4114_in_bit_get,
444 	.private_value = (1<<31) | (4<<8) | AK4114_REG_RCS0,
445 }
446 };
447 
448 
snd_ak4114_proc_regs_read(struct snd_info_entry * entry,struct snd_info_buffer * buffer)449 static void snd_ak4114_proc_regs_read(struct snd_info_entry *entry,
450 		struct snd_info_buffer *buffer)
451 {
452 	struct ak4114 *ak4114 = entry->private_data;
453 	int reg, val;
454 	/* all ak4114 registers 0x00 - 0x1f */
455 	for (reg = 0; reg < 0x20; reg++) {
456 		val = reg_read(ak4114, reg);
457 		snd_iprintf(buffer, "0x%02x = 0x%02x\n", reg, val);
458 	}
459 }
460 
snd_ak4114_proc_init(struct ak4114 * ak4114)461 static void snd_ak4114_proc_init(struct ak4114 *ak4114)
462 {
463 	struct snd_info_entry *entry;
464 	if (!snd_card_proc_new(ak4114->card, "ak4114", &entry))
465 		snd_info_set_text_ops(entry, ak4114, snd_ak4114_proc_regs_read);
466 }
467 
snd_ak4114_build(struct ak4114 * ak4114,struct snd_pcm_substream * ply_substream,struct snd_pcm_substream * cap_substream)468 int snd_ak4114_build(struct ak4114 *ak4114,
469 		     struct snd_pcm_substream *ply_substream,
470 		     struct snd_pcm_substream *cap_substream)
471 {
472 	struct snd_kcontrol *kctl;
473 	unsigned int idx;
474 	int err;
475 
476 	if (snd_BUG_ON(!cap_substream))
477 		return -EINVAL;
478 	ak4114->playback_substream = ply_substream;
479 	ak4114->capture_substream = cap_substream;
480 	for (idx = 0; idx < AK4114_CONTROLS; idx++) {
481 		kctl = snd_ctl_new1(&snd_ak4114_iec958_controls[idx], ak4114);
482 		if (kctl == NULL)
483 			return -ENOMEM;
484 		if (strstr(kctl->id.name, "Playback")) {
485 			if (ply_substream == NULL) {
486 				snd_ctl_free_one(kctl);
487 				ak4114->kctls[idx] = NULL;
488 				continue;
489 			}
490 			kctl->id.device = ply_substream->pcm->device;
491 			kctl->id.subdevice = ply_substream->number;
492 		} else {
493 			kctl->id.device = cap_substream->pcm->device;
494 			kctl->id.subdevice = cap_substream->number;
495 		}
496 		err = snd_ctl_add(ak4114->card, kctl);
497 		if (err < 0)
498 			return err;
499 		ak4114->kctls[idx] = kctl;
500 	}
501 	snd_ak4114_proc_init(ak4114);
502 	/* trigger workq */
503 	schedule_delayed_work(&ak4114->work, HZ / 10);
504 	return 0;
505 }
506 
507 /* notify kcontrols if any parameters are changed */
ak4114_notify(struct ak4114 * ak4114,unsigned char rcs0,unsigned char rcs1,unsigned char c0,unsigned char c1)508 static void ak4114_notify(struct ak4114 *ak4114,
509 			  unsigned char rcs0, unsigned char rcs1,
510 			  unsigned char c0, unsigned char c1)
511 {
512 	if (!ak4114->kctls[0])
513 		return;
514 
515 	if (rcs0 & AK4114_PAR)
516 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
517 			       &ak4114->kctls[0]->id);
518 	if (rcs0 & AK4114_V)
519 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
520 			       &ak4114->kctls[1]->id);
521 	if (rcs1 & AK4114_CCRC)
522 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
523 			       &ak4114->kctls[2]->id);
524 	if (rcs1 & AK4114_QCRC)
525 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
526 			       &ak4114->kctls[3]->id);
527 
528 	/* rate change */
529 	if (c1 & 0xf0)
530 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
531 			       &ak4114->kctls[4]->id);
532 
533 	if ((c0 & AK4114_PEM) | (c0 & AK4114_CINT))
534 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
535 			       &ak4114->kctls[9]->id);
536 	if (c0 & AK4114_QINT)
537 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
538 			       &ak4114->kctls[10]->id);
539 
540 	if (c0 & AK4114_AUDION)
541 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
542 			       &ak4114->kctls[11]->id);
543 	if (c0 & AK4114_AUTO)
544 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
545 			       &ak4114->kctls[12]->id);
546 	if (c0 & AK4114_DTSCD)
547 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
548 			       &ak4114->kctls[13]->id);
549 	if (c0 & AK4114_UNLCK)
550 		snd_ctl_notify(ak4114->card, SNDRV_CTL_EVENT_MASK_VALUE,
551 			       &ak4114->kctls[14]->id);
552 }
553 
snd_ak4114_external_rate(struct ak4114 * ak4114)554 int snd_ak4114_external_rate(struct ak4114 *ak4114)
555 {
556 	unsigned char rcs1;
557 
558 	rcs1 = reg_read(ak4114, AK4114_REG_RCS1);
559 	return external_rate(rcs1);
560 }
561 
snd_ak4114_check_rate_and_errors(struct ak4114 * ak4114,unsigned int flags)562 int snd_ak4114_check_rate_and_errors(struct ak4114 *ak4114, unsigned int flags)
563 {
564 	struct snd_pcm_runtime *runtime = ak4114->capture_substream ? ak4114->capture_substream->runtime : NULL;
565 	unsigned long _flags;
566 	int res = 0;
567 	unsigned char rcs0, rcs1;
568 	unsigned char c0, c1;
569 
570 	rcs1 = reg_read(ak4114, AK4114_REG_RCS1);
571 	if (flags & AK4114_CHECK_NO_STAT)
572 		goto __rate;
573 	rcs0 = reg_read(ak4114, AK4114_REG_RCS0);
574 	spin_lock_irqsave(&ak4114->lock, _flags);
575 	if (rcs0 & AK4114_PAR)
576 		ak4114->parity_errors++;
577 	if (rcs1 & AK4114_V)
578 		ak4114->v_bit_errors++;
579 	if (rcs1 & AK4114_CCRC)
580 		ak4114->ccrc_errors++;
581 	if (rcs1 & AK4114_QCRC)
582 		ak4114->qcrc_errors++;
583 	c0 = (ak4114->rcs0 & (AK4114_QINT | AK4114_CINT | AK4114_PEM | AK4114_AUDION | AK4114_AUTO | AK4114_UNLCK)) ^
584                      (rcs0 & (AK4114_QINT | AK4114_CINT | AK4114_PEM | AK4114_AUDION | AK4114_AUTO | AK4114_UNLCK));
585 	c1 = (ak4114->rcs1 & 0xf0) ^ (rcs1 & 0xf0);
586 	ak4114->rcs0 = rcs0 & ~(AK4114_QINT | AK4114_CINT);
587 	ak4114->rcs1 = rcs1;
588 	spin_unlock_irqrestore(&ak4114->lock, _flags);
589 
590 	ak4114_notify(ak4114, rcs0, rcs1, c0, c1);
591 	if (ak4114->change_callback && (c0 | c1) != 0)
592 		ak4114->change_callback(ak4114, c0, c1);
593 
594       __rate:
595 	/* compare rate */
596 	res = external_rate(rcs1);
597 	if (!(flags & AK4114_CHECK_NO_RATE) && runtime && runtime->rate != res) {
598 		snd_pcm_stream_lock_irqsave(ak4114->capture_substream, _flags);
599 		if (snd_pcm_running(ak4114->capture_substream)) {
600 			// printk(KERN_DEBUG "rate changed (%i <- %i)\n", runtime->rate, res);
601 			snd_pcm_stop(ak4114->capture_substream, SNDRV_PCM_STATE_DRAINING);
602 			res = 1;
603 		}
604 		snd_pcm_stream_unlock_irqrestore(ak4114->capture_substream, _flags);
605 	}
606 	return res;
607 }
608 
ak4114_stats(struct work_struct * work)609 static void ak4114_stats(struct work_struct *work)
610 {
611 	struct ak4114 *chip = container_of(work, struct ak4114, work.work);
612 
613 	if (atomic_inc_return(&chip->wq_processing) == 1)
614 		snd_ak4114_check_rate_and_errors(chip, chip->check_flags);
615 	if (atomic_dec_and_test(&chip->wq_processing))
616 		schedule_delayed_work(&chip->work, HZ / 10);
617 }
618 
619 EXPORT_SYMBOL(snd_ak4114_create);
620 EXPORT_SYMBOL(snd_ak4114_reg_write);
621 EXPORT_SYMBOL(snd_ak4114_reinit);
622 EXPORT_SYMBOL(snd_ak4114_build);
623 EXPORT_SYMBOL(snd_ak4114_external_rate);
624 EXPORT_SYMBOL(snd_ak4114_check_rate_and_errors);
625