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