xref: /linux/sound/pci/ctxfi/ctatc.c (revision ca55b2fef3a9373fcfc30f82fd26bc7fccbda732)
1 /**
2  * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
3  *
4  * This source file is released under GPL v2 license (no other versions).
5  * See the COPYING file included in the main directory of this source
6  * distribution for the license terms and conditions.
7  *
8  * @File    ctatc.c
9  *
10  * @Brief
11  * This file contains the implementation of the device resource management
12  * object.
13  *
14  * @Author Liu Chun
15  * @Date Mar 28 2008
16  */
17 
18 #include "ctatc.h"
19 #include "ctpcm.h"
20 #include "ctmixer.h"
21 #include "ctsrc.h"
22 #include "ctamixer.h"
23 #include "ctdaio.h"
24 #include "cttimer.h"
25 #include <linux/delay.h>
26 #include <linux/slab.h>
27 #include <sound/pcm.h>
28 #include <sound/control.h>
29 #include <sound/asoundef.h>
30 
31 #define MONO_SUM_SCALE	0x19a8	/* 2^(-0.5) in 14-bit floating format */
32 #define MAX_MULTI_CHN	8
33 
34 #define IEC958_DEFAULT_CON ((IEC958_AES0_NONAUDIO \
35 			    | IEC958_AES0_CON_NOT_COPYRIGHT) \
36 			    | ((IEC958_AES1_CON_MIXER \
37 			    | IEC958_AES1_CON_ORIGINAL) << 8) \
38 			    | (0x10 << 16) \
39 			    | ((IEC958_AES3_CON_FS_48000) << 24))
40 
41 static struct snd_pci_quirk subsys_20k1_list[] = {
42 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, 0x0022, "SB055x", CTSB055X),
43 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, 0x002f, "SB055x", CTSB055X),
44 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, 0x0029, "SB073x", CTSB073X),
45 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, 0x0031, "SB073x", CTSB073X),
46 	SND_PCI_QUIRK_MASK(PCI_VENDOR_ID_CREATIVE, 0xf000, 0x6000,
47 			   "UAA", CTUAA),
48 	{ } /* terminator */
49 };
50 
51 static struct snd_pci_quirk subsys_20k2_list[] = {
52 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, PCI_SUBDEVICE_ID_CREATIVE_SB0760,
53 		      "SB0760", CTSB0760),
54 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, PCI_SUBDEVICE_ID_CREATIVE_SB1270,
55 		      "SB1270", CTSB1270),
56 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, PCI_SUBDEVICE_ID_CREATIVE_SB08801,
57 		      "SB0880", CTSB0880),
58 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, PCI_SUBDEVICE_ID_CREATIVE_SB08802,
59 		      "SB0880", CTSB0880),
60 	SND_PCI_QUIRK(PCI_VENDOR_ID_CREATIVE, PCI_SUBDEVICE_ID_CREATIVE_SB08803,
61 		      "SB0880", CTSB0880),
62 	SND_PCI_QUIRK_MASK(PCI_VENDOR_ID_CREATIVE, 0xf000,
63 			   PCI_SUBDEVICE_ID_CREATIVE_HENDRIX, "HENDRIX",
64 			   CTHENDRIX),
65 	{ } /* terminator */
66 };
67 
68 static const char *ct_subsys_name[NUM_CTCARDS] = {
69 	/* 20k1 models */
70 	[CTSB055X]	= "SB055x",
71 	[CTSB073X]	= "SB073x",
72 	[CTUAA]		= "UAA",
73 	[CT20K1_UNKNOWN] = "Unknown",
74 	/* 20k2 models */
75 	[CTSB0760]	= "SB076x",
76 	[CTHENDRIX]	= "Hendrix",
77 	[CTSB0880]	= "SB0880",
78 	[CTSB1270]      = "SB1270",
79 	[CT20K2_UNKNOWN] = "Unknown",
80 };
81 
82 static struct {
83 	int (*create)(struct ct_atc *atc,
84 			enum CTALSADEVS device, const char *device_name);
85 	int (*destroy)(void *alsa_dev);
86 	const char *public_name;
87 } alsa_dev_funcs[NUM_CTALSADEVS] = {
88 	[FRONT]		= { .create = ct_alsa_pcm_create,
89 			    .destroy = NULL,
90 			    .public_name = "Front/WaveIn"},
91 	[SURROUND]	= { .create = ct_alsa_pcm_create,
92 			    .destroy = NULL,
93 			    .public_name = "Surround"},
94 	[CLFE]		= { .create = ct_alsa_pcm_create,
95 			    .destroy = NULL,
96 			    .public_name = "Center/LFE"},
97 	[SIDE]		= { .create = ct_alsa_pcm_create,
98 			    .destroy = NULL,
99 			    .public_name = "Side"},
100 	[IEC958]	= { .create = ct_alsa_pcm_create,
101 			    .destroy = NULL,
102 			    .public_name = "IEC958 Non-audio"},
103 
104 	[MIXER]		= { .create = ct_alsa_mix_create,
105 			    .destroy = NULL,
106 			    .public_name = "Mixer"}
107 };
108 
109 typedef int (*create_t)(struct hw *, void **);
110 typedef int (*destroy_t)(void *);
111 
112 static struct {
113 	int (*create)(struct hw *hw, void **rmgr);
114 	int (*destroy)(void *mgr);
115 } rsc_mgr_funcs[NUM_RSCTYP] = {
116 	[SRC] 		= { .create 	= (create_t)src_mgr_create,
117 			    .destroy 	= (destroy_t)src_mgr_destroy	},
118 	[SRCIMP] 	= { .create 	= (create_t)srcimp_mgr_create,
119 			    .destroy 	= (destroy_t)srcimp_mgr_destroy	},
120 	[AMIXER]	= { .create	= (create_t)amixer_mgr_create,
121 			    .destroy	= (destroy_t)amixer_mgr_destroy	},
122 	[SUM]		= { .create	= (create_t)sum_mgr_create,
123 			    .destroy	= (destroy_t)sum_mgr_destroy	},
124 	[DAIO]		= { .create	= (create_t)daio_mgr_create,
125 			    .destroy	= (destroy_t)daio_mgr_destroy	}
126 };
127 
128 static int
129 atc_pcm_release_resources(struct ct_atc *atc, struct ct_atc_pcm *apcm);
130 
131 /* *
132  * Only mono and interleaved modes are supported now.
133  * Always allocates a contiguous channel block.
134  * */
135 
136 static int ct_map_audio_buffer(struct ct_atc *atc, struct ct_atc_pcm *apcm)
137 {
138 	struct snd_pcm_runtime *runtime;
139 	struct ct_vm *vm;
140 
141 	if (!apcm->substream)
142 		return 0;
143 
144 	runtime = apcm->substream->runtime;
145 	vm = atc->vm;
146 
147 	apcm->vm_block = vm->map(vm, apcm->substream, runtime->dma_bytes);
148 
149 	if (!apcm->vm_block)
150 		return -ENOENT;
151 
152 	return 0;
153 }
154 
155 static void ct_unmap_audio_buffer(struct ct_atc *atc, struct ct_atc_pcm *apcm)
156 {
157 	struct ct_vm *vm;
158 
159 	if (!apcm->vm_block)
160 		return;
161 
162 	vm = atc->vm;
163 
164 	vm->unmap(vm, apcm->vm_block);
165 
166 	apcm->vm_block = NULL;
167 }
168 
169 static unsigned long atc_get_ptp_phys(struct ct_atc *atc, int index)
170 {
171 	return atc->vm->get_ptp_phys(atc->vm, index);
172 }
173 
174 static unsigned int convert_format(snd_pcm_format_t snd_format,
175 				   struct snd_card *card)
176 {
177 	switch (snd_format) {
178 	case SNDRV_PCM_FORMAT_U8:
179 		return SRC_SF_U8;
180 	case SNDRV_PCM_FORMAT_S16_LE:
181 		return SRC_SF_S16;
182 	case SNDRV_PCM_FORMAT_S24_3LE:
183 		return SRC_SF_S24;
184 	case SNDRV_PCM_FORMAT_S32_LE:
185 		return SRC_SF_S32;
186 	case SNDRV_PCM_FORMAT_FLOAT_LE:
187 		return SRC_SF_F32;
188 	default:
189 		dev_err(card->dev, "not recognized snd format is %d\n",
190 			snd_format);
191 		return SRC_SF_S16;
192 	}
193 }
194 
195 static unsigned int
196 atc_get_pitch(unsigned int input_rate, unsigned int output_rate)
197 {
198 	unsigned int pitch;
199 	int b;
200 
201 	/* get pitch and convert to fixed-point 8.24 format. */
202 	pitch = (input_rate / output_rate) << 24;
203 	input_rate %= output_rate;
204 	input_rate /= 100;
205 	output_rate /= 100;
206 	for (b = 31; ((b >= 0) && !(input_rate >> b)); )
207 		b--;
208 
209 	if (b >= 0) {
210 		input_rate <<= (31 - b);
211 		input_rate /= output_rate;
212 		b = 24 - (31 - b);
213 		if (b >= 0)
214 			input_rate <<= b;
215 		else
216 			input_rate >>= -b;
217 
218 		pitch |= input_rate;
219 	}
220 
221 	return pitch;
222 }
223 
224 static int select_rom(unsigned int pitch)
225 {
226 	if (pitch > 0x00428f5c && pitch < 0x01b851ec) {
227 		/* 0.26 <= pitch <= 1.72 */
228 		return 1;
229 	} else if (pitch == 0x01d66666 || pitch == 0x01d66667) {
230 		/* pitch == 1.8375 */
231 		return 2;
232 	} else if (pitch == 0x02000000) {
233 		/* pitch == 2 */
234 		return 3;
235 	} else if (pitch <= 0x08000000) {
236 		/* 0 <= pitch <= 8 */
237 		return 0;
238 	} else {
239 		return -ENOENT;
240 	}
241 }
242 
243 static int atc_pcm_playback_prepare(struct ct_atc *atc, struct ct_atc_pcm *apcm)
244 {
245 	struct src_mgr *src_mgr = atc->rsc_mgrs[SRC];
246 	struct amixer_mgr *amixer_mgr = atc->rsc_mgrs[AMIXER];
247 	struct src_desc desc = {0};
248 	struct amixer_desc mix_dsc = {0};
249 	struct src *src;
250 	struct amixer *amixer;
251 	int err;
252 	int n_amixer = apcm->substream->runtime->channels, i = 0;
253 	int device = apcm->substream->pcm->device;
254 	unsigned int pitch;
255 
256 	/* first release old resources */
257 	atc_pcm_release_resources(atc, apcm);
258 
259 	/* Get SRC resource */
260 	desc.multi = apcm->substream->runtime->channels;
261 	desc.msr = atc->msr;
262 	desc.mode = MEMRD;
263 	err = src_mgr->get_src(src_mgr, &desc, (struct src **)&apcm->src);
264 	if (err)
265 		goto error1;
266 
267 	pitch = atc_get_pitch(apcm->substream->runtime->rate,
268 						(atc->rsr * atc->msr));
269 	src = apcm->src;
270 	src->ops->set_pitch(src, pitch);
271 	src->ops->set_rom(src, select_rom(pitch));
272 	src->ops->set_sf(src, convert_format(apcm->substream->runtime->format,
273 					     atc->card));
274 	src->ops->set_pm(src, (src->ops->next_interleave(src) != NULL));
275 
276 	/* Get AMIXER resource */
277 	n_amixer = (n_amixer < 2) ? 2 : n_amixer;
278 	apcm->amixers = kzalloc(sizeof(void *)*n_amixer, GFP_KERNEL);
279 	if (!apcm->amixers) {
280 		err = -ENOMEM;
281 		goto error1;
282 	}
283 	mix_dsc.msr = atc->msr;
284 	for (i = 0, apcm->n_amixer = 0; i < n_amixer; i++) {
285 		err = amixer_mgr->get_amixer(amixer_mgr, &mix_dsc,
286 					(struct amixer **)&apcm->amixers[i]);
287 		if (err)
288 			goto error1;
289 
290 		apcm->n_amixer++;
291 	}
292 
293 	/* Set up device virtual mem map */
294 	err = ct_map_audio_buffer(atc, apcm);
295 	if (err < 0)
296 		goto error1;
297 
298 	/* Connect resources */
299 	src = apcm->src;
300 	for (i = 0; i < n_amixer; i++) {
301 		amixer = apcm->amixers[i];
302 		mutex_lock(&atc->atc_mutex);
303 		amixer->ops->setup(amixer, &src->rsc,
304 					INIT_VOL, atc->pcm[i+device*2]);
305 		mutex_unlock(&atc->atc_mutex);
306 		src = src->ops->next_interleave(src);
307 		if (!src)
308 			src = apcm->src;
309 	}
310 
311 	ct_timer_prepare(apcm->timer);
312 
313 	return 0;
314 
315 error1:
316 	atc_pcm_release_resources(atc, apcm);
317 	return err;
318 }
319 
320 static int
321 atc_pcm_release_resources(struct ct_atc *atc, struct ct_atc_pcm *apcm)
322 {
323 	struct src_mgr *src_mgr = atc->rsc_mgrs[SRC];
324 	struct srcimp_mgr *srcimp_mgr = atc->rsc_mgrs[SRCIMP];
325 	struct amixer_mgr *amixer_mgr = atc->rsc_mgrs[AMIXER];
326 	struct sum_mgr *sum_mgr = atc->rsc_mgrs[SUM];
327 	struct srcimp *srcimp;
328 	int i;
329 
330 	if (apcm->srcimps) {
331 		for (i = 0; i < apcm->n_srcimp; i++) {
332 			srcimp = apcm->srcimps[i];
333 			srcimp->ops->unmap(srcimp);
334 			srcimp_mgr->put_srcimp(srcimp_mgr, srcimp);
335 			apcm->srcimps[i] = NULL;
336 		}
337 		kfree(apcm->srcimps);
338 		apcm->srcimps = NULL;
339 	}
340 
341 	if (apcm->srccs) {
342 		for (i = 0; i < apcm->n_srcc; i++) {
343 			src_mgr->put_src(src_mgr, apcm->srccs[i]);
344 			apcm->srccs[i] = NULL;
345 		}
346 		kfree(apcm->srccs);
347 		apcm->srccs = NULL;
348 	}
349 
350 	if (apcm->amixers) {
351 		for (i = 0; i < apcm->n_amixer; i++) {
352 			amixer_mgr->put_amixer(amixer_mgr, apcm->amixers[i]);
353 			apcm->amixers[i] = NULL;
354 		}
355 		kfree(apcm->amixers);
356 		apcm->amixers = NULL;
357 	}
358 
359 	if (apcm->mono) {
360 		sum_mgr->put_sum(sum_mgr, apcm->mono);
361 		apcm->mono = NULL;
362 	}
363 
364 	if (apcm->src) {
365 		src_mgr->put_src(src_mgr, apcm->src);
366 		apcm->src = NULL;
367 	}
368 
369 	if (apcm->vm_block) {
370 		/* Undo device virtual mem map */
371 		ct_unmap_audio_buffer(atc, apcm);
372 		apcm->vm_block = NULL;
373 	}
374 
375 	return 0;
376 }
377 
378 static int atc_pcm_playback_start(struct ct_atc *atc, struct ct_atc_pcm *apcm)
379 {
380 	unsigned int max_cisz;
381 	struct src *src = apcm->src;
382 
383 	if (apcm->started)
384 		return 0;
385 	apcm->started = 1;
386 
387 	max_cisz = src->multi * src->rsc.msr;
388 	max_cisz = 0x80 * (max_cisz < 8 ? max_cisz : 8);
389 
390 	src->ops->set_sa(src, apcm->vm_block->addr);
391 	src->ops->set_la(src, apcm->vm_block->addr + apcm->vm_block->size);
392 	src->ops->set_ca(src, apcm->vm_block->addr + max_cisz);
393 	src->ops->set_cisz(src, max_cisz);
394 
395 	src->ops->set_bm(src, 1);
396 	src->ops->set_state(src, SRC_STATE_INIT);
397 	src->ops->commit_write(src);
398 
399 	ct_timer_start(apcm->timer);
400 	return 0;
401 }
402 
403 static int atc_pcm_stop(struct ct_atc *atc, struct ct_atc_pcm *apcm)
404 {
405 	struct src *src;
406 	int i;
407 
408 	ct_timer_stop(apcm->timer);
409 
410 	src = apcm->src;
411 	src->ops->set_bm(src, 0);
412 	src->ops->set_state(src, SRC_STATE_OFF);
413 	src->ops->commit_write(src);
414 
415 	if (apcm->srccs) {
416 		for (i = 0; i < apcm->n_srcc; i++) {
417 			src = apcm->srccs[i];
418 			src->ops->set_bm(src, 0);
419 			src->ops->set_state(src, SRC_STATE_OFF);
420 			src->ops->commit_write(src);
421 		}
422 	}
423 
424 	apcm->started = 0;
425 
426 	return 0;
427 }
428 
429 static int
430 atc_pcm_playback_position(struct ct_atc *atc, struct ct_atc_pcm *apcm)
431 {
432 	struct src *src = apcm->src;
433 	u32 size, max_cisz;
434 	int position;
435 
436 	if (!src)
437 		return 0;
438 	position = src->ops->get_ca(src);
439 
440 	if (position < apcm->vm_block->addr) {
441 		dev_dbg(atc->card->dev,
442 			"bad ca - ca=0x%08x, vba=0x%08x, vbs=0x%08x\n",
443 			position, apcm->vm_block->addr, apcm->vm_block->size);
444 		position = apcm->vm_block->addr;
445 	}
446 
447 	size = apcm->vm_block->size;
448 	max_cisz = src->multi * src->rsc.msr;
449 	max_cisz = 128 * (max_cisz < 8 ? max_cisz : 8);
450 
451 	return (position + size - max_cisz - apcm->vm_block->addr) % size;
452 }
453 
454 struct src_node_conf_t {
455 	unsigned int pitch;
456 	unsigned int msr:8;
457 	unsigned int mix_msr:8;
458 	unsigned int imp_msr:8;
459 	unsigned int vo:1;
460 };
461 
462 static void setup_src_node_conf(struct ct_atc *atc, struct ct_atc_pcm *apcm,
463 				struct src_node_conf_t *conf, int *n_srcc)
464 {
465 	unsigned int pitch;
466 
467 	/* get pitch and convert to fixed-point 8.24 format. */
468 	pitch = atc_get_pitch((atc->rsr * atc->msr),
469 				apcm->substream->runtime->rate);
470 	*n_srcc = 0;
471 
472 	if (1 == atc->msr) { /* FIXME: do we really need SRC here if pitch==1 */
473 		*n_srcc = apcm->substream->runtime->channels;
474 		conf[0].pitch = pitch;
475 		conf[0].mix_msr = conf[0].imp_msr = conf[0].msr = 1;
476 		conf[0].vo = 1;
477 	} else if (2 <= atc->msr) {
478 		if (0x8000000 < pitch) {
479 			/* Need two-stage SRCs, SRCIMPs and
480 			 * AMIXERs for converting format */
481 			conf[0].pitch = (atc->msr << 24);
482 			conf[0].msr = conf[0].mix_msr = 1;
483 			conf[0].imp_msr = atc->msr;
484 			conf[0].vo = 0;
485 			conf[1].pitch = atc_get_pitch(atc->rsr,
486 					apcm->substream->runtime->rate);
487 			conf[1].msr = conf[1].mix_msr = conf[1].imp_msr = 1;
488 			conf[1].vo = 1;
489 			*n_srcc = apcm->substream->runtime->channels * 2;
490 		} else if (0x1000000 < pitch) {
491 			/* Need one-stage SRCs, SRCIMPs and
492 			 * AMIXERs for converting format */
493 			conf[0].pitch = pitch;
494 			conf[0].msr = conf[0].mix_msr
495 				    = conf[0].imp_msr = atc->msr;
496 			conf[0].vo = 1;
497 			*n_srcc = apcm->substream->runtime->channels;
498 		}
499 	}
500 }
501 
502 static int
503 atc_pcm_capture_get_resources(struct ct_atc *atc, struct ct_atc_pcm *apcm)
504 {
505 	struct src_mgr *src_mgr = atc->rsc_mgrs[SRC];
506 	struct srcimp_mgr *srcimp_mgr = atc->rsc_mgrs[SRCIMP];
507 	struct amixer_mgr *amixer_mgr = atc->rsc_mgrs[AMIXER];
508 	struct sum_mgr *sum_mgr = atc->rsc_mgrs[SUM];
509 	struct src_desc src_dsc = {0};
510 	struct src *src;
511 	struct srcimp_desc srcimp_dsc = {0};
512 	struct srcimp *srcimp;
513 	struct amixer_desc mix_dsc = {0};
514 	struct sum_desc sum_dsc = {0};
515 	unsigned int pitch;
516 	int multi, err, i;
517 	int n_srcimp, n_amixer, n_srcc, n_sum;
518 	struct src_node_conf_t src_node_conf[2] = {{0} };
519 
520 	/* first release old resources */
521 	atc_pcm_release_resources(atc, apcm);
522 
523 	/* The numbers of converting SRCs and SRCIMPs should be determined
524 	 * by pitch value. */
525 
526 	multi = apcm->substream->runtime->channels;
527 
528 	/* get pitch and convert to fixed-point 8.24 format. */
529 	pitch = atc_get_pitch((atc->rsr * atc->msr),
530 				apcm->substream->runtime->rate);
531 
532 	setup_src_node_conf(atc, apcm, src_node_conf, &n_srcc);
533 	n_sum = (1 == multi) ? 1 : 0;
534 	n_amixer = n_sum * 2 + n_srcc;
535 	n_srcimp = n_srcc;
536 	if ((multi > 1) && (0x8000000 >= pitch)) {
537 		/* Need extra AMIXERs and SRCIMPs for special treatment
538 		 * of interleaved recording of conjugate channels */
539 		n_amixer += multi * atc->msr;
540 		n_srcimp += multi * atc->msr;
541 	} else {
542 		n_srcimp += multi;
543 	}
544 
545 	if (n_srcc) {
546 		apcm->srccs = kzalloc(sizeof(void *)*n_srcc, GFP_KERNEL);
547 		if (!apcm->srccs)
548 			return -ENOMEM;
549 	}
550 	if (n_amixer) {
551 		apcm->amixers = kzalloc(sizeof(void *)*n_amixer, GFP_KERNEL);
552 		if (!apcm->amixers) {
553 			err = -ENOMEM;
554 			goto error1;
555 		}
556 	}
557 	apcm->srcimps = kzalloc(sizeof(void *)*n_srcimp, GFP_KERNEL);
558 	if (!apcm->srcimps) {
559 		err = -ENOMEM;
560 		goto error1;
561 	}
562 
563 	/* Allocate SRCs for sample rate conversion if needed */
564 	src_dsc.multi = 1;
565 	src_dsc.mode = ARCRW;
566 	for (i = 0, apcm->n_srcc = 0; i < n_srcc; i++) {
567 		src_dsc.msr = src_node_conf[i/multi].msr;
568 		err = src_mgr->get_src(src_mgr, &src_dsc,
569 					(struct src **)&apcm->srccs[i]);
570 		if (err)
571 			goto error1;
572 
573 		src = apcm->srccs[i];
574 		pitch = src_node_conf[i/multi].pitch;
575 		src->ops->set_pitch(src, pitch);
576 		src->ops->set_rom(src, select_rom(pitch));
577 		src->ops->set_vo(src, src_node_conf[i/multi].vo);
578 
579 		apcm->n_srcc++;
580 	}
581 
582 	/* Allocate AMIXERs for routing SRCs of conversion if needed */
583 	for (i = 0, apcm->n_amixer = 0; i < n_amixer; i++) {
584 		if (i < (n_sum*2))
585 			mix_dsc.msr = atc->msr;
586 		else if (i < (n_sum*2+n_srcc))
587 			mix_dsc.msr = src_node_conf[(i-n_sum*2)/multi].mix_msr;
588 		else
589 			mix_dsc.msr = 1;
590 
591 		err = amixer_mgr->get_amixer(amixer_mgr, &mix_dsc,
592 					(struct amixer **)&apcm->amixers[i]);
593 		if (err)
594 			goto error1;
595 
596 		apcm->n_amixer++;
597 	}
598 
599 	/* Allocate a SUM resource to mix all input channels together */
600 	sum_dsc.msr = atc->msr;
601 	err = sum_mgr->get_sum(sum_mgr, &sum_dsc, (struct sum **)&apcm->mono);
602 	if (err)
603 		goto error1;
604 
605 	pitch = atc_get_pitch((atc->rsr * atc->msr),
606 				apcm->substream->runtime->rate);
607 	/* Allocate SRCIMP resources */
608 	for (i = 0, apcm->n_srcimp = 0; i < n_srcimp; i++) {
609 		if (i < (n_srcc))
610 			srcimp_dsc.msr = src_node_conf[i/multi].imp_msr;
611 		else if (1 == multi)
612 			srcimp_dsc.msr = (pitch <= 0x8000000) ? atc->msr : 1;
613 		else
614 			srcimp_dsc.msr = 1;
615 
616 		err = srcimp_mgr->get_srcimp(srcimp_mgr, &srcimp_dsc, &srcimp);
617 		if (err)
618 			goto error1;
619 
620 		apcm->srcimps[i] = srcimp;
621 		apcm->n_srcimp++;
622 	}
623 
624 	/* Allocate a SRC for writing data to host memory */
625 	src_dsc.multi = apcm->substream->runtime->channels;
626 	src_dsc.msr = 1;
627 	src_dsc.mode = MEMWR;
628 	err = src_mgr->get_src(src_mgr, &src_dsc, (struct src **)&apcm->src);
629 	if (err)
630 		goto error1;
631 
632 	src = apcm->src;
633 	src->ops->set_pitch(src, pitch);
634 
635 	/* Set up device virtual mem map */
636 	err = ct_map_audio_buffer(atc, apcm);
637 	if (err < 0)
638 		goto error1;
639 
640 	return 0;
641 
642 error1:
643 	atc_pcm_release_resources(atc, apcm);
644 	return err;
645 }
646 
647 static int atc_pcm_capture_prepare(struct ct_atc *atc, struct ct_atc_pcm *apcm)
648 {
649 	struct src *src;
650 	struct amixer *amixer;
651 	struct srcimp *srcimp;
652 	struct ct_mixer *mixer = atc->mixer;
653 	struct sum *mono;
654 	struct rsc *out_ports[8] = {NULL};
655 	int err, i, j, n_sum, multi;
656 	unsigned int pitch;
657 	int mix_base = 0, imp_base = 0;
658 
659 	atc_pcm_release_resources(atc, apcm);
660 
661 	/* Get needed resources. */
662 	err = atc_pcm_capture_get_resources(atc, apcm);
663 	if (err)
664 		return err;
665 
666 	/* Connect resources */
667 	mixer->get_output_ports(mixer, MIX_PCMO_FRONT,
668 				&out_ports[0], &out_ports[1]);
669 
670 	multi = apcm->substream->runtime->channels;
671 	if (1 == multi) {
672 		mono = apcm->mono;
673 		for (i = 0; i < 2; i++) {
674 			amixer = apcm->amixers[i];
675 			amixer->ops->setup(amixer, out_ports[i],
676 						MONO_SUM_SCALE, mono);
677 		}
678 		out_ports[0] = &mono->rsc;
679 		n_sum = 1;
680 		mix_base = n_sum * 2;
681 	}
682 
683 	for (i = 0; i < apcm->n_srcc; i++) {
684 		src = apcm->srccs[i];
685 		srcimp = apcm->srcimps[imp_base+i];
686 		amixer = apcm->amixers[mix_base+i];
687 		srcimp->ops->map(srcimp, src, out_ports[i%multi]);
688 		amixer->ops->setup(amixer, &src->rsc, INIT_VOL, NULL);
689 		out_ports[i%multi] = &amixer->rsc;
690 	}
691 
692 	pitch = atc_get_pitch((atc->rsr * atc->msr),
693 				apcm->substream->runtime->rate);
694 
695 	if ((multi > 1) && (pitch <= 0x8000000)) {
696 		/* Special connection for interleaved
697 		 * recording with conjugate channels */
698 		for (i = 0; i < multi; i++) {
699 			out_ports[i]->ops->master(out_ports[i]);
700 			for (j = 0; j < atc->msr; j++) {
701 				amixer = apcm->amixers[apcm->n_srcc+j*multi+i];
702 				amixer->ops->set_input(amixer, out_ports[i]);
703 				amixer->ops->set_scale(amixer, INIT_VOL);
704 				amixer->ops->set_sum(amixer, NULL);
705 				amixer->ops->commit_raw_write(amixer);
706 				out_ports[i]->ops->next_conj(out_ports[i]);
707 
708 				srcimp = apcm->srcimps[apcm->n_srcc+j*multi+i];
709 				srcimp->ops->map(srcimp, apcm->src,
710 							&amixer->rsc);
711 			}
712 		}
713 	} else {
714 		for (i = 0; i < multi; i++) {
715 			srcimp = apcm->srcimps[apcm->n_srcc+i];
716 			srcimp->ops->map(srcimp, apcm->src, out_ports[i]);
717 		}
718 	}
719 
720 	ct_timer_prepare(apcm->timer);
721 
722 	return 0;
723 }
724 
725 static int atc_pcm_capture_start(struct ct_atc *atc, struct ct_atc_pcm *apcm)
726 {
727 	struct src *src;
728 	struct src_mgr *src_mgr = atc->rsc_mgrs[SRC];
729 	int i, multi;
730 
731 	if (apcm->started)
732 		return 0;
733 
734 	apcm->started = 1;
735 	multi = apcm->substream->runtime->channels;
736 	/* Set up converting SRCs */
737 	for (i = 0; i < apcm->n_srcc; i++) {
738 		src = apcm->srccs[i];
739 		src->ops->set_pm(src, ((i%multi) != (multi-1)));
740 		src_mgr->src_disable(src_mgr, src);
741 	}
742 
743 	/*  Set up recording SRC */
744 	src = apcm->src;
745 	src->ops->set_sf(src, convert_format(apcm->substream->runtime->format,
746 					     atc->card));
747 	src->ops->set_sa(src, apcm->vm_block->addr);
748 	src->ops->set_la(src, apcm->vm_block->addr + apcm->vm_block->size);
749 	src->ops->set_ca(src, apcm->vm_block->addr);
750 	src_mgr->src_disable(src_mgr, src);
751 
752 	/* Disable relevant SRCs firstly */
753 	src_mgr->commit_write(src_mgr);
754 
755 	/* Enable SRCs respectively */
756 	for (i = 0; i < apcm->n_srcc; i++) {
757 		src = apcm->srccs[i];
758 		src->ops->set_state(src, SRC_STATE_RUN);
759 		src->ops->commit_write(src);
760 		src_mgr->src_enable_s(src_mgr, src);
761 	}
762 	src = apcm->src;
763 	src->ops->set_bm(src, 1);
764 	src->ops->set_state(src, SRC_STATE_RUN);
765 	src->ops->commit_write(src);
766 	src_mgr->src_enable_s(src_mgr, src);
767 
768 	/* Enable relevant SRCs synchronously */
769 	src_mgr->commit_write(src_mgr);
770 
771 	ct_timer_start(apcm->timer);
772 	return 0;
773 }
774 
775 static int
776 atc_pcm_capture_position(struct ct_atc *atc, struct ct_atc_pcm *apcm)
777 {
778 	struct src *src = apcm->src;
779 
780 	if (!src)
781 		return 0;
782 	return src->ops->get_ca(src) - apcm->vm_block->addr;
783 }
784 
785 static int spdif_passthru_playback_get_resources(struct ct_atc *atc,
786 						 struct ct_atc_pcm *apcm)
787 {
788 	struct src_mgr *src_mgr = atc->rsc_mgrs[SRC];
789 	struct amixer_mgr *amixer_mgr = atc->rsc_mgrs[AMIXER];
790 	struct src_desc desc = {0};
791 	struct amixer_desc mix_dsc = {0};
792 	struct src *src;
793 	int err;
794 	int n_amixer = apcm->substream->runtime->channels, i;
795 	unsigned int pitch, rsr = atc->pll_rate;
796 
797 	/* first release old resources */
798 	atc_pcm_release_resources(atc, apcm);
799 
800 	/* Get SRC resource */
801 	desc.multi = apcm->substream->runtime->channels;
802 	desc.msr = 1;
803 	while (apcm->substream->runtime->rate > (rsr * desc.msr))
804 		desc.msr <<= 1;
805 
806 	desc.mode = MEMRD;
807 	err = src_mgr->get_src(src_mgr, &desc, (struct src **)&apcm->src);
808 	if (err)
809 		goto error1;
810 
811 	pitch = atc_get_pitch(apcm->substream->runtime->rate, (rsr * desc.msr));
812 	src = apcm->src;
813 	src->ops->set_pitch(src, pitch);
814 	src->ops->set_rom(src, select_rom(pitch));
815 	src->ops->set_sf(src, convert_format(apcm->substream->runtime->format,
816 					     atc->card));
817 	src->ops->set_pm(src, (src->ops->next_interleave(src) != NULL));
818 	src->ops->set_bp(src, 1);
819 
820 	/* Get AMIXER resource */
821 	n_amixer = (n_amixer < 2) ? 2 : n_amixer;
822 	apcm->amixers = kzalloc(sizeof(void *)*n_amixer, GFP_KERNEL);
823 	if (!apcm->amixers) {
824 		err = -ENOMEM;
825 		goto error1;
826 	}
827 	mix_dsc.msr = desc.msr;
828 	for (i = 0, apcm->n_amixer = 0; i < n_amixer; i++) {
829 		err = amixer_mgr->get_amixer(amixer_mgr, &mix_dsc,
830 					(struct amixer **)&apcm->amixers[i]);
831 		if (err)
832 			goto error1;
833 
834 		apcm->n_amixer++;
835 	}
836 
837 	/* Set up device virtual mem map */
838 	err = ct_map_audio_buffer(atc, apcm);
839 	if (err < 0)
840 		goto error1;
841 
842 	return 0;
843 
844 error1:
845 	atc_pcm_release_resources(atc, apcm);
846 	return err;
847 }
848 
849 static int atc_pll_init(struct ct_atc *atc, int rate)
850 {
851 	struct hw *hw = atc->hw;
852 	int err;
853 	err = hw->pll_init(hw, rate);
854 	atc->pll_rate = err ? 0 : rate;
855 	return err;
856 }
857 
858 static int
859 spdif_passthru_playback_setup(struct ct_atc *atc, struct ct_atc_pcm *apcm)
860 {
861 	struct dao *dao = container_of(atc->daios[SPDIFOO], struct dao, daio);
862 	unsigned int rate = apcm->substream->runtime->rate;
863 	unsigned int status;
864 	int err = 0;
865 	unsigned char iec958_con_fs;
866 
867 	switch (rate) {
868 	case 48000:
869 		iec958_con_fs = IEC958_AES3_CON_FS_48000;
870 		break;
871 	case 44100:
872 		iec958_con_fs = IEC958_AES3_CON_FS_44100;
873 		break;
874 	case 32000:
875 		iec958_con_fs = IEC958_AES3_CON_FS_32000;
876 		break;
877 	default:
878 		return -ENOENT;
879 	}
880 
881 	mutex_lock(&atc->atc_mutex);
882 	dao->ops->get_spos(dao, &status);
883 	if (((status >> 24) & IEC958_AES3_CON_FS) != iec958_con_fs) {
884 		status &= ~(IEC958_AES3_CON_FS << 24);
885 		status |= (iec958_con_fs << 24);
886 		dao->ops->set_spos(dao, status);
887 		dao->ops->commit_write(dao);
888 	}
889 	if ((rate != atc->pll_rate) && (32000 != rate))
890 		err = atc_pll_init(atc, rate);
891 	mutex_unlock(&atc->atc_mutex);
892 
893 	return err;
894 }
895 
896 static int
897 spdif_passthru_playback_prepare(struct ct_atc *atc, struct ct_atc_pcm *apcm)
898 {
899 	struct src *src;
900 	struct amixer *amixer;
901 	struct dao *dao;
902 	int err;
903 	int i;
904 
905 	atc_pcm_release_resources(atc, apcm);
906 
907 	/* Configure SPDIFOO and PLL to passthrough mode;
908 	 * determine pll_rate. */
909 	err = spdif_passthru_playback_setup(atc, apcm);
910 	if (err)
911 		return err;
912 
913 	/* Get needed resources. */
914 	err = spdif_passthru_playback_get_resources(atc, apcm);
915 	if (err)
916 		return err;
917 
918 	/* Connect resources */
919 	src = apcm->src;
920 	for (i = 0; i < apcm->n_amixer; i++) {
921 		amixer = apcm->amixers[i];
922 		amixer->ops->setup(amixer, &src->rsc, INIT_VOL, NULL);
923 		src = src->ops->next_interleave(src);
924 		if (!src)
925 			src = apcm->src;
926 	}
927 	/* Connect to SPDIFOO */
928 	mutex_lock(&atc->atc_mutex);
929 	dao = container_of(atc->daios[SPDIFOO], struct dao, daio);
930 	amixer = apcm->amixers[0];
931 	dao->ops->set_left_input(dao, &amixer->rsc);
932 	amixer = apcm->amixers[1];
933 	dao->ops->set_right_input(dao, &amixer->rsc);
934 	mutex_unlock(&atc->atc_mutex);
935 
936 	ct_timer_prepare(apcm->timer);
937 
938 	return 0;
939 }
940 
941 static int atc_select_line_in(struct ct_atc *atc)
942 {
943 	struct hw *hw = atc->hw;
944 	struct ct_mixer *mixer = atc->mixer;
945 	struct src *src;
946 
947 	if (hw->is_adc_source_selected(hw, ADC_LINEIN))
948 		return 0;
949 
950 	mixer->set_input_left(mixer, MIX_MIC_IN, NULL);
951 	mixer->set_input_right(mixer, MIX_MIC_IN, NULL);
952 
953 	hw->select_adc_source(hw, ADC_LINEIN);
954 
955 	src = atc->srcs[2];
956 	mixer->set_input_left(mixer, MIX_LINE_IN, &src->rsc);
957 	src = atc->srcs[3];
958 	mixer->set_input_right(mixer, MIX_LINE_IN, &src->rsc);
959 
960 	return 0;
961 }
962 
963 static int atc_select_mic_in(struct ct_atc *atc)
964 {
965 	struct hw *hw = atc->hw;
966 	struct ct_mixer *mixer = atc->mixer;
967 	struct src *src;
968 
969 	if (hw->is_adc_source_selected(hw, ADC_MICIN))
970 		return 0;
971 
972 	mixer->set_input_left(mixer, MIX_LINE_IN, NULL);
973 	mixer->set_input_right(mixer, MIX_LINE_IN, NULL);
974 
975 	hw->select_adc_source(hw, ADC_MICIN);
976 
977 	src = atc->srcs[2];
978 	mixer->set_input_left(mixer, MIX_MIC_IN, &src->rsc);
979 	src = atc->srcs[3];
980 	mixer->set_input_right(mixer, MIX_MIC_IN, &src->rsc);
981 
982 	return 0;
983 }
984 
985 static struct capabilities atc_capabilities(struct ct_atc *atc)
986 {
987 	struct hw *hw = atc->hw;
988 
989 	return hw->capabilities(hw);
990 }
991 
992 static int atc_output_switch_get(struct ct_atc *atc)
993 {
994 	struct hw *hw = atc->hw;
995 
996 	return hw->output_switch_get(hw);
997 }
998 
999 static int atc_output_switch_put(struct ct_atc *atc, int position)
1000 {
1001 	struct hw *hw = atc->hw;
1002 
1003 	return hw->output_switch_put(hw, position);
1004 }
1005 
1006 static int atc_mic_source_switch_get(struct ct_atc *atc)
1007 {
1008 	struct hw *hw = atc->hw;
1009 
1010 	return hw->mic_source_switch_get(hw);
1011 }
1012 
1013 static int atc_mic_source_switch_put(struct ct_atc *atc, int position)
1014 {
1015 	struct hw *hw = atc->hw;
1016 
1017 	return hw->mic_source_switch_put(hw, position);
1018 }
1019 
1020 static int atc_select_digit_io(struct ct_atc *atc)
1021 {
1022 	struct hw *hw = atc->hw;
1023 
1024 	if (hw->is_adc_source_selected(hw, ADC_NONE))
1025 		return 0;
1026 
1027 	hw->select_adc_source(hw, ADC_NONE);
1028 
1029 	return 0;
1030 }
1031 
1032 static int atc_daio_unmute(struct ct_atc *atc, unsigned char state, int type)
1033 {
1034 	struct daio_mgr *daio_mgr = atc->rsc_mgrs[DAIO];
1035 
1036 	if (state)
1037 		daio_mgr->daio_enable(daio_mgr, atc->daios[type]);
1038 	else
1039 		daio_mgr->daio_disable(daio_mgr, atc->daios[type]);
1040 
1041 	daio_mgr->commit_write(daio_mgr);
1042 
1043 	return 0;
1044 }
1045 
1046 static int
1047 atc_dao_get_status(struct ct_atc *atc, unsigned int *status, int type)
1048 {
1049 	struct dao *dao = container_of(atc->daios[type], struct dao, daio);
1050 	return dao->ops->get_spos(dao, status);
1051 }
1052 
1053 static int
1054 atc_dao_set_status(struct ct_atc *atc, unsigned int status, int type)
1055 {
1056 	struct dao *dao = container_of(atc->daios[type], struct dao, daio);
1057 
1058 	dao->ops->set_spos(dao, status);
1059 	dao->ops->commit_write(dao);
1060 	return 0;
1061 }
1062 
1063 static int atc_line_front_unmute(struct ct_atc *atc, unsigned char state)
1064 {
1065 	return atc_daio_unmute(atc, state, LINEO1);
1066 }
1067 
1068 static int atc_line_surround_unmute(struct ct_atc *atc, unsigned char state)
1069 {
1070 	return atc_daio_unmute(atc, state, LINEO2);
1071 }
1072 
1073 static int atc_line_clfe_unmute(struct ct_atc *atc, unsigned char state)
1074 {
1075 	return atc_daio_unmute(atc, state, LINEO3);
1076 }
1077 
1078 static int atc_line_rear_unmute(struct ct_atc *atc, unsigned char state)
1079 {
1080 	return atc_daio_unmute(atc, state, LINEO4);
1081 }
1082 
1083 static int atc_line_in_unmute(struct ct_atc *atc, unsigned char state)
1084 {
1085 	return atc_daio_unmute(atc, state, LINEIM);
1086 }
1087 
1088 static int atc_mic_unmute(struct ct_atc *atc, unsigned char state)
1089 {
1090 	return atc_daio_unmute(atc, state, MIC);
1091 }
1092 
1093 static int atc_spdif_out_unmute(struct ct_atc *atc, unsigned char state)
1094 {
1095 	return atc_daio_unmute(atc, state, SPDIFOO);
1096 }
1097 
1098 static int atc_spdif_in_unmute(struct ct_atc *atc, unsigned char state)
1099 {
1100 	return atc_daio_unmute(atc, state, SPDIFIO);
1101 }
1102 
1103 static int atc_spdif_out_get_status(struct ct_atc *atc, unsigned int *status)
1104 {
1105 	return atc_dao_get_status(atc, status, SPDIFOO);
1106 }
1107 
1108 static int atc_spdif_out_set_status(struct ct_atc *atc, unsigned int status)
1109 {
1110 	return atc_dao_set_status(atc, status, SPDIFOO);
1111 }
1112 
1113 static int atc_spdif_out_passthru(struct ct_atc *atc, unsigned char state)
1114 {
1115 	struct dao_desc da_dsc = {0};
1116 	struct dao *dao;
1117 	int err;
1118 	struct ct_mixer *mixer = atc->mixer;
1119 	struct rsc *rscs[2] = {NULL};
1120 	unsigned int spos = 0;
1121 
1122 	mutex_lock(&atc->atc_mutex);
1123 	dao = container_of(atc->daios[SPDIFOO], struct dao, daio);
1124 	da_dsc.msr = state ? 1 : atc->msr;
1125 	da_dsc.passthru = state ? 1 : 0;
1126 	err = dao->ops->reinit(dao, &da_dsc);
1127 	if (state) {
1128 		spos = IEC958_DEFAULT_CON;
1129 	} else {
1130 		mixer->get_output_ports(mixer, MIX_SPDIF_OUT,
1131 					&rscs[0], &rscs[1]);
1132 		dao->ops->set_left_input(dao, rscs[0]);
1133 		dao->ops->set_right_input(dao, rscs[1]);
1134 		/* Restore PLL to atc->rsr if needed. */
1135 		if (atc->pll_rate != atc->rsr)
1136 			err = atc_pll_init(atc, atc->rsr);
1137 	}
1138 	dao->ops->set_spos(dao, spos);
1139 	dao->ops->commit_write(dao);
1140 	mutex_unlock(&atc->atc_mutex);
1141 
1142 	return err;
1143 }
1144 
1145 static int atc_release_resources(struct ct_atc *atc)
1146 {
1147 	int i;
1148 	struct daio_mgr *daio_mgr = NULL;
1149 	struct dao *dao = NULL;
1150 	struct daio *daio = NULL;
1151 	struct sum_mgr *sum_mgr = NULL;
1152 	struct src_mgr *src_mgr = NULL;
1153 	struct srcimp_mgr *srcimp_mgr = NULL;
1154 	struct srcimp *srcimp = NULL;
1155 	struct ct_mixer *mixer = NULL;
1156 
1157 	/* disconnect internal mixer objects */
1158 	if (atc->mixer) {
1159 		mixer = atc->mixer;
1160 		mixer->set_input_left(mixer, MIX_LINE_IN, NULL);
1161 		mixer->set_input_right(mixer, MIX_LINE_IN, NULL);
1162 		mixer->set_input_left(mixer, MIX_MIC_IN, NULL);
1163 		mixer->set_input_right(mixer, MIX_MIC_IN, NULL);
1164 		mixer->set_input_left(mixer, MIX_SPDIF_IN, NULL);
1165 		mixer->set_input_right(mixer, MIX_SPDIF_IN, NULL);
1166 	}
1167 
1168 	if (atc->daios) {
1169 		daio_mgr = (struct daio_mgr *)atc->rsc_mgrs[DAIO];
1170 		for (i = 0; i < atc->n_daio; i++) {
1171 			daio = atc->daios[i];
1172 			if (daio->type < LINEIM) {
1173 				dao = container_of(daio, struct dao, daio);
1174 				dao->ops->clear_left_input(dao);
1175 				dao->ops->clear_right_input(dao);
1176 			}
1177 			daio_mgr->put_daio(daio_mgr, daio);
1178 		}
1179 		kfree(atc->daios);
1180 		atc->daios = NULL;
1181 	}
1182 
1183 	if (atc->pcm) {
1184 		sum_mgr = atc->rsc_mgrs[SUM];
1185 		for (i = 0; i < atc->n_pcm; i++)
1186 			sum_mgr->put_sum(sum_mgr, atc->pcm[i]);
1187 
1188 		kfree(atc->pcm);
1189 		atc->pcm = NULL;
1190 	}
1191 
1192 	if (atc->srcs) {
1193 		src_mgr = atc->rsc_mgrs[SRC];
1194 		for (i = 0; i < atc->n_src; i++)
1195 			src_mgr->put_src(src_mgr, atc->srcs[i]);
1196 
1197 		kfree(atc->srcs);
1198 		atc->srcs = NULL;
1199 	}
1200 
1201 	if (atc->srcimps) {
1202 		srcimp_mgr = atc->rsc_mgrs[SRCIMP];
1203 		for (i = 0; i < atc->n_srcimp; i++) {
1204 			srcimp = atc->srcimps[i];
1205 			srcimp->ops->unmap(srcimp);
1206 			srcimp_mgr->put_srcimp(srcimp_mgr, atc->srcimps[i]);
1207 		}
1208 		kfree(atc->srcimps);
1209 		atc->srcimps = NULL;
1210 	}
1211 
1212 	return 0;
1213 }
1214 
1215 static int ct_atc_destroy(struct ct_atc *atc)
1216 {
1217 	int i = 0;
1218 
1219 	if (!atc)
1220 		return 0;
1221 
1222 	if (atc->timer) {
1223 		ct_timer_free(atc->timer);
1224 		atc->timer = NULL;
1225 	}
1226 
1227 	atc_release_resources(atc);
1228 
1229 	/* Destroy internal mixer objects */
1230 	if (atc->mixer)
1231 		ct_mixer_destroy(atc->mixer);
1232 
1233 	for (i = 0; i < NUM_RSCTYP; i++) {
1234 		if (rsc_mgr_funcs[i].destroy && atc->rsc_mgrs[i])
1235 			rsc_mgr_funcs[i].destroy(atc->rsc_mgrs[i]);
1236 
1237 	}
1238 
1239 	if (atc->hw)
1240 		destroy_hw_obj(atc->hw);
1241 
1242 	/* Destroy device virtual memory manager object */
1243 	if (atc->vm) {
1244 		ct_vm_destroy(atc->vm);
1245 		atc->vm = NULL;
1246 	}
1247 
1248 	kfree(atc);
1249 
1250 	return 0;
1251 }
1252 
1253 static int atc_dev_free(struct snd_device *dev)
1254 {
1255 	struct ct_atc *atc = dev->device_data;
1256 	return ct_atc_destroy(atc);
1257 }
1258 
1259 static int atc_identify_card(struct ct_atc *atc, unsigned int ssid)
1260 {
1261 	const struct snd_pci_quirk *p;
1262 	const struct snd_pci_quirk *list;
1263 	u16 vendor_id, device_id;
1264 
1265 	switch (atc->chip_type) {
1266 	case ATC20K1:
1267 		atc->chip_name = "20K1";
1268 		list = subsys_20k1_list;
1269 		break;
1270 	case ATC20K2:
1271 		atc->chip_name = "20K2";
1272 		list = subsys_20k2_list;
1273 		break;
1274 	default:
1275 		return -ENOENT;
1276 	}
1277 	if (ssid) {
1278 		vendor_id = ssid >> 16;
1279 		device_id = ssid & 0xffff;
1280 	} else {
1281 		vendor_id = atc->pci->subsystem_vendor;
1282 		device_id = atc->pci->subsystem_device;
1283 	}
1284 	p = snd_pci_quirk_lookup_id(vendor_id, device_id, list);
1285 	if (p) {
1286 		if (p->value < 0) {
1287 			dev_err(atc->card->dev,
1288 				"Device %04x:%04x is black-listed\n",
1289 				vendor_id, device_id);
1290 			return -ENOENT;
1291 		}
1292 		atc->model = p->value;
1293 	} else {
1294 		if (atc->chip_type == ATC20K1)
1295 			atc->model = CT20K1_UNKNOWN;
1296 		else
1297 			atc->model = CT20K2_UNKNOWN;
1298 	}
1299 	atc->model_name = ct_subsys_name[atc->model];
1300 	dev_info(atc->card->dev, "chip %s model %s (%04x:%04x) is found\n",
1301 		   atc->chip_name, atc->model_name,
1302 		   vendor_id, device_id);
1303 	return 0;
1304 }
1305 
1306 int ct_atc_create_alsa_devs(struct ct_atc *atc)
1307 {
1308 	enum CTALSADEVS i;
1309 	int err;
1310 
1311 	alsa_dev_funcs[MIXER].public_name = atc->chip_name;
1312 
1313 	for (i = 0; i < NUM_CTALSADEVS; i++) {
1314 		if (!alsa_dev_funcs[i].create)
1315 			continue;
1316 
1317 		err = alsa_dev_funcs[i].create(atc, i,
1318 				alsa_dev_funcs[i].public_name);
1319 		if (err) {
1320 			dev_err(atc->card->dev,
1321 				"Creating alsa device %d failed!\n", i);
1322 			return err;
1323 		}
1324 	}
1325 
1326 	return 0;
1327 }
1328 
1329 static int atc_create_hw_devs(struct ct_atc *atc)
1330 {
1331 	struct hw *hw;
1332 	struct card_conf info = {0};
1333 	int i, err;
1334 
1335 	err = create_hw_obj(atc->pci, atc->chip_type, atc->model, &hw);
1336 	if (err) {
1337 		dev_err(atc->card->dev, "Failed to create hw obj!!!\n");
1338 		return err;
1339 	}
1340 	hw->card = atc->card;
1341 	atc->hw = hw;
1342 
1343 	/* Initialize card hardware. */
1344 	info.rsr = atc->rsr;
1345 	info.msr = atc->msr;
1346 	info.vm_pgt_phys = atc_get_ptp_phys(atc, 0);
1347 	err = hw->card_init(hw, &info);
1348 	if (err < 0)
1349 		return err;
1350 
1351 	for (i = 0; i < NUM_RSCTYP; i++) {
1352 		if (!rsc_mgr_funcs[i].create)
1353 			continue;
1354 
1355 		err = rsc_mgr_funcs[i].create(atc->hw, &atc->rsc_mgrs[i]);
1356 		if (err) {
1357 			dev_err(atc->card->dev,
1358 				"Failed to create rsc_mgr %d!!!\n", i);
1359 			return err;
1360 		}
1361 	}
1362 
1363 	return 0;
1364 }
1365 
1366 static int atc_get_resources(struct ct_atc *atc)
1367 {
1368 	struct daio_desc da_desc = {0};
1369 	struct daio_mgr *daio_mgr;
1370 	struct src_desc src_dsc = {0};
1371 	struct src_mgr *src_mgr;
1372 	struct srcimp_desc srcimp_dsc = {0};
1373 	struct srcimp_mgr *srcimp_mgr;
1374 	struct sum_desc sum_dsc = {0};
1375 	struct sum_mgr *sum_mgr;
1376 	int err, i, num_srcs, num_daios;
1377 
1378 	num_daios = ((atc->model == CTSB1270) ? 8 : 7);
1379 	num_srcs = ((atc->model == CTSB1270) ? 6 : 4);
1380 
1381 	atc->daios = kzalloc(sizeof(void *)*num_daios, GFP_KERNEL);
1382 	if (!atc->daios)
1383 		return -ENOMEM;
1384 
1385 	atc->srcs = kzalloc(sizeof(void *)*num_srcs, GFP_KERNEL);
1386 	if (!atc->srcs)
1387 		return -ENOMEM;
1388 
1389 	atc->srcimps = kzalloc(sizeof(void *)*num_srcs, GFP_KERNEL);
1390 	if (!atc->srcimps)
1391 		return -ENOMEM;
1392 
1393 	atc->pcm = kzalloc(sizeof(void *)*(2*4), GFP_KERNEL);
1394 	if (!atc->pcm)
1395 		return -ENOMEM;
1396 
1397 	daio_mgr = (struct daio_mgr *)atc->rsc_mgrs[DAIO];
1398 	da_desc.msr = atc->msr;
1399 	for (i = 0, atc->n_daio = 0; i < num_daios; i++) {
1400 		da_desc.type = (atc->model != CTSB073X) ? i :
1401 			     ((i == SPDIFIO) ? SPDIFI1 : i);
1402 		err = daio_mgr->get_daio(daio_mgr, &da_desc,
1403 					(struct daio **)&atc->daios[i]);
1404 		if (err) {
1405 			dev_err(atc->card->dev,
1406 				"Failed to get DAIO resource %d!!!\n",
1407 				i);
1408 			return err;
1409 		}
1410 		atc->n_daio++;
1411 	}
1412 
1413 	src_mgr = atc->rsc_mgrs[SRC];
1414 	src_dsc.multi = 1;
1415 	src_dsc.msr = atc->msr;
1416 	src_dsc.mode = ARCRW;
1417 	for (i = 0, atc->n_src = 0; i < num_srcs; i++) {
1418 		err = src_mgr->get_src(src_mgr, &src_dsc,
1419 					(struct src **)&atc->srcs[i]);
1420 		if (err)
1421 			return err;
1422 
1423 		atc->n_src++;
1424 	}
1425 
1426 	srcimp_mgr = atc->rsc_mgrs[SRCIMP];
1427 	srcimp_dsc.msr = 8;
1428 	for (i = 0, atc->n_srcimp = 0; i < num_srcs; i++) {
1429 		err = srcimp_mgr->get_srcimp(srcimp_mgr, &srcimp_dsc,
1430 					(struct srcimp **)&atc->srcimps[i]);
1431 		if (err)
1432 			return err;
1433 
1434 		atc->n_srcimp++;
1435 	}
1436 
1437 	sum_mgr = atc->rsc_mgrs[SUM];
1438 	sum_dsc.msr = atc->msr;
1439 	for (i = 0, atc->n_pcm = 0; i < (2*4); i++) {
1440 		err = sum_mgr->get_sum(sum_mgr, &sum_dsc,
1441 					(struct sum **)&atc->pcm[i]);
1442 		if (err)
1443 			return err;
1444 
1445 		atc->n_pcm++;
1446 	}
1447 
1448 	return 0;
1449 }
1450 
1451 static void
1452 atc_connect_dai(struct src_mgr *src_mgr, struct dai *dai,
1453 		struct src **srcs, struct srcimp **srcimps)
1454 {
1455 	struct rsc *rscs[2] = {NULL};
1456 	struct src *src;
1457 	struct srcimp *srcimp;
1458 	int i = 0;
1459 
1460 	rscs[0] = &dai->daio.rscl;
1461 	rscs[1] = &dai->daio.rscr;
1462 	for (i = 0; i < 2; i++) {
1463 		src = srcs[i];
1464 		srcimp = srcimps[i];
1465 		srcimp->ops->map(srcimp, src, rscs[i]);
1466 		src_mgr->src_disable(src_mgr, src);
1467 	}
1468 
1469 	src_mgr->commit_write(src_mgr); /* Actually disable SRCs */
1470 
1471 	src = srcs[0];
1472 	src->ops->set_pm(src, 1);
1473 	for (i = 0; i < 2; i++) {
1474 		src = srcs[i];
1475 		src->ops->set_state(src, SRC_STATE_RUN);
1476 		src->ops->commit_write(src);
1477 		src_mgr->src_enable_s(src_mgr, src);
1478 	}
1479 
1480 	dai->ops->set_srt_srcl(dai, &(srcs[0]->rsc));
1481 	dai->ops->set_srt_srcr(dai, &(srcs[1]->rsc));
1482 
1483 	dai->ops->set_enb_src(dai, 1);
1484 	dai->ops->set_enb_srt(dai, 1);
1485 	dai->ops->commit_write(dai);
1486 
1487 	src_mgr->commit_write(src_mgr); /* Synchronously enable SRCs */
1488 }
1489 
1490 static void atc_connect_resources(struct ct_atc *atc)
1491 {
1492 	struct dai *dai;
1493 	struct dao *dao;
1494 	struct src *src;
1495 	struct sum *sum;
1496 	struct ct_mixer *mixer;
1497 	struct rsc *rscs[2] = {NULL};
1498 	int i, j;
1499 
1500 	mixer = atc->mixer;
1501 
1502 	for (i = MIX_WAVE_FRONT, j = LINEO1; i <= MIX_SPDIF_OUT; i++, j++) {
1503 		mixer->get_output_ports(mixer, i, &rscs[0], &rscs[1]);
1504 		dao = container_of(atc->daios[j], struct dao, daio);
1505 		dao->ops->set_left_input(dao, rscs[0]);
1506 		dao->ops->set_right_input(dao, rscs[1]);
1507 	}
1508 
1509 	dai = container_of(atc->daios[LINEIM], struct dai, daio);
1510 	atc_connect_dai(atc->rsc_mgrs[SRC], dai,
1511 			(struct src **)&atc->srcs[2],
1512 			(struct srcimp **)&atc->srcimps[2]);
1513 	src = atc->srcs[2];
1514 	mixer->set_input_left(mixer, MIX_LINE_IN, &src->rsc);
1515 	src = atc->srcs[3];
1516 	mixer->set_input_right(mixer, MIX_LINE_IN, &src->rsc);
1517 
1518 	if (atc->model == CTSB1270) {
1519 		/* Titanium HD has a dedicated ADC for the Mic. */
1520 		dai = container_of(atc->daios[MIC], struct dai, daio);
1521 		atc_connect_dai(atc->rsc_mgrs[SRC], dai,
1522 			(struct src **)&atc->srcs[4],
1523 			(struct srcimp **)&atc->srcimps[4]);
1524 		src = atc->srcs[4];
1525 		mixer->set_input_left(mixer, MIX_MIC_IN, &src->rsc);
1526 		src = atc->srcs[5];
1527 		mixer->set_input_right(mixer, MIX_MIC_IN, &src->rsc);
1528 	}
1529 
1530 	dai = container_of(atc->daios[SPDIFIO], struct dai, daio);
1531 	atc_connect_dai(atc->rsc_mgrs[SRC], dai,
1532 			(struct src **)&atc->srcs[0],
1533 			(struct srcimp **)&atc->srcimps[0]);
1534 
1535 	src = atc->srcs[0];
1536 	mixer->set_input_left(mixer, MIX_SPDIF_IN, &src->rsc);
1537 	src = atc->srcs[1];
1538 	mixer->set_input_right(mixer, MIX_SPDIF_IN, &src->rsc);
1539 
1540 	for (i = MIX_PCMI_FRONT, j = 0; i <= MIX_PCMI_SURROUND; i++, j += 2) {
1541 		sum = atc->pcm[j];
1542 		mixer->set_input_left(mixer, i, &sum->rsc);
1543 		sum = atc->pcm[j+1];
1544 		mixer->set_input_right(mixer, i, &sum->rsc);
1545 	}
1546 }
1547 
1548 #ifdef CONFIG_PM_SLEEP
1549 static int atc_suspend(struct ct_atc *atc)
1550 {
1551 	int i;
1552 	struct hw *hw = atc->hw;
1553 
1554 	snd_power_change_state(atc->card, SNDRV_CTL_POWER_D3hot);
1555 
1556 	for (i = FRONT; i < NUM_PCMS; i++) {
1557 		if (!atc->pcms[i])
1558 			continue;
1559 
1560 		snd_pcm_suspend_all(atc->pcms[i]);
1561 	}
1562 
1563 	atc_release_resources(atc);
1564 
1565 	hw->suspend(hw);
1566 
1567 	return 0;
1568 }
1569 
1570 static int atc_hw_resume(struct ct_atc *atc)
1571 {
1572 	struct hw *hw = atc->hw;
1573 	struct card_conf info = {0};
1574 
1575 	/* Re-initialize card hardware. */
1576 	info.rsr = atc->rsr;
1577 	info.msr = atc->msr;
1578 	info.vm_pgt_phys = atc_get_ptp_phys(atc, 0);
1579 	return hw->resume(hw, &info);
1580 }
1581 
1582 static int atc_resources_resume(struct ct_atc *atc)
1583 {
1584 	struct ct_mixer *mixer;
1585 	int err = 0;
1586 
1587 	/* Get resources */
1588 	err = atc_get_resources(atc);
1589 	if (err < 0) {
1590 		atc_release_resources(atc);
1591 		return err;
1592 	}
1593 
1594 	/* Build topology */
1595 	atc_connect_resources(atc);
1596 
1597 	mixer = atc->mixer;
1598 	mixer->resume(mixer);
1599 
1600 	return 0;
1601 }
1602 
1603 static int atc_resume(struct ct_atc *atc)
1604 {
1605 	int err = 0;
1606 
1607 	/* Do hardware resume. */
1608 	err = atc_hw_resume(atc);
1609 	if (err < 0) {
1610 		dev_err(atc->card->dev,
1611 			"pci_enable_device failed, disabling device\n");
1612 		snd_card_disconnect(atc->card);
1613 		return err;
1614 	}
1615 
1616 	err = atc_resources_resume(atc);
1617 	if (err < 0)
1618 		return err;
1619 
1620 	snd_power_change_state(atc->card, SNDRV_CTL_POWER_D0);
1621 
1622 	return 0;
1623 }
1624 #endif
1625 
1626 static struct ct_atc atc_preset = {
1627 	.map_audio_buffer = ct_map_audio_buffer,
1628 	.unmap_audio_buffer = ct_unmap_audio_buffer,
1629 	.pcm_playback_prepare = atc_pcm_playback_prepare,
1630 	.pcm_release_resources = atc_pcm_release_resources,
1631 	.pcm_playback_start = atc_pcm_playback_start,
1632 	.pcm_playback_stop = atc_pcm_stop,
1633 	.pcm_playback_position = atc_pcm_playback_position,
1634 	.pcm_capture_prepare = atc_pcm_capture_prepare,
1635 	.pcm_capture_start = atc_pcm_capture_start,
1636 	.pcm_capture_stop = atc_pcm_stop,
1637 	.pcm_capture_position = atc_pcm_capture_position,
1638 	.spdif_passthru_playback_prepare = spdif_passthru_playback_prepare,
1639 	.get_ptp_phys = atc_get_ptp_phys,
1640 	.select_line_in = atc_select_line_in,
1641 	.select_mic_in = atc_select_mic_in,
1642 	.select_digit_io = atc_select_digit_io,
1643 	.line_front_unmute = atc_line_front_unmute,
1644 	.line_surround_unmute = atc_line_surround_unmute,
1645 	.line_clfe_unmute = atc_line_clfe_unmute,
1646 	.line_rear_unmute = atc_line_rear_unmute,
1647 	.line_in_unmute = atc_line_in_unmute,
1648 	.mic_unmute = atc_mic_unmute,
1649 	.spdif_out_unmute = atc_spdif_out_unmute,
1650 	.spdif_in_unmute = atc_spdif_in_unmute,
1651 	.spdif_out_get_status = atc_spdif_out_get_status,
1652 	.spdif_out_set_status = atc_spdif_out_set_status,
1653 	.spdif_out_passthru = atc_spdif_out_passthru,
1654 	.capabilities = atc_capabilities,
1655 	.output_switch_get = atc_output_switch_get,
1656 	.output_switch_put = atc_output_switch_put,
1657 	.mic_source_switch_get = atc_mic_source_switch_get,
1658 	.mic_source_switch_put = atc_mic_source_switch_put,
1659 #ifdef CONFIG_PM_SLEEP
1660 	.suspend = atc_suspend,
1661 	.resume = atc_resume,
1662 #endif
1663 };
1664 
1665 /**
1666  *  ct_atc_create - create and initialize a hardware manager
1667  *  @card: corresponding alsa card object
1668  *  @pci: corresponding kernel pci device object
1669  *  @ratc: return created object address in it
1670  *
1671  *  Creates and initializes a hardware manager.
1672  *
1673  *  Creates kmallocated ct_atc structure. Initializes hardware.
1674  *  Returns 0 if succeeds, or negative error code if fails.
1675  */
1676 
1677 int ct_atc_create(struct snd_card *card, struct pci_dev *pci,
1678 		  unsigned int rsr, unsigned int msr,
1679 		  int chip_type, unsigned int ssid,
1680 		  struct ct_atc **ratc)
1681 {
1682 	struct ct_atc *atc;
1683 	static struct snd_device_ops ops = {
1684 		.dev_free = atc_dev_free,
1685 	};
1686 	int err;
1687 
1688 	*ratc = NULL;
1689 
1690 	atc = kzalloc(sizeof(*atc), GFP_KERNEL);
1691 	if (!atc)
1692 		return -ENOMEM;
1693 
1694 	/* Set operations */
1695 	*atc = atc_preset;
1696 
1697 	atc->card = card;
1698 	atc->pci = pci;
1699 	atc->rsr = rsr;
1700 	atc->msr = msr;
1701 	atc->chip_type = chip_type;
1702 
1703 	mutex_init(&atc->atc_mutex);
1704 
1705 	/* Find card model */
1706 	err = atc_identify_card(atc, ssid);
1707 	if (err < 0) {
1708 		dev_err(card->dev, "ctatc: Card not recognised\n");
1709 		goto error1;
1710 	}
1711 
1712 	/* Set up device virtual memory management object */
1713 	err = ct_vm_create(&atc->vm, pci);
1714 	if (err < 0)
1715 		goto error1;
1716 
1717 	/* Create all atc hw devices */
1718 	err = atc_create_hw_devs(atc);
1719 	if (err < 0)
1720 		goto error1;
1721 
1722 	err = ct_mixer_create(atc, (struct ct_mixer **)&atc->mixer);
1723 	if (err) {
1724 		dev_err(card->dev, "Failed to create mixer obj!!!\n");
1725 		goto error1;
1726 	}
1727 
1728 	/* Get resources */
1729 	err = atc_get_resources(atc);
1730 	if (err < 0)
1731 		goto error1;
1732 
1733 	/* Build topology */
1734 	atc_connect_resources(atc);
1735 
1736 	atc->timer = ct_timer_new(atc);
1737 	if (!atc->timer) {
1738 		err = -ENOMEM;
1739 		goto error1;
1740 	}
1741 
1742 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, atc, &ops);
1743 	if (err < 0)
1744 		goto error1;
1745 
1746 	*ratc = atc;
1747 	return 0;
1748 
1749 error1:
1750 	ct_atc_destroy(atc);
1751 	dev_err(card->dev, "Something wrong!!!\n");
1752 	return err;
1753 }
1754