xref: /openbmc/linux/sound/pci/pcxhr/pcxhr.c (revision 9a6b55ac)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Driver for Digigram pcxhr compatible soundcards
4  *
5  * main file with alsa callbacks
6  *
7  * Copyright (c) 2004 by Digigram <alsa@digigram.com>
8  */
9 
10 
11 #include <linux/init.h>
12 #include <linux/interrupt.h>
13 #include <linux/slab.h>
14 #include <linux/pci.h>
15 #include <linux/dma-mapping.h>
16 #include <linux/delay.h>
17 #include <linux/module.h>
18 #include <linux/mutex.h>
19 
20 #include <sound/core.h>
21 #include <sound/initval.h>
22 #include <sound/info.h>
23 #include <sound/control.h>
24 #include <sound/pcm.h>
25 #include <sound/pcm_params.h>
26 #include "pcxhr.h"
27 #include "pcxhr_mixer.h"
28 #include "pcxhr_hwdep.h"
29 #include "pcxhr_core.h"
30 #include "pcxhr_mix22.h"
31 
32 #define DRIVER_NAME "pcxhr"
33 
34 MODULE_AUTHOR("Markus Bollinger <bollinger@digigram.com>, "
35 	      "Marc Titinger <titinger@digigram.com>");
36 MODULE_DESCRIPTION("Digigram " DRIVER_NAME " " PCXHR_DRIVER_VERSION_STRING);
37 MODULE_LICENSE("GPL");
38 MODULE_SUPPORTED_DEVICE("{{Digigram," DRIVER_NAME "}}");
39 
40 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;	/* Index 0-MAX */
41 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	/* ID for this card */
42 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;/* Enable this card */
43 static bool mono[SNDRV_CARDS];				/* capture  mono only */
44 
45 module_param_array(index, int, NULL, 0444);
46 MODULE_PARM_DESC(index, "Index value for Digigram " DRIVER_NAME " soundcard");
47 module_param_array(id, charp, NULL, 0444);
48 MODULE_PARM_DESC(id, "ID string for Digigram " DRIVER_NAME " soundcard");
49 module_param_array(enable, bool, NULL, 0444);
50 MODULE_PARM_DESC(enable, "Enable Digigram " DRIVER_NAME " soundcard");
51 module_param_array(mono, bool, NULL, 0444);
52 MODULE_PARM_DESC(mono, "Mono capture mode (default is stereo)");
53 
54 enum {
55 	PCI_ID_VX882HR,
56 	PCI_ID_PCX882HR,
57 	PCI_ID_VX881HR,
58 	PCI_ID_PCX881HR,
59 	PCI_ID_VX882E,
60 	PCI_ID_PCX882E,
61 	PCI_ID_VX881E,
62 	PCI_ID_PCX881E,
63 	PCI_ID_VX1222HR,
64 	PCI_ID_PCX1222HR,
65 	PCI_ID_VX1221HR,
66 	PCI_ID_PCX1221HR,
67 	PCI_ID_VX1222E,
68 	PCI_ID_PCX1222E,
69 	PCI_ID_VX1221E,
70 	PCI_ID_PCX1221E,
71 	PCI_ID_VX222HR,
72 	PCI_ID_VX222E,
73 	PCI_ID_PCX22HR,
74 	PCI_ID_PCX22E,
75 	PCI_ID_VX222HRMIC,
76 	PCI_ID_VX222E_MIC,
77 	PCI_ID_PCX924HR,
78 	PCI_ID_PCX924E,
79 	PCI_ID_PCX924HRMIC,
80 	PCI_ID_PCX924E_MIC,
81 	PCI_ID_VX442HR,
82 	PCI_ID_PCX442HR,
83 	PCI_ID_VX442E,
84 	PCI_ID_PCX442E,
85 	PCI_ID_VX822HR,
86 	PCI_ID_PCX822HR,
87 	PCI_ID_VX822E,
88 	PCI_ID_PCX822E,
89 	PCI_ID_LAST
90 };
91 
92 static const struct pci_device_id pcxhr_ids[] = {
93 	{ 0x10b5, 0x9656, 0x1369, 0xb001, 0, 0, PCI_ID_VX882HR, },
94 	{ 0x10b5, 0x9656, 0x1369, 0xb101, 0, 0, PCI_ID_PCX882HR, },
95 	{ 0x10b5, 0x9656, 0x1369, 0xb201, 0, 0, PCI_ID_VX881HR, },
96 	{ 0x10b5, 0x9656, 0x1369, 0xb301, 0, 0, PCI_ID_PCX881HR, },
97 	{ 0x10b5, 0x9056, 0x1369, 0xb021, 0, 0, PCI_ID_VX882E, },
98 	{ 0x10b5, 0x9056, 0x1369, 0xb121, 0, 0, PCI_ID_PCX882E, },
99 	{ 0x10b5, 0x9056, 0x1369, 0xb221, 0, 0, PCI_ID_VX881E, },
100 	{ 0x10b5, 0x9056, 0x1369, 0xb321, 0, 0, PCI_ID_PCX881E, },
101 	{ 0x10b5, 0x9656, 0x1369, 0xb401, 0, 0, PCI_ID_VX1222HR, },
102 	{ 0x10b5, 0x9656, 0x1369, 0xb501, 0, 0, PCI_ID_PCX1222HR, },
103 	{ 0x10b5, 0x9656, 0x1369, 0xb601, 0, 0, PCI_ID_VX1221HR, },
104 	{ 0x10b5, 0x9656, 0x1369, 0xb701, 0, 0, PCI_ID_PCX1221HR, },
105 	{ 0x10b5, 0x9056, 0x1369, 0xb421, 0, 0, PCI_ID_VX1222E, },
106 	{ 0x10b5, 0x9056, 0x1369, 0xb521, 0, 0, PCI_ID_PCX1222E, },
107 	{ 0x10b5, 0x9056, 0x1369, 0xb621, 0, 0, PCI_ID_VX1221E, },
108 	{ 0x10b5, 0x9056, 0x1369, 0xb721, 0, 0, PCI_ID_PCX1221E, },
109 	{ 0x10b5, 0x9056, 0x1369, 0xba01, 0, 0, PCI_ID_VX222HR, },
110 	{ 0x10b5, 0x9056, 0x1369, 0xba21, 0, 0, PCI_ID_VX222E, },
111 	{ 0x10b5, 0x9056, 0x1369, 0xbd01, 0, 0, PCI_ID_PCX22HR, },
112 	{ 0x10b5, 0x9056, 0x1369, 0xbd21, 0, 0, PCI_ID_PCX22E, },
113 	{ 0x10b5, 0x9056, 0x1369, 0xbc01, 0, 0, PCI_ID_VX222HRMIC, },
114 	{ 0x10b5, 0x9056, 0x1369, 0xbc21, 0, 0, PCI_ID_VX222E_MIC, },
115 	{ 0x10b5, 0x9056, 0x1369, 0xbb01, 0, 0, PCI_ID_PCX924HR, },
116 	{ 0x10b5, 0x9056, 0x1369, 0xbb21, 0, 0, PCI_ID_PCX924E, },
117 	{ 0x10b5, 0x9056, 0x1369, 0xbf01, 0, 0, PCI_ID_PCX924HRMIC, },
118 	{ 0x10b5, 0x9056, 0x1369, 0xbf21, 0, 0, PCI_ID_PCX924E_MIC, },
119 	{ 0x10b5, 0x9656, 0x1369, 0xd001, 0, 0, PCI_ID_VX442HR, },
120 	{ 0x10b5, 0x9656, 0x1369, 0xd101, 0, 0, PCI_ID_PCX442HR, },
121 	{ 0x10b5, 0x9056, 0x1369, 0xd021, 0, 0, PCI_ID_VX442E, },
122 	{ 0x10b5, 0x9056, 0x1369, 0xd121, 0, 0, PCI_ID_PCX442E, },
123 	{ 0x10b5, 0x9656, 0x1369, 0xd201, 0, 0, PCI_ID_VX822HR, },
124 	{ 0x10b5, 0x9656, 0x1369, 0xd301, 0, 0, PCI_ID_PCX822HR, },
125 	{ 0x10b5, 0x9056, 0x1369, 0xd221, 0, 0, PCI_ID_VX822E, },
126 	{ 0x10b5, 0x9056, 0x1369, 0xd321, 0, 0, PCI_ID_PCX822E, },
127 	{ 0, }
128 };
129 
130 MODULE_DEVICE_TABLE(pci, pcxhr_ids);
131 
132 struct board_parameters {
133 	char* board_name;
134 	short playback_chips;
135 	short capture_chips;
136 	short fw_file_set;
137 	short firmware_num;
138 };
139 static struct board_parameters pcxhr_board_params[] = {
140 [PCI_ID_VX882HR] =      { "VX882HR",      4, 4, 0, 41 },
141 [PCI_ID_PCX882HR] =     { "PCX882HR",     4, 4, 0, 41 },
142 [PCI_ID_VX881HR] =      { "VX881HR",      4, 4, 0, 41 },
143 [PCI_ID_PCX881HR] =     { "PCX881HR",     4, 4, 0, 41 },
144 [PCI_ID_VX882E] =       { "VX882e",       4, 4, 1, 41 },
145 [PCI_ID_PCX882E] =      { "PCX882e",      4, 4, 1, 41 },
146 [PCI_ID_VX881E] =       { "VX881e",       4, 4, 1, 41 },
147 [PCI_ID_PCX881E] =      { "PCX881e",      4, 4, 1, 41 },
148 [PCI_ID_VX1222HR] =     { "VX1222HR",     6, 1, 2, 42 },
149 [PCI_ID_PCX1222HR] =    { "PCX1222HR",    6, 1, 2, 42 },
150 [PCI_ID_VX1221HR] =     { "VX1221HR",     6, 1, 2, 42 },
151 [PCI_ID_PCX1221HR] =    { "PCX1221HR",    6, 1, 2, 42 },
152 [PCI_ID_VX1222E] =      { "VX1222e",      6, 1, 3, 42 },
153 [PCI_ID_PCX1222E] =     { "PCX1222e",     6, 1, 3, 42 },
154 [PCI_ID_VX1221E] =      { "VX1221e",      6, 1, 3, 42 },
155 [PCI_ID_PCX1221E] =     { "PCX1221e",     6, 1, 3, 42 },
156 [PCI_ID_VX222HR] =      { "VX222HR",      1, 1, 4, 44 },
157 [PCI_ID_VX222E] =       { "VX222e",       1, 1, 4, 44 },
158 [PCI_ID_PCX22HR] =      { "PCX22HR",      1, 0, 4, 44 },
159 [PCI_ID_PCX22E] =       { "PCX22e",       1, 0, 4, 44 },
160 [PCI_ID_VX222HRMIC] =   { "VX222HR-Mic",  1, 1, 5, 44 },
161 [PCI_ID_VX222E_MIC] =   { "VX222e-Mic",   1, 1, 5, 44 },
162 [PCI_ID_PCX924HR] =     { "PCX924HR",     1, 1, 5, 44 },
163 [PCI_ID_PCX924E] =      { "PCX924e",      1, 1, 5, 44 },
164 [PCI_ID_PCX924HRMIC] =  { "PCX924HR-Mic", 1, 1, 5, 44 },
165 [PCI_ID_PCX924E_MIC] =  { "PCX924e-Mic",  1, 1, 5, 44 },
166 [PCI_ID_VX442HR] =      { "VX442HR",      2, 2, 0, 41 },
167 [PCI_ID_PCX442HR] =     { "PCX442HR",     2, 2, 0, 41 },
168 [PCI_ID_VX442E] =       { "VX442e",       2, 2, 1, 41 },
169 [PCI_ID_PCX442E] =      { "PCX442e",      2, 2, 1, 41 },
170 [PCI_ID_VX822HR] =      { "VX822HR",      4, 1, 2, 42 },
171 [PCI_ID_PCX822HR] =     { "PCX822HR",     4, 1, 2, 42 },
172 [PCI_ID_VX822E] =       { "VX822e",       4, 1, 3, 42 },
173 [PCI_ID_PCX822E] =      { "PCX822e",      4, 1, 3, 42 },
174 };
175 
176 /* boards without hw AES1 and SRC onboard are all using fw_file_set==4 */
177 /* VX222HR, VX222e, PCX22HR and PCX22e */
178 #define PCXHR_BOARD_HAS_AES1(x) (x->fw_file_set != 4)
179 /* some boards do not support 192kHz on digital AES input plugs */
180 #define PCXHR_BOARD_AESIN_NO_192K(x) ((x->capture_chips == 0) || \
181 				      (x->fw_file_set == 0)   || \
182 				      (x->fw_file_set == 2))
183 
184 static int pcxhr_pll_freq_register(unsigned int freq, unsigned int* pllreg,
185 				   unsigned int* realfreq)
186 {
187 	unsigned int reg;
188 
189 	if (freq < 6900 || freq > 110000)
190 		return -EINVAL;
191 	reg = (28224000 * 2) / freq;
192 	reg = (reg - 1) / 2;
193 	if (reg < 0x200)
194 		*pllreg = reg + 0x800;
195 	else if (reg < 0x400)
196 		*pllreg = reg & 0x1ff;
197 	else if (reg < 0x800) {
198 		*pllreg = ((reg >> 1) & 0x1ff) + 0x200;
199 		reg &= ~1;
200 	} else {
201 		*pllreg = ((reg >> 2) & 0x1ff) + 0x400;
202 		reg &= ~3;
203 	}
204 	if (realfreq)
205 		*realfreq = (28224000 / (reg + 1));
206 	return 0;
207 }
208 
209 
210 #define PCXHR_FREQ_REG_MASK		0x1f
211 #define PCXHR_FREQ_QUARTZ_48000		0x00
212 #define PCXHR_FREQ_QUARTZ_24000		0x01
213 #define PCXHR_FREQ_QUARTZ_12000		0x09
214 #define PCXHR_FREQ_QUARTZ_32000		0x08
215 #define PCXHR_FREQ_QUARTZ_16000		0x04
216 #define PCXHR_FREQ_QUARTZ_8000		0x0c
217 #define PCXHR_FREQ_QUARTZ_44100		0x02
218 #define PCXHR_FREQ_QUARTZ_22050		0x0a
219 #define PCXHR_FREQ_QUARTZ_11025		0x06
220 #define PCXHR_FREQ_PLL			0x05
221 #define PCXHR_FREQ_QUARTZ_192000	0x10
222 #define PCXHR_FREQ_QUARTZ_96000		0x18
223 #define PCXHR_FREQ_QUARTZ_176400	0x14
224 #define PCXHR_FREQ_QUARTZ_88200		0x1c
225 #define PCXHR_FREQ_QUARTZ_128000	0x12
226 #define PCXHR_FREQ_QUARTZ_64000		0x1a
227 
228 #define PCXHR_FREQ_WORD_CLOCK		0x0f
229 #define PCXHR_FREQ_SYNC_AES		0x0e
230 #define PCXHR_FREQ_AES_1		0x07
231 #define PCXHR_FREQ_AES_2		0x0b
232 #define PCXHR_FREQ_AES_3		0x03
233 #define PCXHR_FREQ_AES_4		0x0d
234 
235 static int pcxhr_get_clock_reg(struct pcxhr_mgr *mgr, unsigned int rate,
236 			       unsigned int *reg, unsigned int *freq)
237 {
238 	unsigned int val, realfreq, pllreg;
239 	struct pcxhr_rmh rmh;
240 	int err;
241 
242 	realfreq = rate;
243 	switch (mgr->use_clock_type) {
244 	case PCXHR_CLOCK_TYPE_INTERNAL :	/* clock by quartz or pll */
245 		switch (rate) {
246 		case 48000 :	val = PCXHR_FREQ_QUARTZ_48000;	break;
247 		case 24000 :	val = PCXHR_FREQ_QUARTZ_24000;	break;
248 		case 12000 :	val = PCXHR_FREQ_QUARTZ_12000;	break;
249 		case 32000 :	val = PCXHR_FREQ_QUARTZ_32000;	break;
250 		case 16000 :	val = PCXHR_FREQ_QUARTZ_16000;	break;
251 		case 8000 :	val = PCXHR_FREQ_QUARTZ_8000;	break;
252 		case 44100 :	val = PCXHR_FREQ_QUARTZ_44100;	break;
253 		case 22050 :	val = PCXHR_FREQ_QUARTZ_22050;	break;
254 		case 11025 :	val = PCXHR_FREQ_QUARTZ_11025;	break;
255 		case 192000 :	val = PCXHR_FREQ_QUARTZ_192000;	break;
256 		case 96000 :	val = PCXHR_FREQ_QUARTZ_96000;	break;
257 		case 176400 :	val = PCXHR_FREQ_QUARTZ_176400;	break;
258 		case 88200 :	val = PCXHR_FREQ_QUARTZ_88200;	break;
259 		case 128000 :	val = PCXHR_FREQ_QUARTZ_128000;	break;
260 		case 64000 :	val = PCXHR_FREQ_QUARTZ_64000;	break;
261 		default :
262 			val = PCXHR_FREQ_PLL;
263 			/* get the value for the pll register */
264 			err = pcxhr_pll_freq_register(rate, &pllreg, &realfreq);
265 			if (err)
266 				return err;
267 			pcxhr_init_rmh(&rmh, CMD_ACCESS_IO_WRITE);
268 			rmh.cmd[0] |= IO_NUM_REG_GENCLK;
269 			rmh.cmd[1]  = pllreg & MASK_DSP_WORD;
270 			rmh.cmd[2]  = pllreg >> 24;
271 			rmh.cmd_len = 3;
272 			err = pcxhr_send_msg(mgr, &rmh);
273 			if (err < 0) {
274 				dev_err(&mgr->pci->dev,
275 					   "error CMD_ACCESS_IO_WRITE "
276 					   "for PLL register : %x!\n", err);
277 				return err;
278 			}
279 		}
280 		break;
281 	case PCXHR_CLOCK_TYPE_WORD_CLOCK:
282 		val = PCXHR_FREQ_WORD_CLOCK;
283 		break;
284 	case PCXHR_CLOCK_TYPE_AES_SYNC:
285 		val = PCXHR_FREQ_SYNC_AES;
286 		break;
287 	case PCXHR_CLOCK_TYPE_AES_1:
288 		val = PCXHR_FREQ_AES_1;
289 		break;
290 	case PCXHR_CLOCK_TYPE_AES_2:
291 		val = PCXHR_FREQ_AES_2;
292 		break;
293 	case PCXHR_CLOCK_TYPE_AES_3:
294 		val = PCXHR_FREQ_AES_3;
295 		break;
296 	case PCXHR_CLOCK_TYPE_AES_4:
297 		val = PCXHR_FREQ_AES_4;
298 		break;
299 	default:
300 		return -EINVAL;
301 	}
302 	*reg = val;
303 	*freq = realfreq;
304 	return 0;
305 }
306 
307 
308 static int pcxhr_sub_set_clock(struct pcxhr_mgr *mgr,
309 			       unsigned int rate,
310 			       int *changed)
311 {
312 	unsigned int val, realfreq, speed;
313 	struct pcxhr_rmh rmh;
314 	int err;
315 
316 	err = pcxhr_get_clock_reg(mgr, rate, &val, &realfreq);
317 	if (err)
318 		return err;
319 
320 	/* codec speed modes */
321 	if (rate < 55000)
322 		speed = 0;	/* single speed */
323 	else if (rate < 100000)
324 		speed = 1;	/* dual speed */
325 	else
326 		speed = 2;	/* quad speed */
327 	if (mgr->codec_speed != speed) {
328 		pcxhr_init_rmh(&rmh, CMD_ACCESS_IO_WRITE); /* mute outputs */
329 		rmh.cmd[0] |= IO_NUM_REG_MUTE_OUT;
330 		if (DSP_EXT_CMD_SET(mgr)) {
331 			rmh.cmd[1]  = 1;
332 			rmh.cmd_len = 2;
333 		}
334 		err = pcxhr_send_msg(mgr, &rmh);
335 		if (err)
336 			return err;
337 
338 		pcxhr_init_rmh(&rmh, CMD_ACCESS_IO_WRITE); /* set speed ratio */
339 		rmh.cmd[0] |= IO_NUM_SPEED_RATIO;
340 		rmh.cmd[1] = speed;
341 		rmh.cmd_len = 2;
342 		err = pcxhr_send_msg(mgr, &rmh);
343 		if (err)
344 			return err;
345 	}
346 	/* set the new frequency */
347 	dev_dbg(&mgr->pci->dev, "clock register : set %x\n", val);
348 	err = pcxhr_write_io_num_reg_cont(mgr, PCXHR_FREQ_REG_MASK,
349 					  val, changed);
350 	if (err)
351 		return err;
352 
353 	mgr->sample_rate_real = realfreq;
354 	mgr->cur_clock_type = mgr->use_clock_type;
355 
356 	/* unmute after codec speed modes */
357 	if (mgr->codec_speed != speed) {
358 		pcxhr_init_rmh(&rmh, CMD_ACCESS_IO_READ); /* unmute outputs */
359 		rmh.cmd[0] |= IO_NUM_REG_MUTE_OUT;
360 		if (DSP_EXT_CMD_SET(mgr)) {
361 			rmh.cmd[1]  = 1;
362 			rmh.cmd_len = 2;
363 		}
364 		err = pcxhr_send_msg(mgr, &rmh);
365 		if (err)
366 			return err;
367 		mgr->codec_speed = speed;	/* save new codec speed */
368 	}
369 
370 	dev_dbg(&mgr->pci->dev, "pcxhr_sub_set_clock to %dHz (realfreq=%d)\n",
371 		    rate, realfreq);
372 	return 0;
373 }
374 
375 #define PCXHR_MODIFY_CLOCK_S_BIT	0x04
376 
377 #define PCXHR_IRQ_TIMER_FREQ		92000
378 #define PCXHR_IRQ_TIMER_PERIOD		48
379 
380 int pcxhr_set_clock(struct pcxhr_mgr *mgr, unsigned int rate)
381 {
382 	struct pcxhr_rmh rmh;
383 	int err, changed;
384 
385 	if (rate == 0)
386 		return 0; /* nothing to do */
387 
388 	if (mgr->is_hr_stereo)
389 		err = hr222_sub_set_clock(mgr, rate, &changed);
390 	else
391 		err = pcxhr_sub_set_clock(mgr, rate, &changed);
392 
393 	if (err)
394 		return err;
395 
396 	if (changed) {
397 		pcxhr_init_rmh(&rmh, CMD_MODIFY_CLOCK);
398 		rmh.cmd[0] |= PCXHR_MODIFY_CLOCK_S_BIT; /* resync fifos  */
399 		if (rate < PCXHR_IRQ_TIMER_FREQ)
400 			rmh.cmd[1] = PCXHR_IRQ_TIMER_PERIOD;
401 		else
402 			rmh.cmd[1] = PCXHR_IRQ_TIMER_PERIOD * 2;
403 		rmh.cmd[2] = rate;
404 		rmh.cmd_len = 3;
405 		err = pcxhr_send_msg(mgr, &rmh);
406 		if (err)
407 			return err;
408 	}
409 	return 0;
410 }
411 
412 
413 static int pcxhr_sub_get_external_clock(struct pcxhr_mgr *mgr,
414 					enum pcxhr_clock_type clock_type,
415 					int *sample_rate)
416 {
417 	struct pcxhr_rmh rmh;
418 	unsigned char reg;
419 	int err, rate;
420 
421 	switch (clock_type) {
422 	case PCXHR_CLOCK_TYPE_WORD_CLOCK:
423 		reg = REG_STATUS_WORD_CLOCK;
424 		break;
425 	case PCXHR_CLOCK_TYPE_AES_SYNC:
426 		reg = REG_STATUS_AES_SYNC;
427 		break;
428 	case PCXHR_CLOCK_TYPE_AES_1:
429 		reg = REG_STATUS_AES_1;
430 		break;
431 	case PCXHR_CLOCK_TYPE_AES_2:
432 		reg = REG_STATUS_AES_2;
433 		break;
434 	case PCXHR_CLOCK_TYPE_AES_3:
435 		reg = REG_STATUS_AES_3;
436 		break;
437 	case PCXHR_CLOCK_TYPE_AES_4:
438 		reg = REG_STATUS_AES_4;
439 		break;
440 	default:
441 		return -EINVAL;
442 	}
443 	pcxhr_init_rmh(&rmh, CMD_ACCESS_IO_READ);
444 	rmh.cmd_len = 2;
445 	rmh.cmd[0] |= IO_NUM_REG_STATUS;
446 	if (mgr->last_reg_stat != reg) {
447 		rmh.cmd[1]  = reg;
448 		err = pcxhr_send_msg(mgr, &rmh);
449 		if (err)
450 			return err;
451 		udelay(100);	/* wait minimum 2 sample_frames at 32kHz ! */
452 		mgr->last_reg_stat = reg;
453 	}
454 	rmh.cmd[1]  = REG_STATUS_CURRENT;
455 	err = pcxhr_send_msg(mgr, &rmh);
456 	if (err)
457 		return err;
458 	switch (rmh.stat[1] & 0x0f) {
459 	case REG_STATUS_SYNC_32000 :	rate = 32000; break;
460 	case REG_STATUS_SYNC_44100 :	rate = 44100; break;
461 	case REG_STATUS_SYNC_48000 :	rate = 48000; break;
462 	case REG_STATUS_SYNC_64000 :	rate = 64000; break;
463 	case REG_STATUS_SYNC_88200 :	rate = 88200; break;
464 	case REG_STATUS_SYNC_96000 :	rate = 96000; break;
465 	case REG_STATUS_SYNC_128000 :	rate = 128000; break;
466 	case REG_STATUS_SYNC_176400 :	rate = 176400; break;
467 	case REG_STATUS_SYNC_192000 :	rate = 192000; break;
468 	default: rate = 0;
469 	}
470 	dev_dbg(&mgr->pci->dev, "External clock is at %d Hz\n", rate);
471 	*sample_rate = rate;
472 	return 0;
473 }
474 
475 
476 int pcxhr_get_external_clock(struct pcxhr_mgr *mgr,
477 			     enum pcxhr_clock_type clock_type,
478 			     int *sample_rate)
479 {
480 	if (mgr->is_hr_stereo)
481 		return hr222_get_external_clock(mgr, clock_type,
482 						sample_rate);
483 	else
484 		return pcxhr_sub_get_external_clock(mgr, clock_type,
485 						    sample_rate);
486 }
487 
488 /*
489  *  start or stop playback/capture substream
490  */
491 static int pcxhr_set_stream_state(struct snd_pcxhr *chip,
492 				  struct pcxhr_stream *stream)
493 {
494 	int err;
495 	struct pcxhr_rmh rmh;
496 	int stream_mask, start;
497 
498 	if (stream->status == PCXHR_STREAM_STATUS_SCHEDULE_RUN)
499 		start = 1;
500 	else {
501 		if (stream->status != PCXHR_STREAM_STATUS_SCHEDULE_STOP) {
502 			dev_err(chip->card->dev,
503 				"pcxhr_set_stream_state CANNOT be stopped\n");
504 			return -EINVAL;
505 		}
506 		start = 0;
507 	}
508 	if (!stream->substream)
509 		return -EINVAL;
510 
511 	stream->timer_abs_periods = 0;
512 	stream->timer_period_frag = 0;	/* reset theoretical stream pos */
513 	stream->timer_buf_periods = 0;
514 	stream->timer_is_synced = 0;
515 
516 	stream_mask =
517 	  stream->pipe->is_capture ? 1 : 1<<stream->substream->number;
518 
519 	pcxhr_init_rmh(&rmh, start ? CMD_START_STREAM : CMD_STOP_STREAM);
520 	pcxhr_set_pipe_cmd_params(&rmh, stream->pipe->is_capture,
521 				  stream->pipe->first_audio, 0, stream_mask);
522 
523 	chip = snd_pcm_substream_chip(stream->substream);
524 
525 	err = pcxhr_send_msg(chip->mgr, &rmh);
526 	if (err)
527 		dev_err(chip->card->dev,
528 			"ERROR pcxhr_set_stream_state err=%x;\n", err);
529 	stream->status =
530 	  start ? PCXHR_STREAM_STATUS_STARTED : PCXHR_STREAM_STATUS_STOPPED;
531 	return err;
532 }
533 
534 #define HEADER_FMT_BASE_LIN		0xfed00000
535 #define HEADER_FMT_BASE_FLOAT		0xfad00000
536 #define HEADER_FMT_INTEL		0x00008000
537 #define HEADER_FMT_24BITS		0x00004000
538 #define HEADER_FMT_16BITS		0x00002000
539 #define HEADER_FMT_UPTO11		0x00000200
540 #define HEADER_FMT_UPTO32		0x00000100
541 #define HEADER_FMT_MONO			0x00000080
542 
543 static int pcxhr_set_format(struct pcxhr_stream *stream)
544 {
545 	int err, is_capture, sample_rate, stream_num;
546 	struct snd_pcxhr *chip;
547 	struct pcxhr_rmh rmh;
548 	unsigned int header;
549 
550 	chip = snd_pcm_substream_chip(stream->substream);
551 	switch (stream->format) {
552 	case SNDRV_PCM_FORMAT_U8:
553 		header = HEADER_FMT_BASE_LIN;
554 		break;
555 	case SNDRV_PCM_FORMAT_S16_LE:
556 		header = HEADER_FMT_BASE_LIN |
557 			 HEADER_FMT_16BITS | HEADER_FMT_INTEL;
558 		break;
559 	case SNDRV_PCM_FORMAT_S16_BE:
560 		header = HEADER_FMT_BASE_LIN | HEADER_FMT_16BITS;
561 		break;
562 	case SNDRV_PCM_FORMAT_S24_3LE:
563 		header = HEADER_FMT_BASE_LIN |
564 			 HEADER_FMT_24BITS | HEADER_FMT_INTEL;
565 		break;
566 	case SNDRV_PCM_FORMAT_S24_3BE:
567 		header = HEADER_FMT_BASE_LIN | HEADER_FMT_24BITS;
568 		break;
569 	case SNDRV_PCM_FORMAT_FLOAT_LE:
570 		header = HEADER_FMT_BASE_FLOAT | HEADER_FMT_INTEL;
571 		break;
572 	default:
573 		dev_err(chip->card->dev,
574 			"error pcxhr_set_format() : unknown format\n");
575 		return -EINVAL;
576 	}
577 
578 	sample_rate = chip->mgr->sample_rate;
579 	if (sample_rate <= 32000 && sample_rate !=0) {
580 		if (sample_rate <= 11025)
581 			header |= HEADER_FMT_UPTO11;
582 		else
583 			header |= HEADER_FMT_UPTO32;
584 	}
585 	if (stream->channels == 1)
586 		header |= HEADER_FMT_MONO;
587 
588 	is_capture = stream->pipe->is_capture;
589 	stream_num = is_capture ? 0 : stream->substream->number;
590 
591 	pcxhr_init_rmh(&rmh, is_capture ?
592 		       CMD_FORMAT_STREAM_IN : CMD_FORMAT_STREAM_OUT);
593 	pcxhr_set_pipe_cmd_params(&rmh, is_capture, stream->pipe->first_audio,
594 				  stream_num, 0);
595 	if (is_capture) {
596 		/* bug with old dsp versions: */
597 		/* bit 12 also sets the format of the playback stream */
598 		if (DSP_EXT_CMD_SET(chip->mgr))
599 			rmh.cmd[0] |= 1<<10;
600 		else
601 			rmh.cmd[0] |= 1<<12;
602 	}
603 	rmh.cmd[1] = 0;
604 	rmh.cmd_len = 2;
605 	if (DSP_EXT_CMD_SET(chip->mgr)) {
606 		/* add channels and set bit 19 if channels>2 */
607 		rmh.cmd[1] = stream->channels;
608 		if (!is_capture) {
609 			/* playback : add channel mask to command */
610 			rmh.cmd[2] = (stream->channels == 1) ? 0x01 : 0x03;
611 			rmh.cmd_len = 3;
612 		}
613 	}
614 	rmh.cmd[rmh.cmd_len++] = header >> 8;
615 	rmh.cmd[rmh.cmd_len++] = (header & 0xff) << 16;
616 	err = pcxhr_send_msg(chip->mgr, &rmh);
617 	if (err)
618 		dev_err(chip->card->dev,
619 			"ERROR pcxhr_set_format err=%x;\n", err);
620 	return err;
621 }
622 
623 static int pcxhr_update_r_buffer(struct pcxhr_stream *stream)
624 {
625 	int err, is_capture, stream_num;
626 	struct pcxhr_rmh rmh;
627 	struct snd_pcm_substream *subs = stream->substream;
628 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
629 
630 	is_capture = (subs->stream == SNDRV_PCM_STREAM_CAPTURE);
631 	stream_num = is_capture ? 0 : subs->number;
632 
633 	dev_dbg(chip->card->dev,
634 		"pcxhr_update_r_buffer(pcm%c%d) : addr(%p) bytes(%zx) subs(%d)\n",
635 		is_capture ? 'c' : 'p',
636 		chip->chip_idx, (void *)(long)subs->runtime->dma_addr,
637 		subs->runtime->dma_bytes, subs->number);
638 
639 	pcxhr_init_rmh(&rmh, CMD_UPDATE_R_BUFFERS);
640 	pcxhr_set_pipe_cmd_params(&rmh, is_capture, stream->pipe->first_audio,
641 				  stream_num, 0);
642 
643 	/* max buffer size is 2 MByte */
644 	snd_BUG_ON(subs->runtime->dma_bytes >= 0x200000);
645 	/* size in bits */
646 	rmh.cmd[1] = subs->runtime->dma_bytes * 8;
647 	/* most significant byte */
648 	rmh.cmd[2] = subs->runtime->dma_addr >> 24;
649 	/* this is a circular buffer */
650 	rmh.cmd[2] |= 1<<19;
651 	/* least 3 significant bytes */
652 	rmh.cmd[3] = subs->runtime->dma_addr & MASK_DSP_WORD;
653 	rmh.cmd_len = 4;
654 	err = pcxhr_send_msg(chip->mgr, &rmh);
655 	if (err)
656 		dev_err(chip->card->dev,
657 			   "ERROR CMD_UPDATE_R_BUFFERS err=%x;\n", err);
658 	return err;
659 }
660 
661 
662 #if 0
663 static int pcxhr_pipe_sample_count(struct pcxhr_stream *stream,
664 				   snd_pcm_uframes_t *sample_count)
665 {
666 	struct pcxhr_rmh rmh;
667 	int err;
668 	pcxhr_t *chip = snd_pcm_substream_chip(stream->substream);
669 	pcxhr_init_rmh(&rmh, CMD_PIPE_SAMPLE_COUNT);
670 	pcxhr_set_pipe_cmd_params(&rmh, stream->pipe->is_capture, 0, 0,
671 				  1<<stream->pipe->first_audio);
672 	err = pcxhr_send_msg(chip->mgr, &rmh);
673 	if (err == 0) {
674 		*sample_count = ((snd_pcm_uframes_t)rmh.stat[0]) << 24;
675 		*sample_count += (snd_pcm_uframes_t)rmh.stat[1];
676 	}
677 	dev_dbg(chip->card->dev, "PIPE_SAMPLE_COUNT = %lx\n", *sample_count);
678 	return err;
679 }
680 #endif
681 
682 static inline int pcxhr_stream_scheduled_get_pipe(struct pcxhr_stream *stream,
683 						  struct pcxhr_pipe **pipe)
684 {
685 	if (stream->status == PCXHR_STREAM_STATUS_SCHEDULE_RUN) {
686 		*pipe = stream->pipe;
687 		return 1;
688 	}
689 	return 0;
690 }
691 
692 static void pcxhr_start_linked_stream(struct pcxhr_mgr *mgr)
693 {
694 	int i, j, err;
695 	struct pcxhr_pipe *pipe;
696 	struct snd_pcxhr *chip;
697 	int capture_mask = 0;
698 	int playback_mask = 0;
699 
700 #ifdef CONFIG_SND_DEBUG_VERBOSE
701 	ktime_t start_time, stop_time, diff_time;
702 
703 	start_time = ktime_get();
704 #endif
705 	mutex_lock(&mgr->setup_mutex);
706 
707 	/* check the pipes concerned and build pipe_array */
708 	for (i = 0; i < mgr->num_cards; i++) {
709 		chip = mgr->chip[i];
710 		for (j = 0; j < chip->nb_streams_capt; j++) {
711 			if (pcxhr_stream_scheduled_get_pipe(&chip->capture_stream[j], &pipe))
712 				capture_mask |= (1 << pipe->first_audio);
713 		}
714 		for (j = 0; j < chip->nb_streams_play; j++) {
715 			if (pcxhr_stream_scheduled_get_pipe(&chip->playback_stream[j], &pipe)) {
716 				playback_mask |= (1 << pipe->first_audio);
717 				break;	/* add only once, as all playback
718 					 * streams of one chip use the same pipe
719 					 */
720 			}
721 		}
722 	}
723 	if (capture_mask == 0 && playback_mask == 0) {
724 		mutex_unlock(&mgr->setup_mutex);
725 		dev_err(&mgr->pci->dev, "pcxhr_start_linked_stream : no pipes\n");
726 		return;
727 	}
728 
729 	dev_dbg(&mgr->pci->dev, "pcxhr_start_linked_stream : "
730 		    "playback_mask=%x capture_mask=%x\n",
731 		    playback_mask, capture_mask);
732 
733 	/* synchronous stop of all the pipes concerned */
734 	err = pcxhr_set_pipe_state(mgr,  playback_mask, capture_mask, 0);
735 	if (err) {
736 		mutex_unlock(&mgr->setup_mutex);
737 		dev_err(&mgr->pci->dev, "pcxhr_start_linked_stream : "
738 			   "error stop pipes (P%x C%x)\n",
739 			   playback_mask, capture_mask);
740 		return;
741 	}
742 
743 	/* the dsp lost format and buffer info with the stop pipe */
744 	for (i = 0; i < mgr->num_cards; i++) {
745 		struct pcxhr_stream *stream;
746 		chip = mgr->chip[i];
747 		for (j = 0; j < chip->nb_streams_capt; j++) {
748 			stream = &chip->capture_stream[j];
749 			if (pcxhr_stream_scheduled_get_pipe(stream, &pipe)) {
750 				err = pcxhr_set_format(stream);
751 				err = pcxhr_update_r_buffer(stream);
752 			}
753 		}
754 		for (j = 0; j < chip->nb_streams_play; j++) {
755 			stream = &chip->playback_stream[j];
756 			if (pcxhr_stream_scheduled_get_pipe(stream, &pipe)) {
757 				err = pcxhr_set_format(stream);
758 				err = pcxhr_update_r_buffer(stream);
759 			}
760 		}
761 	}
762 	/* start all the streams */
763 	for (i = 0; i < mgr->num_cards; i++) {
764 		struct pcxhr_stream *stream;
765 		chip = mgr->chip[i];
766 		for (j = 0; j < chip->nb_streams_capt; j++) {
767 			stream = &chip->capture_stream[j];
768 			if (pcxhr_stream_scheduled_get_pipe(stream, &pipe))
769 				err = pcxhr_set_stream_state(chip, stream);
770 		}
771 		for (j = 0; j < chip->nb_streams_play; j++) {
772 			stream = &chip->playback_stream[j];
773 			if (pcxhr_stream_scheduled_get_pipe(stream, &pipe))
774 				err = pcxhr_set_stream_state(chip, stream);
775 		}
776 	}
777 
778 	/* synchronous start of all the pipes concerned */
779 	err = pcxhr_set_pipe_state(mgr, playback_mask, capture_mask, 1);
780 	if (err) {
781 		mutex_unlock(&mgr->setup_mutex);
782 		dev_err(&mgr->pci->dev, "pcxhr_start_linked_stream : "
783 			   "error start pipes (P%x C%x)\n",
784 			   playback_mask, capture_mask);
785 		return;
786 	}
787 
788 	/* put the streams into the running state now
789 	 * (increment pointer by interrupt)
790 	 */
791 	mutex_lock(&mgr->lock);
792 	for ( i =0; i < mgr->num_cards; i++) {
793 		struct pcxhr_stream *stream;
794 		chip = mgr->chip[i];
795 		for(j = 0; j < chip->nb_streams_capt; j++) {
796 			stream = &chip->capture_stream[j];
797 			if(stream->status == PCXHR_STREAM_STATUS_STARTED)
798 				stream->status = PCXHR_STREAM_STATUS_RUNNING;
799 		}
800 		for (j = 0; j < chip->nb_streams_play; j++) {
801 			stream = &chip->playback_stream[j];
802 			if (stream->status == PCXHR_STREAM_STATUS_STARTED) {
803 				/* playback will already have advanced ! */
804 				stream->timer_period_frag += mgr->granularity;
805 				stream->status = PCXHR_STREAM_STATUS_RUNNING;
806 			}
807 		}
808 	}
809 	mutex_unlock(&mgr->lock);
810 
811 	mutex_unlock(&mgr->setup_mutex);
812 
813 #ifdef CONFIG_SND_DEBUG_VERBOSE
814 	stop_time = ktime_get();
815 	diff_time = ktime_sub(stop_time, start_time);
816 	dev_dbg(&mgr->pci->dev, "***TRIGGER START*** TIME = %ld (err = %x)\n",
817 		    (long)(ktime_to_ns(diff_time)), err);
818 #endif
819 }
820 
821 
822 /*
823  *  trigger callback
824  */
825 static int pcxhr_trigger(struct snd_pcm_substream *subs, int cmd)
826 {
827 	struct pcxhr_stream *stream;
828 	struct snd_pcm_substream *s;
829 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
830 
831 	switch (cmd) {
832 	case SNDRV_PCM_TRIGGER_START:
833 		dev_dbg(chip->card->dev, "SNDRV_PCM_TRIGGER_START\n");
834 		if (snd_pcm_stream_linked(subs)) {
835 			snd_pcm_group_for_each_entry(s, subs) {
836 				if (snd_pcm_substream_chip(s) != chip)
837 					continue;
838 				stream = s->runtime->private_data;
839 				stream->status =
840 					PCXHR_STREAM_STATUS_SCHEDULE_RUN;
841 				snd_pcm_trigger_done(s, subs);
842 			}
843 			pcxhr_start_linked_stream(chip->mgr);
844 		} else {
845 			stream = subs->runtime->private_data;
846 			dev_dbg(chip->card->dev, "Only one Substream %c %d\n",
847 				    stream->pipe->is_capture ? 'C' : 'P',
848 				    stream->pipe->first_audio);
849 			if (pcxhr_set_format(stream))
850 				return -EINVAL;
851 			if (pcxhr_update_r_buffer(stream))
852 				return -EINVAL;
853 
854 			stream->status = PCXHR_STREAM_STATUS_SCHEDULE_RUN;
855 			if (pcxhr_set_stream_state(chip, stream))
856 				return -EINVAL;
857 			stream->status = PCXHR_STREAM_STATUS_RUNNING;
858 		}
859 		break;
860 	case SNDRV_PCM_TRIGGER_STOP:
861 		dev_dbg(chip->card->dev, "SNDRV_PCM_TRIGGER_STOP\n");
862 		snd_pcm_group_for_each_entry(s, subs) {
863 			stream = s->runtime->private_data;
864 			stream->status = PCXHR_STREAM_STATUS_SCHEDULE_STOP;
865 			if (pcxhr_set_stream_state(chip, stream))
866 				return -EINVAL;
867 			snd_pcm_trigger_done(s, subs);
868 		}
869 		break;
870 	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
871 	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
872 		/* TODO */
873 	default:
874 		return -EINVAL;
875 	}
876 	return 0;
877 }
878 
879 
880 static int pcxhr_hardware_timer(struct pcxhr_mgr *mgr, int start)
881 {
882 	struct pcxhr_rmh rmh;
883 	int err;
884 
885 	pcxhr_init_rmh(&rmh, CMD_SET_TIMER_INTERRUPT);
886 	if (start) {
887 		/* last dsp time invalid */
888 		mgr->dsp_time_last = PCXHR_DSP_TIME_INVALID;
889 		rmh.cmd[0] |= mgr->granularity;
890 	}
891 	err = pcxhr_send_msg(mgr, &rmh);
892 	if (err < 0)
893 		dev_err(&mgr->pci->dev, "error pcxhr_hardware_timer err(%x)\n",
894 			   err);
895 	return err;
896 }
897 
898 /*
899  *  prepare callback for all pcms
900  */
901 static int pcxhr_prepare(struct snd_pcm_substream *subs)
902 {
903 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
904 	struct pcxhr_mgr *mgr = chip->mgr;
905 	int err = 0;
906 
907 	dev_dbg(chip->card->dev,
908 		"pcxhr_prepare : period_size(%lx) periods(%x) buffer_size(%lx)\n",
909 		    subs->runtime->period_size, subs->runtime->periods,
910 		    subs->runtime->buffer_size);
911 
912 	mutex_lock(&mgr->setup_mutex);
913 
914 	do {
915 		/* only the first stream can choose the sample rate */
916 		/* set the clock only once (first stream) */
917 		if (mgr->sample_rate != subs->runtime->rate) {
918 			err = pcxhr_set_clock(mgr, subs->runtime->rate);
919 			if (err)
920 				break;
921 			if (mgr->sample_rate == 0)
922 				/* start the DSP-timer */
923 				err = pcxhr_hardware_timer(mgr, 1);
924 			mgr->sample_rate = subs->runtime->rate;
925 		}
926 	} while(0);	/* do only once (so we can use break instead of goto) */
927 
928 	mutex_unlock(&mgr->setup_mutex);
929 
930 	return err;
931 }
932 
933 
934 /*
935  *  HW_PARAMS callback for all pcms
936  */
937 static int pcxhr_hw_params(struct snd_pcm_substream *subs,
938 			   struct snd_pcm_hw_params *hw)
939 {
940 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
941 	struct pcxhr_mgr *mgr = chip->mgr;
942 	struct pcxhr_stream *stream = subs->runtime->private_data;
943 	snd_pcm_format_t format;
944 	int err;
945 	int channels;
946 
947 	/* set up channels */
948 	channels = params_channels(hw);
949 
950 	/*  set up format for the stream */
951 	format = params_format(hw);
952 
953 	mutex_lock(&mgr->setup_mutex);
954 
955 	stream->channels = channels;
956 	stream->format = format;
957 
958 	/* allocate buffer */
959 	err = snd_pcm_lib_malloc_pages(subs, params_buffer_bytes(hw));
960 
961 	mutex_unlock(&mgr->setup_mutex);
962 
963 	return err;
964 }
965 
966 static int pcxhr_hw_free(struct snd_pcm_substream *subs)
967 {
968 	snd_pcm_lib_free_pages(subs);
969 	return 0;
970 }
971 
972 
973 /*
974  *  CONFIGURATION SPACE for all pcms, mono pcm must update channels_max
975  */
976 static const struct snd_pcm_hardware pcxhr_caps =
977 {
978 	.info             = (SNDRV_PCM_INFO_MMAP |
979 			     SNDRV_PCM_INFO_INTERLEAVED |
980 			     SNDRV_PCM_INFO_MMAP_VALID |
981 			     SNDRV_PCM_INFO_SYNC_START),
982 	.formats	  = (SNDRV_PCM_FMTBIT_U8 |
983 			     SNDRV_PCM_FMTBIT_S16_LE |
984 			     SNDRV_PCM_FMTBIT_S16_BE |
985 			     SNDRV_PCM_FMTBIT_S24_3LE |
986 			     SNDRV_PCM_FMTBIT_S24_3BE |
987 			     SNDRV_PCM_FMTBIT_FLOAT_LE),
988 	.rates            = (SNDRV_PCM_RATE_CONTINUOUS |
989 			     SNDRV_PCM_RATE_8000_192000),
990 	.rate_min         = 8000,
991 	.rate_max         = 192000,
992 	.channels_min     = 1,
993 	.channels_max     = 2,
994 	.buffer_bytes_max = (32*1024),
995 	/* 1 byte == 1 frame U8 mono (PCXHR_GRANULARITY is frames!) */
996 	.period_bytes_min = (2*PCXHR_GRANULARITY),
997 	.period_bytes_max = (16*1024),
998 	.periods_min      = 2,
999 	.periods_max      = (32*1024/PCXHR_GRANULARITY),
1000 };
1001 
1002 
1003 static int pcxhr_open(struct snd_pcm_substream *subs)
1004 {
1005 	struct snd_pcxhr       *chip = snd_pcm_substream_chip(subs);
1006 	struct pcxhr_mgr       *mgr = chip->mgr;
1007 	struct snd_pcm_runtime *runtime = subs->runtime;
1008 	struct pcxhr_stream    *stream;
1009 	int err;
1010 
1011 	mutex_lock(&mgr->setup_mutex);
1012 
1013 	/* copy the struct snd_pcm_hardware struct */
1014 	runtime->hw = pcxhr_caps;
1015 
1016 	if( subs->stream == SNDRV_PCM_STREAM_PLAYBACK ) {
1017 		dev_dbg(chip->card->dev, "pcxhr_open playback chip%d subs%d\n",
1018 			    chip->chip_idx, subs->number);
1019 		stream = &chip->playback_stream[subs->number];
1020 	} else {
1021 		dev_dbg(chip->card->dev, "pcxhr_open capture chip%d subs%d\n",
1022 			    chip->chip_idx, subs->number);
1023 		if (mgr->mono_capture)
1024 			runtime->hw.channels_max = 1;
1025 		else
1026 			runtime->hw.channels_min = 2;
1027 		stream = &chip->capture_stream[subs->number];
1028 	}
1029 	if (stream->status != PCXHR_STREAM_STATUS_FREE){
1030 		/* streams in use */
1031 		dev_err(chip->card->dev, "pcxhr_open chip%d subs%d in use\n",
1032 			   chip->chip_idx, subs->number);
1033 		mutex_unlock(&mgr->setup_mutex);
1034 		return -EBUSY;
1035 	}
1036 
1037 	/* float format support is in some cases buggy on stereo cards */
1038 	if (mgr->is_hr_stereo)
1039 		runtime->hw.formats &= ~SNDRV_PCM_FMTBIT_FLOAT_LE;
1040 
1041 	/* buffer-size should better be multiple of period-size */
1042 	err = snd_pcm_hw_constraint_integer(runtime,
1043 					    SNDRV_PCM_HW_PARAM_PERIODS);
1044 	if (err < 0) {
1045 		mutex_unlock(&mgr->setup_mutex);
1046 		return err;
1047 	}
1048 
1049 	/* if a sample rate is already used or fixed by external clock,
1050 	 * the stream cannot change
1051 	 */
1052 	if (mgr->sample_rate)
1053 		runtime->hw.rate_min = runtime->hw.rate_max = mgr->sample_rate;
1054 	else {
1055 		if (mgr->use_clock_type != PCXHR_CLOCK_TYPE_INTERNAL) {
1056 			int external_rate;
1057 			if (pcxhr_get_external_clock(mgr, mgr->use_clock_type,
1058 						     &external_rate) ||
1059 			    external_rate == 0) {
1060 				/* cannot detect the external clock rate */
1061 				mutex_unlock(&mgr->setup_mutex);
1062 				return -EBUSY;
1063 			}
1064 			runtime->hw.rate_min = external_rate;
1065 			runtime->hw.rate_max = external_rate;
1066 		}
1067 	}
1068 
1069 	stream->status      = PCXHR_STREAM_STATUS_OPEN;
1070 	stream->substream   = subs;
1071 	stream->channels    = 0; /* not configured yet */
1072 
1073 	runtime->private_data = stream;
1074 
1075 	/* better get a divisor of granularity values (96 or 192) */
1076 	snd_pcm_hw_constraint_step(runtime, 0,
1077 				   SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32);
1078 	snd_pcm_hw_constraint_step(runtime, 0,
1079 				   SNDRV_PCM_HW_PARAM_PERIOD_SIZE, 32);
1080 	snd_pcm_set_sync(subs);
1081 
1082 	mgr->ref_count_rate++;
1083 
1084 	mutex_unlock(&mgr->setup_mutex);
1085 	return 0;
1086 }
1087 
1088 
1089 static int pcxhr_close(struct snd_pcm_substream *subs)
1090 {
1091 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
1092 	struct pcxhr_mgr *mgr = chip->mgr;
1093 	struct pcxhr_stream *stream = subs->runtime->private_data;
1094 
1095 	mutex_lock(&mgr->setup_mutex);
1096 
1097 	dev_dbg(chip->card->dev, "pcxhr_close chip%d subs%d\n",
1098 		    chip->chip_idx, subs->number);
1099 
1100 	/* sample rate released */
1101 	if (--mgr->ref_count_rate == 0) {
1102 		mgr->sample_rate = 0;	/* the sample rate is no more locked */
1103 		pcxhr_hardware_timer(mgr, 0);	/* stop the DSP-timer */
1104 	}
1105 
1106 	stream->status    = PCXHR_STREAM_STATUS_FREE;
1107 	stream->substream = NULL;
1108 
1109 	mutex_unlock(&mgr->setup_mutex);
1110 
1111 	return 0;
1112 }
1113 
1114 
1115 static snd_pcm_uframes_t pcxhr_stream_pointer(struct snd_pcm_substream *subs)
1116 {
1117 	u_int32_t timer_period_frag;
1118 	int timer_buf_periods;
1119 	struct snd_pcxhr *chip = snd_pcm_substream_chip(subs);
1120 	struct snd_pcm_runtime *runtime = subs->runtime;
1121 	struct pcxhr_stream *stream  = runtime->private_data;
1122 
1123 	mutex_lock(&chip->mgr->lock);
1124 
1125 	/* get the period fragment and the nb of periods in the buffer */
1126 	timer_period_frag = stream->timer_period_frag;
1127 	timer_buf_periods = stream->timer_buf_periods;
1128 
1129 	mutex_unlock(&chip->mgr->lock);
1130 
1131 	return (snd_pcm_uframes_t)((timer_buf_periods * runtime->period_size) +
1132 				   timer_period_frag);
1133 }
1134 
1135 
1136 static const struct snd_pcm_ops pcxhr_ops = {
1137 	.open      = pcxhr_open,
1138 	.close     = pcxhr_close,
1139 	.ioctl     = snd_pcm_lib_ioctl,
1140 	.prepare   = pcxhr_prepare,
1141 	.hw_params = pcxhr_hw_params,
1142 	.hw_free   = pcxhr_hw_free,
1143 	.trigger   = pcxhr_trigger,
1144 	.pointer   = pcxhr_stream_pointer,
1145 };
1146 
1147 /*
1148  */
1149 int pcxhr_create_pcm(struct snd_pcxhr *chip)
1150 {
1151 	int err;
1152 	struct snd_pcm *pcm;
1153 	char name[32];
1154 
1155 	snprintf(name, sizeof(name), "pcxhr %d", chip->chip_idx);
1156 	if ((err = snd_pcm_new(chip->card, name, 0,
1157 			       chip->nb_streams_play,
1158 			       chip->nb_streams_capt, &pcm)) < 0) {
1159 		dev_err(chip->card->dev, "cannot create pcm %s\n", name);
1160 		return err;
1161 	}
1162 	pcm->private_data = chip;
1163 
1164 	if (chip->nb_streams_play)
1165 		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcxhr_ops);
1166 	if (chip->nb_streams_capt)
1167 		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcxhr_ops);
1168 
1169 	pcm->info_flags = 0;
1170 	pcm->nonatomic = true;
1171 	strcpy(pcm->name, name);
1172 
1173 	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1174 					      &chip->mgr->pci->dev,
1175 					      32*1024, 32*1024);
1176 	chip->pcm = pcm;
1177 	return 0;
1178 }
1179 
1180 static int pcxhr_chip_free(struct snd_pcxhr *chip)
1181 {
1182 	kfree(chip);
1183 	return 0;
1184 }
1185 
1186 static int pcxhr_chip_dev_free(struct snd_device *device)
1187 {
1188 	struct snd_pcxhr *chip = device->device_data;
1189 	return pcxhr_chip_free(chip);
1190 }
1191 
1192 
1193 /*
1194  */
1195 static int pcxhr_create(struct pcxhr_mgr *mgr,
1196 			struct snd_card *card, int idx)
1197 {
1198 	int err;
1199 	struct snd_pcxhr *chip;
1200 	static struct snd_device_ops ops = {
1201 		.dev_free = pcxhr_chip_dev_free,
1202 	};
1203 
1204 	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
1205 	if (!chip)
1206 		return -ENOMEM;
1207 
1208 	chip->card = card;
1209 	chip->chip_idx = idx;
1210 	chip->mgr = mgr;
1211 
1212 	if (idx < mgr->playback_chips)
1213 		/* stereo or mono streams */
1214 		chip->nb_streams_play = PCXHR_PLAYBACK_STREAMS;
1215 
1216 	if (idx < mgr->capture_chips) {
1217 		if (mgr->mono_capture)
1218 			chip->nb_streams_capt = 2;	/* 2 mono streams */
1219 		else
1220 			chip->nb_streams_capt = 1;	/* or 1 stereo stream */
1221 	}
1222 
1223 	if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {
1224 		pcxhr_chip_free(chip);
1225 		return err;
1226 	}
1227 
1228 	mgr->chip[idx] = chip;
1229 
1230 	return 0;
1231 }
1232 
1233 /* proc interface */
1234 static void pcxhr_proc_info(struct snd_info_entry *entry,
1235 			    struct snd_info_buffer *buffer)
1236 {
1237 	struct snd_pcxhr *chip = entry->private_data;
1238 	struct pcxhr_mgr *mgr = chip->mgr;
1239 
1240 	snd_iprintf(buffer, "\n%s\n", mgr->name);
1241 
1242 	/* stats available when embedded DSP is running */
1243 	if (mgr->dsp_loaded & (1 << PCXHR_FIRMWARE_DSP_MAIN_INDEX)) {
1244 		struct pcxhr_rmh rmh;
1245 		short ver_maj = (mgr->dsp_version >> 16) & 0xff;
1246 		short ver_min = (mgr->dsp_version >> 8) & 0xff;
1247 		short ver_build = mgr->dsp_version & 0xff;
1248 		snd_iprintf(buffer, "module version %s\n",
1249 			    PCXHR_DRIVER_VERSION_STRING);
1250 		snd_iprintf(buffer, "dsp version %d.%d.%d\n",
1251 			    ver_maj, ver_min, ver_build);
1252 		if (mgr->board_has_analog)
1253 			snd_iprintf(buffer, "analog io available\n");
1254 		else
1255 			snd_iprintf(buffer, "digital only board\n");
1256 
1257 		/* calc cpu load of the dsp */
1258 		pcxhr_init_rmh(&rmh, CMD_GET_DSP_RESOURCES);
1259 		if( ! pcxhr_send_msg(mgr, &rmh) ) {
1260 			int cur = rmh.stat[0];
1261 			int ref = rmh.stat[1];
1262 			if (ref > 0) {
1263 				if (mgr->sample_rate_real != 0 &&
1264 				    mgr->sample_rate_real != 48000) {
1265 					ref = (ref * 48000) /
1266 					  mgr->sample_rate_real;
1267 					if (mgr->sample_rate_real >=
1268 					    PCXHR_IRQ_TIMER_FREQ)
1269 						ref *= 2;
1270 				}
1271 				cur = 100 - (100 * cur) / ref;
1272 				snd_iprintf(buffer, "cpu load    %d%%\n", cur);
1273 				snd_iprintf(buffer, "buffer pool %d/%d\n",
1274 					    rmh.stat[2], rmh.stat[3]);
1275 			}
1276 		}
1277 		snd_iprintf(buffer, "dma granularity : %d\n",
1278 			    mgr->granularity);
1279 		snd_iprintf(buffer, "dsp time errors : %d\n",
1280 			    mgr->dsp_time_err);
1281 		snd_iprintf(buffer, "dsp async pipe xrun errors : %d\n",
1282 			    mgr->async_err_pipe_xrun);
1283 		snd_iprintf(buffer, "dsp async stream xrun errors : %d\n",
1284 			    mgr->async_err_stream_xrun);
1285 		snd_iprintf(buffer, "dsp async last other error : %x\n",
1286 			    mgr->async_err_other_last);
1287 		/* debug zone dsp */
1288 		rmh.cmd[0] = 0x4200 + PCXHR_SIZE_MAX_STATUS;
1289 		rmh.cmd_len = 1;
1290 		rmh.stat_len = PCXHR_SIZE_MAX_STATUS;
1291 		rmh.dsp_stat = 0;
1292 		rmh.cmd_idx = CMD_LAST_INDEX;
1293 		if( ! pcxhr_send_msg(mgr, &rmh) ) {
1294 			int i;
1295 			if (rmh.stat_len > 8)
1296 				rmh.stat_len = 8;
1297 			for (i = 0; i < rmh.stat_len; i++)
1298 				snd_iprintf(buffer, "debug[%02d] = %06x\n",
1299 					    i,  rmh.stat[i]);
1300 		}
1301 	} else
1302 		snd_iprintf(buffer, "no firmware loaded\n");
1303 	snd_iprintf(buffer, "\n");
1304 }
1305 static void pcxhr_proc_sync(struct snd_info_entry *entry,
1306 			    struct snd_info_buffer *buffer)
1307 {
1308 	struct snd_pcxhr *chip = entry->private_data;
1309 	struct pcxhr_mgr *mgr = chip->mgr;
1310 	static const char *textsHR22[3] = {
1311 		"Internal", "AES Sync", "AES 1"
1312 	};
1313 	static const char *textsPCXHR[7] = {
1314 		"Internal", "Word", "AES Sync",
1315 		"AES 1", "AES 2", "AES 3", "AES 4"
1316 	};
1317 	const char **texts;
1318 	int max_clock;
1319 	if (mgr->is_hr_stereo) {
1320 		texts = textsHR22;
1321 		max_clock = HR22_CLOCK_TYPE_MAX;
1322 	} else {
1323 		texts = textsPCXHR;
1324 		max_clock = PCXHR_CLOCK_TYPE_MAX;
1325 	}
1326 
1327 	snd_iprintf(buffer, "\n%s\n", mgr->name);
1328 	snd_iprintf(buffer, "Current Sample Clock\t: %s\n",
1329 		    texts[mgr->cur_clock_type]);
1330 	snd_iprintf(buffer, "Current Sample Rate\t= %d\n",
1331 		    mgr->sample_rate_real);
1332 	/* commands available when embedded DSP is running */
1333 	if (mgr->dsp_loaded & (1 << PCXHR_FIRMWARE_DSP_MAIN_INDEX)) {
1334 		int i, err, sample_rate;
1335 		for (i = 1; i <= max_clock; i++) {
1336 			err = pcxhr_get_external_clock(mgr, i, &sample_rate);
1337 			if (err)
1338 				break;
1339 			snd_iprintf(buffer, "%s Clock\t\t= %d\n",
1340 				    texts[i], sample_rate);
1341 		}
1342 	} else
1343 		snd_iprintf(buffer, "no firmware loaded\n");
1344 	snd_iprintf(buffer, "\n");
1345 }
1346 
1347 static void pcxhr_proc_gpio_read(struct snd_info_entry *entry,
1348 				 struct snd_info_buffer *buffer)
1349 {
1350 	struct snd_pcxhr *chip = entry->private_data;
1351 	struct pcxhr_mgr *mgr = chip->mgr;
1352 	/* commands available when embedded DSP is running */
1353 	if (mgr->dsp_loaded & (1 << PCXHR_FIRMWARE_DSP_MAIN_INDEX)) {
1354 		/* gpio ports on stereo boards only available */
1355 		int value = 0;
1356 		hr222_read_gpio(mgr, 1, &value);	/* GPI */
1357 		snd_iprintf(buffer, "GPI: 0x%x\n", value);
1358 		hr222_read_gpio(mgr, 0, &value);	/* GP0 */
1359 		snd_iprintf(buffer, "GPO: 0x%x\n", value);
1360 	} else
1361 		snd_iprintf(buffer, "no firmware loaded\n");
1362 	snd_iprintf(buffer, "\n");
1363 }
1364 static void pcxhr_proc_gpo_write(struct snd_info_entry *entry,
1365 				 struct snd_info_buffer *buffer)
1366 {
1367 	struct snd_pcxhr *chip = entry->private_data;
1368 	struct pcxhr_mgr *mgr = chip->mgr;
1369 	char line[64];
1370 	int value;
1371 	/* commands available when embedded DSP is running */
1372 	if (!(mgr->dsp_loaded & (1 << PCXHR_FIRMWARE_DSP_MAIN_INDEX)))
1373 		return;
1374 	while (!snd_info_get_line(buffer, line, sizeof(line))) {
1375 		if (sscanf(line, "GPO: 0x%x", &value) != 1)
1376 			continue;
1377 		hr222_write_gpo(mgr, value);	/* GP0 */
1378 	}
1379 }
1380 
1381 /* Access to the results of the CMD_GET_TIME_CODE RMH */
1382 #define TIME_CODE_VALID_MASK	0x00800000
1383 #define TIME_CODE_NEW_MASK	0x00400000
1384 #define TIME_CODE_BACK_MASK	0x00200000
1385 #define TIME_CODE_WAIT_MASK	0x00100000
1386 
1387 /* Values for the CMD_MANAGE_SIGNAL RMH */
1388 #define MANAGE_SIGNAL_TIME_CODE	0x01
1389 #define MANAGE_SIGNAL_MIDI	0x02
1390 
1391 /* linear time code read proc*/
1392 static void pcxhr_proc_ltc(struct snd_info_entry *entry,
1393 			   struct snd_info_buffer *buffer)
1394 {
1395 	struct snd_pcxhr *chip = entry->private_data;
1396 	struct pcxhr_mgr *mgr = chip->mgr;
1397 	struct pcxhr_rmh rmh;
1398 	unsigned int ltcHrs, ltcMin, ltcSec, ltcFrm;
1399 	int err;
1400 	/* commands available when embedded DSP is running */
1401 	if (!(mgr->dsp_loaded & (1 << PCXHR_FIRMWARE_DSP_MAIN_INDEX))) {
1402 		snd_iprintf(buffer, "no firmware loaded\n");
1403 		return;
1404 	}
1405 	if (!mgr->capture_ltc) {
1406 		pcxhr_init_rmh(&rmh, CMD_MANAGE_SIGNAL);
1407 		rmh.cmd[0] |= MANAGE_SIGNAL_TIME_CODE;
1408 		err = pcxhr_send_msg(mgr, &rmh);
1409 		if (err) {
1410 			snd_iprintf(buffer, "ltc not activated (%d)\n", err);
1411 			return;
1412 		}
1413 		if (mgr->is_hr_stereo)
1414 			hr222_manage_timecode(mgr, 1);
1415 		else
1416 			pcxhr_write_io_num_reg_cont(mgr, REG_CONT_VALSMPTE,
1417 						    REG_CONT_VALSMPTE, NULL);
1418 		mgr->capture_ltc = 1;
1419 	}
1420 	pcxhr_init_rmh(&rmh, CMD_GET_TIME_CODE);
1421 	err = pcxhr_send_msg(mgr, &rmh);
1422 	if (err) {
1423 		snd_iprintf(buffer, "ltc read error (err=%d)\n", err);
1424 		return ;
1425 	}
1426 	ltcHrs = 10*((rmh.stat[0] >> 8) & 0x3) + (rmh.stat[0] & 0xf);
1427 	ltcMin = 10*((rmh.stat[1] >> 16) & 0x7) + ((rmh.stat[1] >> 8) & 0xf);
1428 	ltcSec = 10*(rmh.stat[1] & 0x7) + ((rmh.stat[2] >> 16) & 0xf);
1429 	ltcFrm = 10*((rmh.stat[2] >> 8) & 0x3) + (rmh.stat[2] & 0xf);
1430 
1431 	snd_iprintf(buffer, "timecode: %02u:%02u:%02u-%02u\n",
1432 			    ltcHrs, ltcMin, ltcSec, ltcFrm);
1433 	snd_iprintf(buffer, "raw: 0x%04x%06x%06x\n", rmh.stat[0] & 0x00ffff,
1434 			    rmh.stat[1] & 0xffffff, rmh.stat[2] & 0xffffff);
1435 	/*snd_iprintf(buffer, "dsp ref time: 0x%06x%06x\n",
1436 			    rmh.stat[3] & 0xffffff, rmh.stat[4] & 0xffffff);*/
1437 	if (!(rmh.stat[0] & TIME_CODE_VALID_MASK)) {
1438 		snd_iprintf(buffer, "warning: linear timecode not valid\n");
1439 	}
1440 }
1441 
1442 static void pcxhr_proc_init(struct snd_pcxhr *chip)
1443 {
1444 	snd_card_ro_proc_new(chip->card, "info", chip, pcxhr_proc_info);
1445 	snd_card_ro_proc_new(chip->card, "sync", chip, pcxhr_proc_sync);
1446 	/* gpio available on stereo sound cards only */
1447 	if (chip->mgr->is_hr_stereo)
1448 		snd_card_rw_proc_new(chip->card, "gpio", chip,
1449 				     pcxhr_proc_gpio_read,
1450 				     pcxhr_proc_gpo_write);
1451 	snd_card_ro_proc_new(chip->card, "ltc", chip, pcxhr_proc_ltc);
1452 }
1453 /* end of proc interface */
1454 
1455 /*
1456  * release all the cards assigned to a manager instance
1457  */
1458 static int pcxhr_free(struct pcxhr_mgr *mgr)
1459 {
1460 	unsigned int i;
1461 
1462 	for (i = 0; i < mgr->num_cards; i++) {
1463 		if (mgr->chip[i])
1464 			snd_card_free(mgr->chip[i]->card);
1465 	}
1466 
1467 	/* reset board if some firmware was loaded */
1468 	if(mgr->dsp_loaded) {
1469 		pcxhr_reset_board(mgr);
1470 		dev_dbg(&mgr->pci->dev, "reset pcxhr !\n");
1471 	}
1472 
1473 	/* release irq  */
1474 	if (mgr->irq >= 0)
1475 		free_irq(mgr->irq, mgr);
1476 
1477 	pci_release_regions(mgr->pci);
1478 
1479 	/* free hostport purgebuffer */
1480 	if (mgr->hostport.area) {
1481 		snd_dma_free_pages(&mgr->hostport);
1482 		mgr->hostport.area = NULL;
1483 	}
1484 
1485 	kfree(mgr->prmh);
1486 
1487 	pci_disable_device(mgr->pci);
1488 	kfree(mgr);
1489 	return 0;
1490 }
1491 
1492 /*
1493  *    probe function - creates the card manager
1494  */
1495 static int pcxhr_probe(struct pci_dev *pci,
1496 		       const struct pci_device_id *pci_id)
1497 {
1498 	static int dev;
1499 	struct pcxhr_mgr *mgr;
1500 	unsigned int i;
1501 	int err;
1502 	size_t size;
1503 	char *card_name;
1504 
1505 	if (dev >= SNDRV_CARDS)
1506 		return -ENODEV;
1507 	if (! enable[dev]) {
1508 		dev++;
1509 		return -ENOENT;
1510 	}
1511 
1512 	/* enable PCI device */
1513 	if ((err = pci_enable_device(pci)) < 0)
1514 		return err;
1515 	pci_set_master(pci);
1516 
1517 	/* check if we can restrict PCI DMA transfers to 32 bits */
1518 	if (dma_set_mask(&pci->dev, DMA_BIT_MASK(32)) < 0) {
1519 		dev_err(&pci->dev,
1520 			"architecture does not support 32bit PCI busmaster DMA\n");
1521 		pci_disable_device(pci);
1522 		return -ENXIO;
1523 	}
1524 
1525 	/* alloc card manager */
1526 	mgr = kzalloc(sizeof(*mgr), GFP_KERNEL);
1527 	if (! mgr) {
1528 		pci_disable_device(pci);
1529 		return -ENOMEM;
1530 	}
1531 
1532 	if (snd_BUG_ON(pci_id->driver_data >= PCI_ID_LAST)) {
1533 		kfree(mgr);
1534 		pci_disable_device(pci);
1535 		return -ENODEV;
1536 	}
1537 	card_name =
1538 		pcxhr_board_params[pci_id->driver_data].board_name;
1539 	mgr->playback_chips =
1540 		pcxhr_board_params[pci_id->driver_data].playback_chips;
1541 	mgr->capture_chips  =
1542 		pcxhr_board_params[pci_id->driver_data].capture_chips;
1543 	mgr->fw_file_set =
1544 		pcxhr_board_params[pci_id->driver_data].fw_file_set;
1545 	mgr->firmware_num  =
1546 		pcxhr_board_params[pci_id->driver_data].firmware_num;
1547 	mgr->mono_capture = mono[dev];
1548 	mgr->is_hr_stereo = (mgr->playback_chips == 1);
1549 	mgr->board_has_aes1 = PCXHR_BOARD_HAS_AES1(mgr);
1550 	mgr->board_aes_in_192k = !PCXHR_BOARD_AESIN_NO_192K(mgr);
1551 
1552 	if (mgr->is_hr_stereo)
1553 		mgr->granularity = PCXHR_GRANULARITY_HR22;
1554 	else
1555 		mgr->granularity = PCXHR_GRANULARITY;
1556 
1557 	/* resource assignment */
1558 	if ((err = pci_request_regions(pci, card_name)) < 0) {
1559 		kfree(mgr);
1560 		pci_disable_device(pci);
1561 		return err;
1562 	}
1563 	for (i = 0; i < 3; i++)
1564 		mgr->port[i] = pci_resource_start(pci, i);
1565 
1566 	mgr->pci = pci;
1567 	mgr->irq = -1;
1568 
1569 	if (request_threaded_irq(pci->irq, pcxhr_interrupt,
1570 				 pcxhr_threaded_irq, IRQF_SHARED,
1571 				 KBUILD_MODNAME, mgr)) {
1572 		dev_err(&pci->dev, "unable to grab IRQ %d\n", pci->irq);
1573 		pcxhr_free(mgr);
1574 		return -EBUSY;
1575 	}
1576 	mgr->irq = pci->irq;
1577 
1578 	snprintf(mgr->name, sizeof(mgr->name),
1579 		 "Digigram at 0x%lx & 0x%lx, 0x%lx irq %i",
1580 		 mgr->port[0], mgr->port[1], mgr->port[2], mgr->irq);
1581 
1582 	/* ISR lock  */
1583 	mutex_init(&mgr->lock);
1584 	mutex_init(&mgr->msg_lock);
1585 
1586 	/* init setup mutex*/
1587 	mutex_init(&mgr->setup_mutex);
1588 
1589 	mgr->prmh = kmalloc(sizeof(*mgr->prmh) +
1590 			    sizeof(u32) * (PCXHR_SIZE_MAX_LONG_STATUS -
1591 					   PCXHR_SIZE_MAX_STATUS),
1592 			    GFP_KERNEL);
1593 	if (! mgr->prmh) {
1594 		pcxhr_free(mgr);
1595 		return -ENOMEM;
1596 	}
1597 
1598 	for (i=0; i < PCXHR_MAX_CARDS; i++) {
1599 		struct snd_card *card;
1600 		char tmpid[16];
1601 		int idx;
1602 
1603 		if (i >= max(mgr->playback_chips, mgr->capture_chips))
1604 			break;
1605 		mgr->num_cards++;
1606 
1607 		if (index[dev] < 0)
1608 			idx = index[dev];
1609 		else
1610 			idx = index[dev] + i;
1611 
1612 		snprintf(tmpid, sizeof(tmpid), "%s-%d",
1613 			 id[dev] ? id[dev] : card_name, i);
1614 		err = snd_card_new(&pci->dev, idx, tmpid, THIS_MODULE,
1615 				   0, &card);
1616 
1617 		if (err < 0) {
1618 			dev_err(&pci->dev, "cannot allocate the card %d\n", i);
1619 			pcxhr_free(mgr);
1620 			return err;
1621 		}
1622 
1623 		strcpy(card->driver, DRIVER_NAME);
1624 		snprintf(card->shortname, sizeof(card->shortname),
1625 			 "Digigram [PCM #%d]", i);
1626 		snprintf(card->longname, sizeof(card->longname),
1627 			 "%s [PCM #%d]", mgr->name, i);
1628 
1629 		if ((err = pcxhr_create(mgr, card, i)) < 0) {
1630 			snd_card_free(card);
1631 			pcxhr_free(mgr);
1632 			return err;
1633 		}
1634 
1635 		if (i == 0)
1636 			/* init proc interface only for chip0 */
1637 			pcxhr_proc_init(mgr->chip[i]);
1638 
1639 		if ((err = snd_card_register(card)) < 0) {
1640 			pcxhr_free(mgr);
1641 			return err;
1642 		}
1643 	}
1644 
1645 	/* create hostport purgebuffer */
1646 	size = PAGE_ALIGN(sizeof(struct pcxhr_hostport));
1647 	if (snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, &pci->dev,
1648 				size, &mgr->hostport) < 0) {
1649 		pcxhr_free(mgr);
1650 		return -ENOMEM;
1651 	}
1652 	/* init purgebuffer */
1653 	memset(mgr->hostport.area, 0, size);
1654 
1655 	/* create a DSP loader */
1656 	err = pcxhr_setup_firmware(mgr);
1657 	if (err < 0) {
1658 		pcxhr_free(mgr);
1659 		return err;
1660 	}
1661 
1662 	pci_set_drvdata(pci, mgr);
1663 	dev++;
1664 	return 0;
1665 }
1666 
1667 static void pcxhr_remove(struct pci_dev *pci)
1668 {
1669 	pcxhr_free(pci_get_drvdata(pci));
1670 }
1671 
1672 static struct pci_driver pcxhr_driver = {
1673 	.name = KBUILD_MODNAME,
1674 	.id_table = pcxhr_ids,
1675 	.probe = pcxhr_probe,
1676 	.remove = pcxhr_remove,
1677 };
1678 
1679 module_pci_driver(pcxhr_driver);
1680