xref: /openbmc/linux/sound/pci/asihpi/asihpi.c (revision 8730046c)
1 /*
2  *  Asihpi soundcard
3  *  Copyright (c) by AudioScience Inc <support@audioscience.com>
4  *
5  *   This program is free software; you can redistribute it and/or modify
6  *   it under the terms of version 2 of the GNU General Public License as
7  *   published by the Free Software Foundation;
8  *
9  *   This program is distributed in the hope that it will be useful,
10  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
11  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  *   GNU General Public License for more details.
13  *
14  *   You should have received a copy of the GNU General Public License
15  *   along with this program; if not, write to the Free Software
16  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
17  *
18  *
19  *  The following is not a condition of use, merely a request:
20  *  If you modify this program, particularly if you fix errors, AudioScience Inc
21  *  would appreciate it if you grant us the right to use those modifications
22  *  for any purpose including commercial applications.
23  */
24 
25 #include "hpi_internal.h"
26 #include "hpi_version.h"
27 #include "hpimsginit.h"
28 #include "hpioctl.h"
29 #include "hpicmn.h"
30 
31 #include <linux/pci.h>
32 #include <linux/init.h>
33 #include <linux/jiffies.h>
34 #include <linux/slab.h>
35 #include <linux/time.h>
36 #include <linux/wait.h>
37 #include <linux/module.h>
38 #include <sound/core.h>
39 #include <sound/control.h>
40 #include <sound/pcm.h>
41 #include <sound/pcm_params.h>
42 #include <sound/info.h>
43 #include <sound/initval.h>
44 #include <sound/tlv.h>
45 #include <sound/hwdep.h>
46 
47 MODULE_LICENSE("GPL");
48 MODULE_AUTHOR("AudioScience inc. <support@audioscience.com>");
49 MODULE_DESCRIPTION("AudioScience ALSA ASI5xxx ASI6xxx ASI87xx ASI89xx "
50 			HPI_VER_STRING);
51 
52 #if defined CONFIG_SND_DEBUG_VERBOSE
53 /**
54  * snd_printddd - very verbose debug printk
55  * @format: format string
56  *
57  * Works like snd_printk() for debugging purposes.
58  * Ignored when CONFIG_SND_DEBUG_VERBOSE is not set.
59  * Must set snd module debug parameter to 3 to enable at runtime.
60  */
61 #define snd_printddd(format, args...) \
62 	__snd_printk(3, __FILE__, __LINE__, format, ##args)
63 #else
64 #define snd_printddd(format, args...) do { } while (0)
65 #endif
66 
67 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;	/* index 0-MAX */
68 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	/* ID for this card */
69 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
70 static bool enable_hpi_hwdep = 1;
71 
72 module_param_array(index, int, NULL, S_IRUGO);
73 MODULE_PARM_DESC(index, "ALSA index value for AudioScience soundcard.");
74 
75 module_param_array(id, charp, NULL, S_IRUGO);
76 MODULE_PARM_DESC(id, "ALSA ID string for AudioScience soundcard.");
77 
78 module_param_array(enable, bool, NULL, S_IRUGO);
79 MODULE_PARM_DESC(enable, "ALSA enable AudioScience soundcard.");
80 
81 module_param(enable_hpi_hwdep, bool, S_IRUGO|S_IWUSR);
82 MODULE_PARM_DESC(enable_hpi_hwdep,
83 		"ALSA enable HPI hwdep for AudioScience soundcard ");
84 
85 /* identify driver */
86 #ifdef KERNEL_ALSA_BUILD
87 static char *build_info = "Built using headers from kernel source";
88 module_param(build_info, charp, S_IRUGO);
89 MODULE_PARM_DESC(build_info, "Built using headers from kernel source");
90 #else
91 static char *build_info = "Built within ALSA source";
92 module_param(build_info, charp, S_IRUGO);
93 MODULE_PARM_DESC(build_info, "Built within ALSA source");
94 #endif
95 
96 /* set to 1 to dump every control from adapter to log */
97 static const int mixer_dump;
98 
99 #define DEFAULT_SAMPLERATE 44100
100 static int adapter_fs = DEFAULT_SAMPLERATE;
101 
102 /* defaults */
103 #define PERIODS_MIN 2
104 #define PERIOD_BYTES_MIN  2048
105 #define BUFFER_BYTES_MAX (512 * 1024)
106 
107 #define MAX_CLOCKSOURCES (HPI_SAMPLECLOCK_SOURCE_LAST + 1 + 7)
108 
109 struct clk_source {
110 	int source;
111 	int index;
112 	const char *name;
113 };
114 
115 struct clk_cache {
116 	int count;
117 	int has_local;
118 	struct clk_source s[MAX_CLOCKSOURCES];
119 };
120 
121 /* Per card data */
122 struct snd_card_asihpi {
123 	struct snd_card *card;
124 	struct pci_dev *pci;
125 	struct hpi_adapter *hpi;
126 
127 	/* In low latency mode there is only one stream, a pointer to its
128 	 * private data is stored here on trigger and cleared on stop.
129 	 * The interrupt handler uses it as a parameter when calling
130 	 * snd_card_asihpi_timer_function().
131 	 */
132 	struct snd_card_asihpi_pcm *llmode_streampriv;
133 	struct tasklet_struct t;
134 	void (*pcm_start)(struct snd_pcm_substream *substream);
135 	void (*pcm_stop)(struct snd_pcm_substream *substream);
136 
137 	u32 h_mixer;
138 	struct clk_cache cc;
139 
140 	u16 can_dma;
141 	u16 support_grouping;
142 	u16 support_mrx;
143 	u16 update_interval_frames;
144 	u16 in_max_chans;
145 	u16 out_max_chans;
146 	u16 in_min_chans;
147 	u16 out_min_chans;
148 };
149 
150 /* Per stream data */
151 struct snd_card_asihpi_pcm {
152 	struct timer_list timer;
153 	unsigned int respawn_timer;
154 	unsigned int hpi_buffer_attached;
155 	unsigned int buffer_bytes;
156 	unsigned int period_bytes;
157 	unsigned int bytes_per_sec;
158 	unsigned int pcm_buf_host_rw_ofs; /* Host R/W pos */
159 	unsigned int pcm_buf_dma_ofs;	/* DMA R/W offset in buffer */
160 	unsigned int pcm_buf_elapsed_dma_ofs;	/* DMA R/W offset in buffer */
161 	unsigned int drained_count;
162 	struct snd_pcm_substream *substream;
163 	u32 h_stream;
164 	struct hpi_format format;
165 };
166 
167 /* universal stream verbs work with out or in stream handles */
168 
169 /* Functions to allow driver to give a buffer to HPI for busmastering */
170 
171 static u16 hpi_stream_host_buffer_attach(
172 	u32 h_stream,   /* handle to outstream. */
173 	u32 size_in_bytes, /* size in bytes of bus mastering buffer */
174 	u32 pci_address
175 )
176 {
177 	struct hpi_message hm;
178 	struct hpi_response hr;
179 	unsigned int obj = hpi_handle_object(h_stream);
180 
181 	if (!h_stream)
182 		return HPI_ERROR_INVALID_OBJ;
183 	hpi_init_message_response(&hm, &hr, obj,
184 			obj == HPI_OBJ_OSTREAM ?
185 				HPI_OSTREAM_HOSTBUFFER_ALLOC :
186 				HPI_ISTREAM_HOSTBUFFER_ALLOC);
187 
188 	hpi_handle_to_indexes(h_stream, &hm.adapter_index,
189 				&hm.obj_index);
190 
191 	hm.u.d.u.buffer.buffer_size = size_in_bytes;
192 	hm.u.d.u.buffer.pci_address = pci_address;
193 	hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_GRANTADAPTER;
194 	hpi_send_recv(&hm, &hr);
195 	return hr.error;
196 }
197 
198 static u16 hpi_stream_host_buffer_detach(u32  h_stream)
199 {
200 	struct hpi_message hm;
201 	struct hpi_response hr;
202 	unsigned int obj = hpi_handle_object(h_stream);
203 
204 	if (!h_stream)
205 		return HPI_ERROR_INVALID_OBJ;
206 
207 	hpi_init_message_response(&hm, &hr,  obj,
208 			obj == HPI_OBJ_OSTREAM ?
209 				HPI_OSTREAM_HOSTBUFFER_FREE :
210 				HPI_ISTREAM_HOSTBUFFER_FREE);
211 
212 	hpi_handle_to_indexes(h_stream, &hm.adapter_index,
213 				&hm.obj_index);
214 	hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_REVOKEADAPTER;
215 	hpi_send_recv(&hm, &hr);
216 	return hr.error;
217 }
218 
219 static inline u16 hpi_stream_start(u32 h_stream)
220 {
221 	if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
222 		return hpi_outstream_start(h_stream);
223 	else
224 		return hpi_instream_start(h_stream);
225 }
226 
227 static inline u16 hpi_stream_stop(u32 h_stream)
228 {
229 	if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
230 		return hpi_outstream_stop(h_stream);
231 	else
232 		return hpi_instream_stop(h_stream);
233 }
234 
235 static inline u16 hpi_stream_get_info_ex(
236     u32 h_stream,
237     u16        *pw_state,
238     u32        *pbuffer_size,
239     u32        *pdata_in_buffer,
240     u32        *psample_count,
241     u32        *pauxiliary_data
242 )
243 {
244 	u16 e;
245 	if (hpi_handle_object(h_stream)  ==  HPI_OBJ_OSTREAM)
246 		e = hpi_outstream_get_info_ex(h_stream, pw_state,
247 					pbuffer_size, pdata_in_buffer,
248 					psample_count, pauxiliary_data);
249 	else
250 		e = hpi_instream_get_info_ex(h_stream, pw_state,
251 					pbuffer_size, pdata_in_buffer,
252 					psample_count, pauxiliary_data);
253 	return e;
254 }
255 
256 static inline u16 hpi_stream_group_add(
257 					u32 h_master,
258 					u32 h_stream)
259 {
260 	if (hpi_handle_object(h_master) ==  HPI_OBJ_OSTREAM)
261 		return hpi_outstream_group_add(h_master, h_stream);
262 	else
263 		return hpi_instream_group_add(h_master, h_stream);
264 }
265 
266 static inline u16 hpi_stream_group_reset(u32 h_stream)
267 {
268 	if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
269 		return hpi_outstream_group_reset(h_stream);
270 	else
271 		return hpi_instream_group_reset(h_stream);
272 }
273 
274 static inline u16 hpi_stream_group_get_map(
275 				u32 h_stream, u32 *mo, u32 *mi)
276 {
277 	if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
278 		return hpi_outstream_group_get_map(h_stream, mo, mi);
279 	else
280 		return hpi_instream_group_get_map(h_stream, mo, mi);
281 }
282 
283 static u16 handle_error(u16 err, int line, char *filename)
284 {
285 	if (err)
286 		printk(KERN_WARNING
287 			"in file %s, line %d: HPI error %d\n",
288 			filename, line, err);
289 	return err;
290 }
291 
292 #define hpi_handle_error(x)  handle_error(x, __LINE__, __FILE__)
293 
294 /***************************** GENERAL PCM ****************/
295 
296 static void print_hwparams(struct snd_pcm_substream *substream,
297 				struct snd_pcm_hw_params *p)
298 {
299 	char name[16];
300 	snd_pcm_debug_name(substream, name, sizeof(name));
301 	snd_printdd("%s HWPARAMS\n", name);
302 	snd_printdd(" samplerate=%dHz channels=%d format=%d subformat=%d\n",
303 		params_rate(p), params_channels(p),
304 		params_format(p), params_subformat(p));
305 	snd_printdd(" buffer=%dB period=%dB period_size=%dB periods=%d\n",
306 		params_buffer_bytes(p), params_period_bytes(p),
307 		params_period_size(p), params_periods(p));
308 	snd_printdd(" buffer_size=%d access=%d data_rate=%dB/s\n",
309 		params_buffer_size(p), params_access(p),
310 		params_rate(p) * params_channels(p) *
311 		snd_pcm_format_width(params_format(p)) / 8);
312 }
313 
314 static snd_pcm_format_t hpi_to_alsa_formats[] = {
315 	-1,			/* INVALID */
316 	SNDRV_PCM_FORMAT_U8,	/* HPI_FORMAT_PCM8_UNSIGNED        1 */
317 	SNDRV_PCM_FORMAT_S16,	/* HPI_FORMAT_PCM16_SIGNED         2 */
318 	-1,			/* HPI_FORMAT_MPEG_L1              3 */
319 	SNDRV_PCM_FORMAT_MPEG,	/* HPI_FORMAT_MPEG_L2              4 */
320 	SNDRV_PCM_FORMAT_MPEG,	/* HPI_FORMAT_MPEG_L3              5 */
321 	-1,			/* HPI_FORMAT_DOLBY_AC2            6 */
322 	-1,			/* HPI_FORMAT_DOLBY_AC3            7 */
323 	SNDRV_PCM_FORMAT_S16_BE,/* HPI_FORMAT_PCM16_BIGENDIAN      8 */
324 	-1,			/* HPI_FORMAT_AA_TAGIT1_HITS       9 */
325 	-1,			/* HPI_FORMAT_AA_TAGIT1_INSERTS   10 */
326 	SNDRV_PCM_FORMAT_S32,	/* HPI_FORMAT_PCM32_SIGNED        11 */
327 	-1,			/* HPI_FORMAT_RAW_BITSTREAM       12 */
328 	-1,			/* HPI_FORMAT_AA_TAGIT1_HITS_EX1  13 */
329 	SNDRV_PCM_FORMAT_FLOAT,	/* HPI_FORMAT_PCM32_FLOAT         14 */
330 #if 1
331 	/* ALSA can't handle 3 byte sample size together with power-of-2
332 	 *  constraint on buffer_bytes, so disable this format
333 	 */
334 	-1
335 #else
336 	/* SNDRV_PCM_FORMAT_S24_3LE */ /* HPI_FORMAT_PCM24_SIGNED 15 */
337 #endif
338 };
339 
340 
341 static int snd_card_asihpi_format_alsa2hpi(snd_pcm_format_t alsa_format,
342 					   u16 *hpi_format)
343 {
344 	u16 format;
345 
346 	for (format = HPI_FORMAT_PCM8_UNSIGNED;
347 	     format <= HPI_FORMAT_PCM24_SIGNED; format++) {
348 		if (hpi_to_alsa_formats[format] == alsa_format) {
349 			*hpi_format = format;
350 			return 0;
351 		}
352 	}
353 
354 	snd_printd(KERN_WARNING "failed match for alsa format %d\n",
355 		   alsa_format);
356 	*hpi_format = 0;
357 	return -EINVAL;
358 }
359 
360 static void snd_card_asihpi_pcm_samplerates(struct snd_card_asihpi *asihpi,
361 					 struct snd_pcm_hardware *pcmhw)
362 {
363 	u16 err;
364 	u32 h_control;
365 	u32 sample_rate;
366 	int idx;
367 	unsigned int rate_min = 200000;
368 	unsigned int rate_max = 0;
369 	unsigned int rates = 0;
370 
371 	if (asihpi->support_mrx) {
372 		rates |= SNDRV_PCM_RATE_CONTINUOUS;
373 		rates |= SNDRV_PCM_RATE_8000_96000;
374 		rate_min = 8000;
375 		rate_max = 100000;
376 	} else {
377 		/* on cards without SRC,
378 		   valid rates are determined by sampleclock */
379 		err = hpi_mixer_get_control(asihpi->h_mixer,
380 					  HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
381 					  HPI_CONTROL_SAMPLECLOCK, &h_control);
382 		if (err) {
383 			dev_err(&asihpi->pci->dev,
384 				"No local sampleclock, err %d\n", err);
385 		}
386 
387 		for (idx = -1; idx < 100; idx++) {
388 			if (idx == -1) {
389 				if (hpi_sample_clock_get_sample_rate(h_control,
390 								&sample_rate))
391 					continue;
392 			} else if (hpi_sample_clock_query_local_rate(h_control,
393 							idx, &sample_rate)) {
394 				break;
395 			}
396 
397 			rate_min = min(rate_min, sample_rate);
398 			rate_max = max(rate_max, sample_rate);
399 
400 			switch (sample_rate) {
401 			case 5512:
402 				rates |= SNDRV_PCM_RATE_5512;
403 				break;
404 			case 8000:
405 				rates |= SNDRV_PCM_RATE_8000;
406 				break;
407 			case 11025:
408 				rates |= SNDRV_PCM_RATE_11025;
409 				break;
410 			case 16000:
411 				rates |= SNDRV_PCM_RATE_16000;
412 				break;
413 			case 22050:
414 				rates |= SNDRV_PCM_RATE_22050;
415 				break;
416 			case 32000:
417 				rates |= SNDRV_PCM_RATE_32000;
418 				break;
419 			case 44100:
420 				rates |= SNDRV_PCM_RATE_44100;
421 				break;
422 			case 48000:
423 				rates |= SNDRV_PCM_RATE_48000;
424 				break;
425 			case 64000:
426 				rates |= SNDRV_PCM_RATE_64000;
427 				break;
428 			case 88200:
429 				rates |= SNDRV_PCM_RATE_88200;
430 				break;
431 			case 96000:
432 				rates |= SNDRV_PCM_RATE_96000;
433 				break;
434 			case 176400:
435 				rates |= SNDRV_PCM_RATE_176400;
436 				break;
437 			case 192000:
438 				rates |= SNDRV_PCM_RATE_192000;
439 				break;
440 			default: /* some other rate */
441 				rates |= SNDRV_PCM_RATE_KNOT;
442 			}
443 		}
444 	}
445 
446 	pcmhw->rates = rates;
447 	pcmhw->rate_min = rate_min;
448 	pcmhw->rate_max = rate_max;
449 }
450 
451 static int snd_card_asihpi_pcm_hw_params(struct snd_pcm_substream *substream,
452 					 struct snd_pcm_hw_params *params)
453 {
454 	struct snd_pcm_runtime *runtime = substream->runtime;
455 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
456 	struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
457 	int err;
458 	u16 format;
459 	int width;
460 	unsigned int bytes_per_sec;
461 
462 	print_hwparams(substream, params);
463 	err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
464 	if (err < 0)
465 		return err;
466 	err = snd_card_asihpi_format_alsa2hpi(params_format(params), &format);
467 	if (err)
468 		return err;
469 
470 	hpi_handle_error(hpi_format_create(&dpcm->format,
471 			params_channels(params),
472 			format, params_rate(params), 0, 0));
473 
474 	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
475 		if (hpi_instream_reset(dpcm->h_stream) != 0)
476 			return -EINVAL;
477 
478 		if (hpi_instream_set_format(
479 			dpcm->h_stream, &dpcm->format) != 0)
480 			return -EINVAL;
481 	}
482 
483 	dpcm->hpi_buffer_attached = 0;
484 	if (card->can_dma) {
485 		err = hpi_stream_host_buffer_attach(dpcm->h_stream,
486 			params_buffer_bytes(params),  runtime->dma_addr);
487 		if (err == 0) {
488 			snd_printdd(
489 				"stream_host_buffer_attach success %u %lu\n",
490 				params_buffer_bytes(params),
491 				(unsigned long)runtime->dma_addr);
492 		} else {
493 			snd_printd("stream_host_buffer_attach error %d\n",
494 					err);
495 			return -ENOMEM;
496 		}
497 
498 		err = hpi_stream_get_info_ex(dpcm->h_stream, NULL,
499 				&dpcm->hpi_buffer_attached, NULL, NULL, NULL);
500 	}
501 	bytes_per_sec = params_rate(params) * params_channels(params);
502 	width = snd_pcm_format_width(params_format(params));
503 	bytes_per_sec *= width;
504 	bytes_per_sec /= 8;
505 	if (width < 0 || bytes_per_sec == 0)
506 		return -EINVAL;
507 
508 	dpcm->bytes_per_sec = bytes_per_sec;
509 	dpcm->buffer_bytes = params_buffer_bytes(params);
510 	dpcm->period_bytes = params_period_bytes(params);
511 
512 	return 0;
513 }
514 
515 static int
516 snd_card_asihpi_hw_free(struct snd_pcm_substream *substream)
517 {
518 	struct snd_pcm_runtime *runtime = substream->runtime;
519 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
520 	if (dpcm->hpi_buffer_attached)
521 		hpi_stream_host_buffer_detach(dpcm->h_stream);
522 
523 	snd_pcm_lib_free_pages(substream);
524 	return 0;
525 }
526 
527 static void snd_card_asihpi_runtime_free(struct snd_pcm_runtime *runtime)
528 {
529 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
530 	kfree(dpcm);
531 }
532 
533 static void snd_card_asihpi_pcm_timer_start(struct snd_pcm_substream *
534 					    substream)
535 {
536 	struct snd_pcm_runtime *runtime = substream->runtime;
537 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
538 	int expiry;
539 
540 	expiry = HZ / 200;
541 
542 	expiry = max(expiry, 1); /* don't let it be zero! */
543 	mod_timer(&dpcm->timer, jiffies + expiry);
544 	dpcm->respawn_timer = 1;
545 }
546 
547 static void snd_card_asihpi_pcm_timer_stop(struct snd_pcm_substream *substream)
548 {
549 	struct snd_pcm_runtime *runtime = substream->runtime;
550 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
551 
552 	dpcm->respawn_timer = 0;
553 	del_timer(&dpcm->timer);
554 }
555 
556 static void snd_card_asihpi_pcm_int_start(struct snd_pcm_substream *substream)
557 {
558 	struct snd_card_asihpi_pcm *dpcm;
559 	struct snd_card_asihpi *card;
560 
561 	BUG_ON(!substream);
562 
563 	dpcm = (struct snd_card_asihpi_pcm *)substream->runtime->private_data;
564 	card = snd_pcm_substream_chip(substream);
565 
566 	BUG_ON(in_interrupt());
567 	tasklet_disable(&card->t);
568 	card->llmode_streampriv = dpcm;
569 	tasklet_enable(&card->t);
570 
571 	hpi_handle_error(hpi_adapter_set_property(card->hpi->adapter->index,
572 		HPI_ADAPTER_PROPERTY_IRQ_RATE,
573 		card->update_interval_frames, 0));
574 }
575 
576 static void snd_card_asihpi_pcm_int_stop(struct snd_pcm_substream *substream)
577 {
578 	struct snd_card_asihpi_pcm *dpcm;
579 	struct snd_card_asihpi *card;
580 
581 	BUG_ON(!substream);
582 
583 	dpcm = (struct snd_card_asihpi_pcm *)substream->runtime->private_data;
584 	card = snd_pcm_substream_chip(substream);
585 
586 	hpi_handle_error(hpi_adapter_set_property(card->hpi->adapter->index,
587 		HPI_ADAPTER_PROPERTY_IRQ_RATE, 0, 0));
588 
589 	if (in_interrupt())
590 		card->llmode_streampriv = NULL;
591 	else {
592 		tasklet_disable(&card->t);
593 		card->llmode_streampriv = NULL;
594 		tasklet_enable(&card->t);
595 	}
596 }
597 
598 static int snd_card_asihpi_trigger(struct snd_pcm_substream *substream,
599 					   int cmd)
600 {
601 	struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
602 	struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
603 	struct snd_pcm_substream *s;
604 	u16 e;
605 	char name[16];
606 
607 	snd_pcm_debug_name(substream, name, sizeof(name));
608 
609 	switch (cmd) {
610 	case SNDRV_PCM_TRIGGER_START:
611 		snd_printdd("%s trigger start\n", name);
612 		snd_pcm_group_for_each_entry(s, substream) {
613 			struct snd_pcm_runtime *runtime = s->runtime;
614 			struct snd_card_asihpi_pcm *ds = runtime->private_data;
615 
616 			if (snd_pcm_substream_chip(s) != card)
617 				continue;
618 
619 			/* don't link Cap and Play */
620 			if (substream->stream != s->stream)
621 				continue;
622 
623 			ds->drained_count = 0;
624 			if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
625 				/* How do I know how much valid data is present
626 				* in buffer? Must be at least one period!
627 				* Guessing 2 periods, but if
628 				* buffer is bigger it may contain even more
629 				* data??
630 				*/
631 				unsigned int preload = ds->period_bytes * 1;
632 				snd_printddd("%d preload %d\n", s->number, preload);
633 				hpi_handle_error(hpi_outstream_write_buf(
634 						ds->h_stream,
635 						&runtime->dma_area[0],
636 						preload,
637 						&ds->format));
638 				ds->pcm_buf_host_rw_ofs = preload;
639 			}
640 
641 			if (card->support_grouping) {
642 				snd_printdd("%d group\n", s->number);
643 				e = hpi_stream_group_add(
644 					dpcm->h_stream,
645 					ds->h_stream);
646 				if (!e) {
647 					snd_pcm_trigger_done(s, substream);
648 				} else {
649 					hpi_handle_error(e);
650 					break;
651 				}
652 			} else
653 				break;
654 		}
655 		/* start the master stream */
656 		card->pcm_start(substream);
657 		if ((substream->stream == SNDRV_PCM_STREAM_CAPTURE) ||
658 			!card->can_dma)
659 			hpi_handle_error(hpi_stream_start(dpcm->h_stream));
660 		break;
661 
662 	case SNDRV_PCM_TRIGGER_STOP:
663 		snd_printdd("%s trigger stop\n", name);
664 		card->pcm_stop(substream);
665 		snd_pcm_group_for_each_entry(s, substream) {
666 			if (snd_pcm_substream_chip(s) != card)
667 				continue;
668 			/* don't link Cap and Play */
669 			if (substream->stream != s->stream)
670 				continue;
671 
672 			/*? workaround linked streams don't
673 			transition to SETUP 20070706*/
674 			s->runtime->status->state = SNDRV_PCM_STATE_SETUP;
675 
676 			if (card->support_grouping) {
677 				snd_printdd("%d group\n", s->number);
678 				snd_pcm_trigger_done(s, substream);
679 			} else
680 				break;
681 		}
682 
683 		/* _prepare and _hwparams reset the stream */
684 		hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
685 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
686 			hpi_handle_error(
687 				hpi_outstream_reset(dpcm->h_stream));
688 
689 		if (card->support_grouping)
690 			hpi_handle_error(hpi_stream_group_reset(dpcm->h_stream));
691 		break;
692 
693 	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
694 		snd_printdd("%s trigger pause release\n", name);
695 		card->pcm_start(substream);
696 		hpi_handle_error(hpi_stream_start(dpcm->h_stream));
697 		break;
698 	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
699 		snd_printdd("%s trigger pause push\n", name);
700 		card->pcm_stop(substream);
701 		hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
702 		break;
703 	default:
704 		snd_printd(KERN_ERR "\tINVALID\n");
705 		return -EINVAL;
706 	}
707 
708 	return 0;
709 }
710 
711 /*algorithm outline
712  Without linking degenerates to getting single stream pos etc
713  Without mmap 2nd loop degenerates to snd_pcm_period_elapsed
714 */
715 /*
716 pcm_buf_dma_ofs=get_buf_pos(s);
717 for_each_linked_stream(s) {
718 	pcm_buf_dma_ofs=get_buf_pos(s);
719 	min_buf_pos = modulo_min(min_buf_pos, pcm_buf_dma_ofs, buffer_bytes)
720 	new_data = min(new_data, calc_new_data(pcm_buf_dma_ofs,irq_pos)
721 }
722 timer.expires = jiffies + predict_next_period_ready(min_buf_pos);
723 for_each_linked_stream(s) {
724 	s->pcm_buf_dma_ofs = min_buf_pos;
725 	if (new_data > period_bytes) {
726 		if (mmap) {
727 			irq_pos = (irq_pos + period_bytes) % buffer_bytes;
728 			if (playback) {
729 				write(period_bytes);
730 			} else {
731 				read(period_bytes);
732 			}
733 		}
734 		snd_pcm_period_elapsed(s);
735 	}
736 }
737 */
738 
739 /** Minimum of 2 modulo values.  Works correctly when the difference between
740 * the values is less than half the modulus
741 */
742 static inline unsigned int modulo_min(unsigned int a, unsigned int b,
743 					unsigned long int modulus)
744 {
745 	unsigned int result;
746 	if (((a-b) % modulus) < (modulus/2))
747 		result = b;
748 	else
749 		result = a;
750 
751 	return result;
752 }
753 
754 /** Timer function, equivalent to interrupt service routine for cards
755 */
756 static void snd_card_asihpi_timer_function(unsigned long data)
757 {
758 	struct snd_card_asihpi_pcm *dpcm = (struct snd_card_asihpi_pcm *)data;
759 	struct snd_pcm_substream *substream = dpcm->substream;
760 	struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
761 	struct snd_pcm_runtime *runtime;
762 	struct snd_pcm_substream *s;
763 	unsigned int newdata = 0;
764 	unsigned int pcm_buf_dma_ofs, min_buf_pos = 0;
765 	unsigned int remdata, xfercount, next_jiffies;
766 	int first = 1;
767 	int loops = 0;
768 	u16 state;
769 	u32 buffer_size, bytes_avail, samples_played, on_card_bytes;
770 	char name[16];
771 
772 
773 	snd_pcm_debug_name(substream, name, sizeof(name));
774 
775 	/* find minimum newdata and buffer pos in group */
776 	snd_pcm_group_for_each_entry(s, substream) {
777 		struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
778 		runtime = s->runtime;
779 
780 		if (snd_pcm_substream_chip(s) != card)
781 			continue;
782 
783 		/* don't link Cap and Play */
784 		if (substream->stream != s->stream)
785 			continue;
786 
787 		hpi_handle_error(hpi_stream_get_info_ex(
788 					ds->h_stream, &state,
789 					&buffer_size, &bytes_avail,
790 					&samples_played, &on_card_bytes));
791 
792 		/* number of bytes in on-card buffer */
793 		runtime->delay = on_card_bytes;
794 
795 		if (!card->can_dma)
796 			on_card_bytes = bytes_avail;
797 
798 		if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
799 			pcm_buf_dma_ofs = ds->pcm_buf_host_rw_ofs - bytes_avail;
800 			if (state == HPI_STATE_STOPPED) {
801 				if (bytes_avail == 0) {
802 					hpi_handle_error(hpi_stream_start(ds->h_stream));
803 					snd_printdd("P%d start\n", s->number);
804 					ds->drained_count = 0;
805 				}
806 			} else if (state == HPI_STATE_DRAINED) {
807 				snd_printd(KERN_WARNING "P%d drained\n",
808 						s->number);
809 				ds->drained_count++;
810 				if (ds->drained_count > 20) {
811 					snd_pcm_stop_xrun(s);
812 					continue;
813 				}
814 			} else {
815 				ds->drained_count = 0;
816 			}
817 		} else
818 			pcm_buf_dma_ofs = bytes_avail + ds->pcm_buf_host_rw_ofs;
819 
820 		if (first) {
821 			/* can't statically init min when wrap is involved */
822 			min_buf_pos = pcm_buf_dma_ofs;
823 			newdata = (pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes;
824 			first = 0;
825 		} else {
826 			min_buf_pos =
827 				modulo_min(min_buf_pos, pcm_buf_dma_ofs, UINT_MAX+1L);
828 			newdata = min(
829 				(pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes,
830 				newdata);
831 		}
832 
833 		snd_printddd(
834 			"timer1, %s, %d, S=%d, elap=%d, rw=%d, dsp=%d, left=%d, aux=%d, space=%d, hw_ptr=%ld, appl_ptr=%ld\n",
835 			name, s->number, state,
836 			ds->pcm_buf_elapsed_dma_ofs,
837 			ds->pcm_buf_host_rw_ofs,
838 			pcm_buf_dma_ofs,
839 			(int)bytes_avail,
840 
841 			(int)on_card_bytes,
842 			buffer_size-bytes_avail,
843 			(unsigned long)frames_to_bytes(runtime,
844 						runtime->status->hw_ptr),
845 			(unsigned long)frames_to_bytes(runtime,
846 						runtime->control->appl_ptr)
847 		);
848 		loops++;
849 	}
850 	pcm_buf_dma_ofs = min_buf_pos;
851 
852 	remdata = newdata % dpcm->period_bytes;
853 	xfercount = newdata - remdata; /* a multiple of period_bytes */
854 	/* come back when on_card_bytes has decreased enough to allow
855 	   write to happen, or when data has been consumed to make another
856 	   period
857 	*/
858 	if (xfercount && (on_card_bytes  > dpcm->period_bytes))
859 		next_jiffies = ((on_card_bytes - dpcm->period_bytes) * HZ / dpcm->bytes_per_sec);
860 	else
861 		next_jiffies = ((dpcm->period_bytes - remdata) * HZ / dpcm->bytes_per_sec);
862 
863 	next_jiffies = max(next_jiffies, 1U);
864 	dpcm->timer.expires = jiffies + next_jiffies;
865 	snd_printddd("timer2, jif=%d, buf_pos=%d, newdata=%d, xfer=%d\n",
866 			next_jiffies, pcm_buf_dma_ofs, newdata, xfercount);
867 
868 	snd_pcm_group_for_each_entry(s, substream) {
869 		struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
870 		runtime = s->runtime;
871 
872 		/* don't link Cap and Play */
873 		if (substream->stream != s->stream)
874 			continue;
875 
876 		/* Store dma offset for use by pointer callback */
877 		ds->pcm_buf_dma_ofs = pcm_buf_dma_ofs;
878 
879 		if (xfercount &&
880 			/* Limit use of on card fifo for playback */
881 			((on_card_bytes <= ds->period_bytes) ||
882 			(s->stream == SNDRV_PCM_STREAM_CAPTURE)))
883 
884 		{
885 
886 			unsigned int buf_ofs = ds->pcm_buf_host_rw_ofs % ds->buffer_bytes;
887 			unsigned int xfer1, xfer2;
888 			char *pd = &s->runtime->dma_area[buf_ofs];
889 
890 			if (card->can_dma) { /* buffer wrap is handled at lower level */
891 				xfer1 = xfercount;
892 				xfer2 = 0;
893 			} else {
894 				xfer1 = min(xfercount, ds->buffer_bytes - buf_ofs);
895 				xfer2 = xfercount - xfer1;
896 			}
897 
898 			if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
899 				snd_printddd("write1, P=%d, xfer=%d, buf_ofs=%d\n",
900 					s->number, xfer1, buf_ofs);
901 				hpi_handle_error(
902 					hpi_outstream_write_buf(
903 						ds->h_stream, pd, xfer1,
904 						&ds->format));
905 
906 				if (xfer2) {
907 					pd = s->runtime->dma_area;
908 
909 					snd_printddd("write2, P=%d, xfer=%d, buf_ofs=%d\n",
910 							s->number,
911 							xfercount - xfer1, buf_ofs);
912 					hpi_handle_error(
913 						hpi_outstream_write_buf(
914 							ds->h_stream, pd,
915 							xfercount - xfer1,
916 							&ds->format));
917 				}
918 			} else {
919 				snd_printddd("read1, C=%d, xfer=%d\n",
920 					s->number, xfer1);
921 				hpi_handle_error(
922 					hpi_instream_read_buf(
923 						ds->h_stream,
924 						pd, xfer1));
925 				if (xfer2) {
926 					pd = s->runtime->dma_area;
927 					snd_printddd("read2, C=%d, xfer=%d\n",
928 						s->number, xfer2);
929 					hpi_handle_error(
930 						hpi_instream_read_buf(
931 							ds->h_stream,
932 							pd, xfer2));
933 				}
934 			}
935 			/* ? host_rw_ofs always ahead of elapsed_dma_ofs by preload size? */
936 			ds->pcm_buf_host_rw_ofs += xfercount;
937 			ds->pcm_buf_elapsed_dma_ofs += xfercount;
938 			snd_pcm_period_elapsed(s);
939 		}
940 	}
941 
942 	if (!card->hpi->interrupt_mode && dpcm->respawn_timer)
943 		add_timer(&dpcm->timer);
944 }
945 
946 static void snd_card_asihpi_int_task(unsigned long data)
947 {
948 	struct hpi_adapter *a = (struct hpi_adapter *)data;
949 	struct snd_card_asihpi *asihpi;
950 
951 	WARN_ON(!a || !a->snd_card || !a->snd_card->private_data);
952 	asihpi = (struct snd_card_asihpi *)a->snd_card->private_data;
953 	if (asihpi->llmode_streampriv)
954 		snd_card_asihpi_timer_function(
955 			(unsigned long)asihpi->llmode_streampriv);
956 }
957 
958 static void snd_card_asihpi_isr(struct hpi_adapter *a)
959 {
960 	struct snd_card_asihpi *asihpi;
961 
962 	WARN_ON(!a || !a->snd_card || !a->snd_card->private_data);
963 	asihpi = (struct snd_card_asihpi *)a->snd_card->private_data;
964 	tasklet_schedule(&asihpi->t);
965 }
966 
967 /***************************** PLAYBACK OPS ****************/
968 static int snd_card_asihpi_playback_ioctl(struct snd_pcm_substream *substream,
969 					  unsigned int cmd, void *arg)
970 {
971 	char name[16];
972 	snd_pcm_debug_name(substream, name, sizeof(name));
973 	snd_printddd(KERN_INFO "%s ioctl %d\n", name, cmd);
974 	return snd_pcm_lib_ioctl(substream, cmd, arg);
975 }
976 
977 static int snd_card_asihpi_playback_prepare(struct snd_pcm_substream *
978 					    substream)
979 {
980 	struct snd_pcm_runtime *runtime = substream->runtime;
981 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
982 
983 	snd_printdd("P%d prepare\n", substream->number);
984 
985 	hpi_handle_error(hpi_outstream_reset(dpcm->h_stream));
986 	dpcm->pcm_buf_host_rw_ofs = 0;
987 	dpcm->pcm_buf_dma_ofs = 0;
988 	dpcm->pcm_buf_elapsed_dma_ofs = 0;
989 	return 0;
990 }
991 
992 static snd_pcm_uframes_t
993 snd_card_asihpi_playback_pointer(struct snd_pcm_substream *substream)
994 {
995 	struct snd_pcm_runtime *runtime = substream->runtime;
996 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
997 	snd_pcm_uframes_t ptr;
998 	char name[16];
999 	snd_pcm_debug_name(substream, name, sizeof(name));
1000 
1001 	ptr = bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs  % dpcm->buffer_bytes);
1002 	snd_printddd("%s, pointer=%ld\n", name, (unsigned long)ptr);
1003 	return ptr;
1004 }
1005 
1006 static u64 snd_card_asihpi_playback_formats(struct snd_card_asihpi *asihpi,
1007 						u32 h_stream)
1008 {
1009 	struct hpi_format hpi_format;
1010 	u16 format;
1011 	u16 err;
1012 	u32 h_control;
1013 	u32 sample_rate = 48000;
1014 	u64 formats = 0;
1015 
1016 	/* on cards without SRC, must query at valid rate,
1017 	* maybe set by external sync
1018 	*/
1019 	err = hpi_mixer_get_control(asihpi->h_mixer,
1020 				  HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
1021 				  HPI_CONTROL_SAMPLECLOCK, &h_control);
1022 
1023 	if (!err)
1024 		err = hpi_sample_clock_get_sample_rate(h_control,
1025 				&sample_rate);
1026 
1027 	for (format = HPI_FORMAT_PCM8_UNSIGNED;
1028 	     format <= HPI_FORMAT_PCM24_SIGNED; format++) {
1029 		err = hpi_format_create(&hpi_format, asihpi->out_max_chans,
1030 					format, sample_rate, 128000, 0);
1031 		if (!err)
1032 			err = hpi_outstream_query_format(h_stream, &hpi_format);
1033 		if (!err && (hpi_to_alsa_formats[format] != -1))
1034 			formats |= pcm_format_to_bits(hpi_to_alsa_formats[format]);
1035 	}
1036 	return formats;
1037 }
1038 
1039 static int snd_card_asihpi_playback_open(struct snd_pcm_substream *substream)
1040 {
1041 	struct snd_pcm_runtime *runtime = substream->runtime;
1042 	struct snd_card_asihpi_pcm *dpcm;
1043 	struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
1044 	struct snd_pcm_hardware snd_card_asihpi_playback;
1045 	int err;
1046 
1047 	dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
1048 	if (dpcm == NULL)
1049 		return -ENOMEM;
1050 
1051 	err = hpi_outstream_open(card->hpi->adapter->index,
1052 			      substream->number, &dpcm->h_stream);
1053 	hpi_handle_error(err);
1054 	if (err)
1055 		kfree(dpcm);
1056 	if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
1057 		return -EBUSY;
1058 	if (err)
1059 		return -EIO;
1060 
1061 	/*? also check ASI5000 samplerate source
1062 	    If external, only support external rate.
1063 	    If internal and other stream playing, can't switch
1064 	*/
1065 
1066 	setup_timer(&dpcm->timer, snd_card_asihpi_timer_function,
1067 		    (unsigned long) dpcm);
1068 	dpcm->substream = substream;
1069 	runtime->private_data = dpcm;
1070 	runtime->private_free = snd_card_asihpi_runtime_free;
1071 
1072 	memset(&snd_card_asihpi_playback, 0, sizeof(snd_card_asihpi_playback));
1073 	if (!card->hpi->interrupt_mode) {
1074 		snd_card_asihpi_playback.buffer_bytes_max = BUFFER_BYTES_MAX;
1075 		snd_card_asihpi_playback.period_bytes_min = PERIOD_BYTES_MIN;
1076 		snd_card_asihpi_playback.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1077 		snd_card_asihpi_playback.periods_min = PERIODS_MIN;
1078 		snd_card_asihpi_playback.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
1079 	} else {
1080 		size_t pbmin = card->update_interval_frames *
1081 			card->out_max_chans;
1082 		snd_card_asihpi_playback.buffer_bytes_max = BUFFER_BYTES_MAX;
1083 		snd_card_asihpi_playback.period_bytes_min = pbmin;
1084 		snd_card_asihpi_playback.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1085 		snd_card_asihpi_playback.periods_min = PERIODS_MIN;
1086 		snd_card_asihpi_playback.periods_max = BUFFER_BYTES_MAX / pbmin;
1087 	}
1088 
1089 	/* snd_card_asihpi_playback.fifo_size = 0; */
1090 	snd_card_asihpi_playback.channels_max = card->out_max_chans;
1091 	snd_card_asihpi_playback.channels_min = card->out_min_chans;
1092 	snd_card_asihpi_playback.formats =
1093 			snd_card_asihpi_playback_formats(card, dpcm->h_stream);
1094 
1095 	snd_card_asihpi_pcm_samplerates(card,  &snd_card_asihpi_playback);
1096 
1097 	snd_card_asihpi_playback.info = SNDRV_PCM_INFO_INTERLEAVED |
1098 					SNDRV_PCM_INFO_DOUBLE |
1099 					SNDRV_PCM_INFO_BATCH |
1100 					SNDRV_PCM_INFO_BLOCK_TRANSFER |
1101 					SNDRV_PCM_INFO_PAUSE |
1102 					SNDRV_PCM_INFO_MMAP |
1103 					SNDRV_PCM_INFO_MMAP_VALID;
1104 
1105 	if (card->support_grouping) {
1106 		snd_card_asihpi_playback.info |= SNDRV_PCM_INFO_SYNC_START;
1107 		snd_pcm_set_sync(substream);
1108 	}
1109 
1110 	/* struct is copied, so can create initializer dynamically */
1111 	runtime->hw = snd_card_asihpi_playback;
1112 
1113 	if (card->can_dma)
1114 		err = snd_pcm_hw_constraint_pow2(runtime, 0,
1115 					SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1116 	if (err < 0)
1117 		return err;
1118 
1119 	snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1120 		card->update_interval_frames);
1121 
1122 	snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1123 		card->update_interval_frames, UINT_MAX);
1124 
1125 	snd_printdd("playback open\n");
1126 
1127 	return 0;
1128 }
1129 
1130 static int snd_card_asihpi_playback_close(struct snd_pcm_substream *substream)
1131 {
1132 	struct snd_pcm_runtime *runtime = substream->runtime;
1133 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1134 
1135 	hpi_handle_error(hpi_outstream_close(dpcm->h_stream));
1136 	snd_printdd("playback close\n");
1137 
1138 	return 0;
1139 }
1140 
1141 static const struct snd_pcm_ops snd_card_asihpi_playback_mmap_ops = {
1142 	.open = snd_card_asihpi_playback_open,
1143 	.close = snd_card_asihpi_playback_close,
1144 	.ioctl = snd_card_asihpi_playback_ioctl,
1145 	.hw_params = snd_card_asihpi_pcm_hw_params,
1146 	.hw_free = snd_card_asihpi_hw_free,
1147 	.prepare = snd_card_asihpi_playback_prepare,
1148 	.trigger = snd_card_asihpi_trigger,
1149 	.pointer = snd_card_asihpi_playback_pointer,
1150 };
1151 
1152 /***************************** CAPTURE OPS ****************/
1153 static snd_pcm_uframes_t
1154 snd_card_asihpi_capture_pointer(struct snd_pcm_substream *substream)
1155 {
1156 	struct snd_pcm_runtime *runtime = substream->runtime;
1157 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1158 	char name[16];
1159 	snd_pcm_debug_name(substream, name, sizeof(name));
1160 
1161 	snd_printddd("%s, pointer=%d\n", name, dpcm->pcm_buf_dma_ofs);
1162 	/* NOTE Unlike playback can't use actual samples_played
1163 		for the capture position, because those samples aren't yet in
1164 		the local buffer available for reading.
1165 	*/
1166 	return bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs % dpcm->buffer_bytes);
1167 }
1168 
1169 static int snd_card_asihpi_capture_ioctl(struct snd_pcm_substream *substream,
1170 					 unsigned int cmd, void *arg)
1171 {
1172 	return snd_pcm_lib_ioctl(substream, cmd, arg);
1173 }
1174 
1175 static int snd_card_asihpi_capture_prepare(struct snd_pcm_substream *substream)
1176 {
1177 	struct snd_pcm_runtime *runtime = substream->runtime;
1178 	struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1179 
1180 	hpi_handle_error(hpi_instream_reset(dpcm->h_stream));
1181 	dpcm->pcm_buf_host_rw_ofs = 0;
1182 	dpcm->pcm_buf_dma_ofs = 0;
1183 	dpcm->pcm_buf_elapsed_dma_ofs = 0;
1184 
1185 	snd_printdd("Capture Prepare %d\n", substream->number);
1186 	return 0;
1187 }
1188 
1189 static u64 snd_card_asihpi_capture_formats(struct snd_card_asihpi *asihpi,
1190 					u32 h_stream)
1191 {
1192   struct hpi_format hpi_format;
1193 	u16 format;
1194 	u16 err;
1195 	u32 h_control;
1196 	u32 sample_rate = 48000;
1197 	u64 formats = 0;
1198 
1199 	/* on cards without SRC, must query at valid rate,
1200 		maybe set by external sync */
1201 	err = hpi_mixer_get_control(asihpi->h_mixer,
1202 				  HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
1203 				  HPI_CONTROL_SAMPLECLOCK, &h_control);
1204 
1205 	if (!err)
1206 		err = hpi_sample_clock_get_sample_rate(h_control,
1207 			&sample_rate);
1208 
1209 	for (format = HPI_FORMAT_PCM8_UNSIGNED;
1210 		format <= HPI_FORMAT_PCM24_SIGNED; format++) {
1211 
1212 		err = hpi_format_create(&hpi_format, asihpi->in_max_chans,
1213 					format, sample_rate, 128000, 0);
1214 		if (!err)
1215 			err = hpi_instream_query_format(h_stream, &hpi_format);
1216 		if (!err && (hpi_to_alsa_formats[format] != -1))
1217 			formats |= pcm_format_to_bits(hpi_to_alsa_formats[format]);
1218 	}
1219 	return formats;
1220 }
1221 
1222 static int snd_card_asihpi_capture_open(struct snd_pcm_substream *substream)
1223 {
1224 	struct snd_pcm_runtime *runtime = substream->runtime;
1225 	struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
1226 	struct snd_card_asihpi_pcm *dpcm;
1227 	struct snd_pcm_hardware snd_card_asihpi_capture;
1228 	int err;
1229 
1230 	dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
1231 	if (dpcm == NULL)
1232 		return -ENOMEM;
1233 
1234 	snd_printdd("capture open adapter %d stream %d\n",
1235 			card->hpi->adapter->index, substream->number);
1236 
1237 	err = hpi_handle_error(
1238 	    hpi_instream_open(card->hpi->adapter->index,
1239 			     substream->number, &dpcm->h_stream));
1240 	if (err)
1241 		kfree(dpcm);
1242 	if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
1243 		return -EBUSY;
1244 	if (err)
1245 		return -EIO;
1246 
1247 	setup_timer(&dpcm->timer, snd_card_asihpi_timer_function,
1248 		    (unsigned long) dpcm);
1249 	dpcm->substream = substream;
1250 	runtime->private_data = dpcm;
1251 	runtime->private_free = snd_card_asihpi_runtime_free;
1252 
1253 	memset(&snd_card_asihpi_capture, 0, sizeof(snd_card_asihpi_capture));
1254 	if (!card->hpi->interrupt_mode) {
1255 		snd_card_asihpi_capture.buffer_bytes_max = BUFFER_BYTES_MAX;
1256 		snd_card_asihpi_capture.period_bytes_min = PERIOD_BYTES_MIN;
1257 		snd_card_asihpi_capture.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1258 		snd_card_asihpi_capture.periods_min = PERIODS_MIN;
1259 		snd_card_asihpi_capture.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
1260 	} else {
1261 		size_t pbmin = card->update_interval_frames *
1262 			card->out_max_chans;
1263 		snd_card_asihpi_capture.buffer_bytes_max = BUFFER_BYTES_MAX;
1264 		snd_card_asihpi_capture.period_bytes_min = pbmin;
1265 		snd_card_asihpi_capture.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1266 		snd_card_asihpi_capture.periods_min = PERIODS_MIN;
1267 		snd_card_asihpi_capture.periods_max = BUFFER_BYTES_MAX / pbmin;
1268 	}
1269 	/* snd_card_asihpi_capture.fifo_size = 0; */
1270 	snd_card_asihpi_capture.channels_max = card->in_max_chans;
1271 	snd_card_asihpi_capture.channels_min = card->in_min_chans;
1272 	snd_card_asihpi_capture.formats =
1273 		snd_card_asihpi_capture_formats(card, dpcm->h_stream);
1274 	snd_card_asihpi_pcm_samplerates(card,  &snd_card_asihpi_capture);
1275 	snd_card_asihpi_capture.info = SNDRV_PCM_INFO_INTERLEAVED |
1276 					SNDRV_PCM_INFO_MMAP |
1277 					SNDRV_PCM_INFO_MMAP_VALID;
1278 
1279 	if (card->support_grouping)
1280 		snd_card_asihpi_capture.info |= SNDRV_PCM_INFO_SYNC_START;
1281 
1282 	runtime->hw = snd_card_asihpi_capture;
1283 
1284 	if (card->can_dma)
1285 		err = snd_pcm_hw_constraint_pow2(runtime, 0,
1286 					SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1287 	if (err < 0)
1288 		return err;
1289 
1290 	snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1291 		card->update_interval_frames);
1292 	snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1293 		card->update_interval_frames, UINT_MAX);
1294 
1295 	snd_pcm_set_sync(substream);
1296 
1297 	return 0;
1298 }
1299 
1300 static int snd_card_asihpi_capture_close(struct snd_pcm_substream *substream)
1301 {
1302 	struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
1303 
1304 	hpi_handle_error(hpi_instream_close(dpcm->h_stream));
1305 	return 0;
1306 }
1307 
1308 static const struct snd_pcm_ops snd_card_asihpi_capture_mmap_ops = {
1309 	.open = snd_card_asihpi_capture_open,
1310 	.close = snd_card_asihpi_capture_close,
1311 	.ioctl = snd_card_asihpi_capture_ioctl,
1312 	.hw_params = snd_card_asihpi_pcm_hw_params,
1313 	.hw_free = snd_card_asihpi_hw_free,
1314 	.prepare = snd_card_asihpi_capture_prepare,
1315 	.trigger = snd_card_asihpi_trigger,
1316 	.pointer = snd_card_asihpi_capture_pointer,
1317 };
1318 
1319 static int snd_card_asihpi_pcm_new(struct snd_card_asihpi *asihpi, int device)
1320 {
1321 	struct snd_pcm *pcm;
1322 	int err;
1323 	u16 num_instreams, num_outstreams, x16;
1324 	u32 x32;
1325 
1326 	err = hpi_adapter_get_info(asihpi->hpi->adapter->index,
1327 			&num_outstreams, &num_instreams,
1328 			&x16, &x32, &x16);
1329 
1330 	err = snd_pcm_new(asihpi->card, "Asihpi PCM", device,
1331 			num_outstreams,	num_instreams, &pcm);
1332 	if (err < 0)
1333 		return err;
1334 
1335 	/* pointer to ops struct is stored, dont change ops afterwards! */
1336 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
1337 			&snd_card_asihpi_playback_mmap_ops);
1338 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
1339 			&snd_card_asihpi_capture_mmap_ops);
1340 
1341 	pcm->private_data = asihpi;
1342 	pcm->info_flags = 0;
1343 	strcpy(pcm->name, "Asihpi PCM");
1344 
1345 	/*? do we want to emulate MMAP for non-BBM cards?
1346 	Jack doesn't work with ALSAs MMAP emulation - WHY NOT? */
1347 	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1348 						snd_dma_pci_data(asihpi->pci),
1349 						64*1024, BUFFER_BYTES_MAX);
1350 
1351 	return 0;
1352 }
1353 
1354 /***************************** MIXER CONTROLS ****************/
1355 struct hpi_control {
1356 	u32 h_control;
1357 	u16 control_type;
1358 	u16 src_node_type;
1359 	u16 src_node_index;
1360 	u16 dst_node_type;
1361 	u16 dst_node_index;
1362 	u16 band;
1363 	char name[SNDRV_CTL_ELEM_ID_NAME_MAXLEN]; /* copied to snd_ctl_elem_id.name[44]; */
1364 };
1365 
1366 static const char * const asihpi_tuner_band_names[] = {
1367 	"invalid",
1368 	"AM",
1369 	"FM mono",
1370 	"TV NTSC-M",
1371 	"FM stereo",
1372 	"AUX",
1373 	"TV PAL BG",
1374 	"TV PAL I",
1375 	"TV PAL DK",
1376 	"TV SECAM",
1377 	"TV DAB",
1378 };
1379 /* Number of strings must match the enumerations for HPI_TUNER_BAND in hpi.h */
1380 compile_time_assert(
1381 	(ARRAY_SIZE(asihpi_tuner_band_names) ==
1382 		(HPI_TUNER_BAND_LAST+1)),
1383 	assert_tuner_band_names_size);
1384 
1385 static const char * const asihpi_src_names[] = {
1386 	"no source",
1387 	"PCM",
1388 	"Line",
1389 	"Digital",
1390 	"Tuner",
1391 	"RF",
1392 	"Clock",
1393 	"Bitstream",
1394 	"Mic",
1395 	"Net",
1396 	"Analog",
1397 	"Adapter",
1398 	"RTP",
1399 	"Internal",
1400 	"AVB",
1401 	"BLU-Link"
1402 };
1403 /* Number of strings must match the enumerations for HPI_SOURCENODES in hpi.h */
1404 compile_time_assert(
1405 	(ARRAY_SIZE(asihpi_src_names) ==
1406 		(HPI_SOURCENODE_LAST_INDEX-HPI_SOURCENODE_NONE+1)),
1407 	assert_src_names_size);
1408 
1409 static const char * const asihpi_dst_names[] = {
1410 	"no destination",
1411 	"PCM",
1412 	"Line",
1413 	"Digital",
1414 	"RF",
1415 	"Speaker",
1416 	"Net",
1417 	"Analog",
1418 	"RTP",
1419 	"AVB",
1420 	"Internal",
1421 	"BLU-Link"
1422 };
1423 /* Number of strings must match the enumerations for HPI_DESTNODES in hpi.h */
1424 compile_time_assert(
1425 	(ARRAY_SIZE(asihpi_dst_names) ==
1426 		(HPI_DESTNODE_LAST_INDEX-HPI_DESTNODE_NONE+1)),
1427 	assert_dst_names_size);
1428 
1429 static inline int ctl_add(struct snd_card *card, struct snd_kcontrol_new *ctl,
1430 				struct snd_card_asihpi *asihpi)
1431 {
1432 	int err;
1433 
1434 	err = snd_ctl_add(card, snd_ctl_new1(ctl, asihpi));
1435 	if (err < 0)
1436 		return err;
1437 	else if (mixer_dump)
1438 		dev_info(&asihpi->pci->dev, "added %s(%d)\n", ctl->name, ctl->index);
1439 
1440 	return 0;
1441 }
1442 
1443 /* Convert HPI control name and location into ALSA control name */
1444 static void asihpi_ctl_init(struct snd_kcontrol_new *snd_control,
1445 				struct hpi_control *hpi_ctl,
1446 				char *name)
1447 {
1448 	char *dir;
1449 	memset(snd_control, 0, sizeof(*snd_control));
1450 	snd_control->name = hpi_ctl->name;
1451 	snd_control->private_value = hpi_ctl->h_control;
1452 	snd_control->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1453 	snd_control->index = 0;
1454 
1455 	if (hpi_ctl->src_node_type + HPI_SOURCENODE_NONE == HPI_SOURCENODE_CLOCK_SOURCE)
1456 		dir = ""; /* clock is neither capture nor playback */
1457 	else if (hpi_ctl->dst_node_type + HPI_DESTNODE_NONE == HPI_DESTNODE_ISTREAM)
1458 		dir = "Capture ";  /* On or towards a PCM capture destination*/
1459 	else if ((hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
1460 		(!hpi_ctl->dst_node_type))
1461 		dir = "Capture "; /* On a source node that is not PCM playback */
1462 	else if (hpi_ctl->src_node_type &&
1463 		(hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
1464 		(hpi_ctl->dst_node_type))
1465 		dir = "Monitor Playback "; /* Between an input and an output */
1466 	else
1467 		dir = "Playback "; /* PCM Playback source, or  output node */
1468 
1469 	if (hpi_ctl->src_node_type && hpi_ctl->dst_node_type)
1470 		sprintf(hpi_ctl->name, "%s %d %s %d %s%s",
1471 			asihpi_src_names[hpi_ctl->src_node_type],
1472 			hpi_ctl->src_node_index,
1473 			asihpi_dst_names[hpi_ctl->dst_node_type],
1474 			hpi_ctl->dst_node_index,
1475 			dir, name);
1476 	else if (hpi_ctl->dst_node_type) {
1477 		sprintf(hpi_ctl->name, "%s %d %s%s",
1478 		asihpi_dst_names[hpi_ctl->dst_node_type],
1479 		hpi_ctl->dst_node_index,
1480 		dir, name);
1481 	} else {
1482 		sprintf(hpi_ctl->name, "%s %d %s%s",
1483 		asihpi_src_names[hpi_ctl->src_node_type],
1484 		hpi_ctl->src_node_index,
1485 		dir, name);
1486 	}
1487 	/* printk(KERN_INFO "Adding %s %d to %d ",  hpi_ctl->name,
1488 		hpi_ctl->wSrcNodeType, hpi_ctl->wDstNodeType); */
1489 }
1490 
1491 /*------------------------------------------------------------
1492    Volume controls
1493  ------------------------------------------------------------*/
1494 #define VOL_STEP_mB 1
1495 static int snd_asihpi_volume_info(struct snd_kcontrol *kcontrol,
1496 				  struct snd_ctl_elem_info *uinfo)
1497 {
1498 	u32 h_control = kcontrol->private_value;
1499 	u32 count;
1500 	u16 err;
1501 	/* native gains are in millibels */
1502 	short min_gain_mB;
1503 	short max_gain_mB;
1504 	short step_gain_mB;
1505 
1506 	err = hpi_volume_query_range(h_control,
1507 			&min_gain_mB, &max_gain_mB, &step_gain_mB);
1508 	if (err) {
1509 		max_gain_mB = 0;
1510 		min_gain_mB = -10000;
1511 		step_gain_mB = VOL_STEP_mB;
1512 	}
1513 
1514 	err = hpi_meter_query_channels(h_control, &count);
1515 	if (err)
1516 		count = HPI_MAX_CHANNELS;
1517 
1518 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1519 	uinfo->count = count;
1520 	uinfo->value.integer.min = min_gain_mB / VOL_STEP_mB;
1521 	uinfo->value.integer.max = max_gain_mB / VOL_STEP_mB;
1522 	uinfo->value.integer.step = step_gain_mB / VOL_STEP_mB;
1523 	return 0;
1524 }
1525 
1526 static int snd_asihpi_volume_get(struct snd_kcontrol *kcontrol,
1527 				 struct snd_ctl_elem_value *ucontrol)
1528 {
1529 	u32 h_control = kcontrol->private_value;
1530 	short an_gain_mB[HPI_MAX_CHANNELS];
1531 
1532 	hpi_handle_error(hpi_volume_get_gain(h_control, an_gain_mB));
1533 	ucontrol->value.integer.value[0] = an_gain_mB[0] / VOL_STEP_mB;
1534 	ucontrol->value.integer.value[1] = an_gain_mB[1] / VOL_STEP_mB;
1535 
1536 	return 0;
1537 }
1538 
1539 static int snd_asihpi_volume_put(struct snd_kcontrol *kcontrol,
1540 				 struct snd_ctl_elem_value *ucontrol)
1541 {
1542 	int change;
1543 	u32 h_control = kcontrol->private_value;
1544 	short an_gain_mB[HPI_MAX_CHANNELS];
1545 
1546 	an_gain_mB[0] =
1547 	    (ucontrol->value.integer.value[0]) * VOL_STEP_mB;
1548 	an_gain_mB[1] =
1549 	    (ucontrol->value.integer.value[1]) * VOL_STEP_mB;
1550 	/*  change = asihpi->mixer_volume[addr][0] != left ||
1551 	   asihpi->mixer_volume[addr][1] != right;
1552 	 */
1553 	change = 1;
1554 	hpi_handle_error(hpi_volume_set_gain(h_control, an_gain_mB));
1555 	return change;
1556 }
1557 
1558 static const DECLARE_TLV_DB_SCALE(db_scale_100, -10000, VOL_STEP_mB, 0);
1559 
1560 #define snd_asihpi_volume_mute_info	snd_ctl_boolean_mono_info
1561 
1562 static int snd_asihpi_volume_mute_get(struct snd_kcontrol *kcontrol,
1563 				 struct snd_ctl_elem_value *ucontrol)
1564 {
1565 	u32 h_control = kcontrol->private_value;
1566 	u32 mute;
1567 
1568 	hpi_handle_error(hpi_volume_get_mute(h_control, &mute));
1569 	ucontrol->value.integer.value[0] = mute ? 0 : 1;
1570 
1571 	return 0;
1572 }
1573 
1574 static int snd_asihpi_volume_mute_put(struct snd_kcontrol *kcontrol,
1575 				 struct snd_ctl_elem_value *ucontrol)
1576 {
1577 	u32 h_control = kcontrol->private_value;
1578 	int change = 1;
1579 	/* HPI currently only supports all or none muting of multichannel volume
1580 	ALSA Switch element has opposite sense to HPI mute: on==unmuted, off=muted
1581 	*/
1582 	int mute =  ucontrol->value.integer.value[0] ? 0 : HPI_BITMASK_ALL_CHANNELS;
1583 	hpi_handle_error(hpi_volume_set_mute(h_control, mute));
1584 	return change;
1585 }
1586 
1587 static int snd_asihpi_volume_add(struct snd_card_asihpi *asihpi,
1588 				 struct hpi_control *hpi_ctl)
1589 {
1590 	struct snd_card *card = asihpi->card;
1591 	struct snd_kcontrol_new snd_control;
1592 	int err;
1593 	u32 mute;
1594 
1595 	asihpi_ctl_init(&snd_control, hpi_ctl, "Volume");
1596 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
1597 				SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1598 	snd_control.info = snd_asihpi_volume_info;
1599 	snd_control.get = snd_asihpi_volume_get;
1600 	snd_control.put = snd_asihpi_volume_put;
1601 	snd_control.tlv.p = db_scale_100;
1602 
1603 	err = ctl_add(card, &snd_control, asihpi);
1604 	if (err)
1605 		return err;
1606 
1607 	if (hpi_volume_get_mute(hpi_ctl->h_control, &mute) == 0) {
1608 		asihpi_ctl_init(&snd_control, hpi_ctl, "Switch");
1609 		snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1610 		snd_control.info = snd_asihpi_volume_mute_info;
1611 		snd_control.get = snd_asihpi_volume_mute_get;
1612 		snd_control.put = snd_asihpi_volume_mute_put;
1613 		err = ctl_add(card, &snd_control, asihpi);
1614 	}
1615 	return err;
1616 }
1617 
1618 /*------------------------------------------------------------
1619    Level controls
1620  ------------------------------------------------------------*/
1621 static int snd_asihpi_level_info(struct snd_kcontrol *kcontrol,
1622 				 struct snd_ctl_elem_info *uinfo)
1623 {
1624 	u32 h_control = kcontrol->private_value;
1625 	u16 err;
1626 	short min_gain_mB;
1627 	short max_gain_mB;
1628 	short step_gain_mB;
1629 
1630 	err =
1631 	    hpi_level_query_range(h_control, &min_gain_mB,
1632 			       &max_gain_mB, &step_gain_mB);
1633 	if (err) {
1634 		max_gain_mB = 2400;
1635 		min_gain_mB = -1000;
1636 		step_gain_mB = 100;
1637 	}
1638 
1639 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1640 	uinfo->count = 2;
1641 	uinfo->value.integer.min = min_gain_mB / HPI_UNITS_PER_dB;
1642 	uinfo->value.integer.max = max_gain_mB / HPI_UNITS_PER_dB;
1643 	uinfo->value.integer.step = step_gain_mB / HPI_UNITS_PER_dB;
1644 	return 0;
1645 }
1646 
1647 static int snd_asihpi_level_get(struct snd_kcontrol *kcontrol,
1648 				struct snd_ctl_elem_value *ucontrol)
1649 {
1650 	u32 h_control = kcontrol->private_value;
1651 	short an_gain_mB[HPI_MAX_CHANNELS];
1652 
1653 	hpi_handle_error(hpi_level_get_gain(h_control, an_gain_mB));
1654 	ucontrol->value.integer.value[0] =
1655 	    an_gain_mB[0] / HPI_UNITS_PER_dB;
1656 	ucontrol->value.integer.value[1] =
1657 	    an_gain_mB[1] / HPI_UNITS_PER_dB;
1658 
1659 	return 0;
1660 }
1661 
1662 static int snd_asihpi_level_put(struct snd_kcontrol *kcontrol,
1663 				struct snd_ctl_elem_value *ucontrol)
1664 {
1665 	int change;
1666 	u32 h_control = kcontrol->private_value;
1667 	short an_gain_mB[HPI_MAX_CHANNELS];
1668 
1669 	an_gain_mB[0] =
1670 	    (ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
1671 	an_gain_mB[1] =
1672 	    (ucontrol->value.integer.value[1]) * HPI_UNITS_PER_dB;
1673 	/*  change = asihpi->mixer_level[addr][0] != left ||
1674 	   asihpi->mixer_level[addr][1] != right;
1675 	 */
1676 	change = 1;
1677 	hpi_handle_error(hpi_level_set_gain(h_control, an_gain_mB));
1678 	return change;
1679 }
1680 
1681 static const DECLARE_TLV_DB_SCALE(db_scale_level, -1000, 100, 0);
1682 
1683 static int snd_asihpi_level_add(struct snd_card_asihpi *asihpi,
1684 				struct hpi_control *hpi_ctl)
1685 {
1686 	struct snd_card *card = asihpi->card;
1687 	struct snd_kcontrol_new snd_control;
1688 
1689 	/* can't use 'volume' cos some nodes have volume as well */
1690 	asihpi_ctl_init(&snd_control, hpi_ctl, "Level");
1691 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
1692 				SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1693 	snd_control.info = snd_asihpi_level_info;
1694 	snd_control.get = snd_asihpi_level_get;
1695 	snd_control.put = snd_asihpi_level_put;
1696 	snd_control.tlv.p = db_scale_level;
1697 
1698 	return ctl_add(card, &snd_control, asihpi);
1699 }
1700 
1701 /*------------------------------------------------------------
1702    AESEBU controls
1703  ------------------------------------------------------------*/
1704 
1705 /* AESEBU format */
1706 static const char * const asihpi_aesebu_format_names[] = {
1707 	"N/A", "S/PDIF", "AES/EBU" };
1708 
1709 static int snd_asihpi_aesebu_format_info(struct snd_kcontrol *kcontrol,
1710 				  struct snd_ctl_elem_info *uinfo)
1711 {
1712 	return snd_ctl_enum_info(uinfo, 1, 3, asihpi_aesebu_format_names);
1713 }
1714 
1715 static int snd_asihpi_aesebu_format_get(struct snd_kcontrol *kcontrol,
1716 			struct snd_ctl_elem_value *ucontrol,
1717 			u16 (*func)(u32, u16 *))
1718 {
1719 	u32 h_control = kcontrol->private_value;
1720 	u16 source, err;
1721 
1722 	err = func(h_control, &source);
1723 
1724 	/* default to N/A */
1725 	ucontrol->value.enumerated.item[0] = 0;
1726 	/* return success but set the control to N/A */
1727 	if (err)
1728 		return 0;
1729 	if (source == HPI_AESEBU_FORMAT_SPDIF)
1730 		ucontrol->value.enumerated.item[0] = 1;
1731 	if (source == HPI_AESEBU_FORMAT_AESEBU)
1732 		ucontrol->value.enumerated.item[0] = 2;
1733 
1734 	return 0;
1735 }
1736 
1737 static int snd_asihpi_aesebu_format_put(struct snd_kcontrol *kcontrol,
1738 			struct snd_ctl_elem_value *ucontrol,
1739 			 u16 (*func)(u32, u16))
1740 {
1741 	u32 h_control = kcontrol->private_value;
1742 
1743 	/* default to S/PDIF */
1744 	u16 source = HPI_AESEBU_FORMAT_SPDIF;
1745 
1746 	if (ucontrol->value.enumerated.item[0] == 1)
1747 		source = HPI_AESEBU_FORMAT_SPDIF;
1748 	if (ucontrol->value.enumerated.item[0] == 2)
1749 		source = HPI_AESEBU_FORMAT_AESEBU;
1750 
1751 	if (func(h_control, source) != 0)
1752 		return -EINVAL;
1753 
1754 	return 1;
1755 }
1756 
1757 static int snd_asihpi_aesebu_rx_format_get(struct snd_kcontrol *kcontrol,
1758 				 struct snd_ctl_elem_value *ucontrol) {
1759 	return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
1760 					hpi_aesebu_receiver_get_format);
1761 }
1762 
1763 static int snd_asihpi_aesebu_rx_format_put(struct snd_kcontrol *kcontrol,
1764 				 struct snd_ctl_elem_value *ucontrol) {
1765 	return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
1766 					hpi_aesebu_receiver_set_format);
1767 }
1768 
1769 static int snd_asihpi_aesebu_rxstatus_info(struct snd_kcontrol *kcontrol,
1770 				  struct snd_ctl_elem_info *uinfo)
1771 {
1772 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1773 	uinfo->count = 1;
1774 
1775 	uinfo->value.integer.min = 0;
1776 	uinfo->value.integer.max = 0X1F;
1777 	uinfo->value.integer.step = 1;
1778 
1779 	return 0;
1780 }
1781 
1782 static int snd_asihpi_aesebu_rxstatus_get(struct snd_kcontrol *kcontrol,
1783 				 struct snd_ctl_elem_value *ucontrol) {
1784 
1785 	u32 h_control = kcontrol->private_value;
1786 	u16 status;
1787 
1788 	hpi_handle_error(hpi_aesebu_receiver_get_error_status(
1789 					 h_control, &status));
1790 	ucontrol->value.integer.value[0] = status;
1791 	return 0;
1792 }
1793 
1794 static int snd_asihpi_aesebu_rx_add(struct snd_card_asihpi *asihpi,
1795 				    struct hpi_control *hpi_ctl)
1796 {
1797 	struct snd_card *card = asihpi->card;
1798 	struct snd_kcontrol_new snd_control;
1799 
1800 	asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
1801 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1802 	snd_control.info = snd_asihpi_aesebu_format_info;
1803 	snd_control.get = snd_asihpi_aesebu_rx_format_get;
1804 	snd_control.put = snd_asihpi_aesebu_rx_format_put;
1805 
1806 
1807 	if (ctl_add(card, &snd_control, asihpi) < 0)
1808 		return -EINVAL;
1809 
1810 	asihpi_ctl_init(&snd_control, hpi_ctl, "Status");
1811 	snd_control.access =
1812 	    SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
1813 	snd_control.info = snd_asihpi_aesebu_rxstatus_info;
1814 	snd_control.get = snd_asihpi_aesebu_rxstatus_get;
1815 
1816 	return ctl_add(card, &snd_control, asihpi);
1817 }
1818 
1819 static int snd_asihpi_aesebu_tx_format_get(struct snd_kcontrol *kcontrol,
1820 				 struct snd_ctl_elem_value *ucontrol) {
1821 	return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
1822 					hpi_aesebu_transmitter_get_format);
1823 }
1824 
1825 static int snd_asihpi_aesebu_tx_format_put(struct snd_kcontrol *kcontrol,
1826 				 struct snd_ctl_elem_value *ucontrol) {
1827 	return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
1828 					hpi_aesebu_transmitter_set_format);
1829 }
1830 
1831 
1832 static int snd_asihpi_aesebu_tx_add(struct snd_card_asihpi *asihpi,
1833 				    struct hpi_control *hpi_ctl)
1834 {
1835 	struct snd_card *card = asihpi->card;
1836 	struct snd_kcontrol_new snd_control;
1837 
1838 	asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
1839 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1840 	snd_control.info = snd_asihpi_aesebu_format_info;
1841 	snd_control.get = snd_asihpi_aesebu_tx_format_get;
1842 	snd_control.put = snd_asihpi_aesebu_tx_format_put;
1843 
1844 	return ctl_add(card, &snd_control, asihpi);
1845 }
1846 
1847 /*------------------------------------------------------------
1848    Tuner controls
1849  ------------------------------------------------------------*/
1850 
1851 /* Gain */
1852 
1853 static int snd_asihpi_tuner_gain_info(struct snd_kcontrol *kcontrol,
1854 				  struct snd_ctl_elem_info *uinfo)
1855 {
1856 	u32 h_control = kcontrol->private_value;
1857 	u16 err;
1858 	short idx;
1859 	u16 gain_range[3];
1860 
1861 	for (idx = 0; idx < 3; idx++) {
1862 		err = hpi_tuner_query_gain(h_control,
1863 					  idx, &gain_range[idx]);
1864 		if (err != 0)
1865 			return err;
1866 	}
1867 
1868 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1869 	uinfo->count = 1;
1870 	uinfo->value.integer.min = ((int)gain_range[0]) / HPI_UNITS_PER_dB;
1871 	uinfo->value.integer.max = ((int)gain_range[1]) / HPI_UNITS_PER_dB;
1872 	uinfo->value.integer.step = ((int) gain_range[2]) / HPI_UNITS_PER_dB;
1873 	return 0;
1874 }
1875 
1876 static int snd_asihpi_tuner_gain_get(struct snd_kcontrol *kcontrol,
1877 				 struct snd_ctl_elem_value *ucontrol)
1878 {
1879 	/*
1880 	struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1881 	*/
1882 	u32 h_control = kcontrol->private_value;
1883 	short gain;
1884 
1885 	hpi_handle_error(hpi_tuner_get_gain(h_control, &gain));
1886 	ucontrol->value.integer.value[0] = gain / HPI_UNITS_PER_dB;
1887 
1888 	return 0;
1889 }
1890 
1891 static int snd_asihpi_tuner_gain_put(struct snd_kcontrol *kcontrol,
1892 				 struct snd_ctl_elem_value *ucontrol)
1893 {
1894 	/*
1895 	struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1896 	*/
1897 	u32 h_control = kcontrol->private_value;
1898 	short gain;
1899 
1900 	gain = (ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
1901 	hpi_handle_error(hpi_tuner_set_gain(h_control, gain));
1902 
1903 	return 1;
1904 }
1905 
1906 /* Band  */
1907 
1908 static int asihpi_tuner_band_query(struct snd_kcontrol *kcontrol,
1909 					u16 *band_list, u32 len) {
1910 	u32 h_control = kcontrol->private_value;
1911 	u16 err = 0;
1912 	u32 i;
1913 
1914 	for (i = 0; i < len; i++) {
1915 		err = hpi_tuner_query_band(
1916 				h_control, i, &band_list[i]);
1917 		if (err != 0)
1918 			break;
1919 	}
1920 
1921 	if (err && (err != HPI_ERROR_INVALID_OBJ_INDEX))
1922 		return -EIO;
1923 
1924 	return i;
1925 }
1926 
1927 static int snd_asihpi_tuner_band_info(struct snd_kcontrol *kcontrol,
1928 				  struct snd_ctl_elem_info *uinfo)
1929 {
1930 	u16 tuner_bands[HPI_TUNER_BAND_LAST];
1931 	int num_bands = 0;
1932 
1933 	num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1934 				HPI_TUNER_BAND_LAST);
1935 
1936 	if (num_bands < 0)
1937 		return num_bands;
1938 
1939 	return snd_ctl_enum_info(uinfo, 1, num_bands, asihpi_tuner_band_names);
1940 }
1941 
1942 static int snd_asihpi_tuner_band_get(struct snd_kcontrol *kcontrol,
1943 				 struct snd_ctl_elem_value *ucontrol)
1944 {
1945 	u32 h_control = kcontrol->private_value;
1946 	/*
1947 	struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1948 	*/
1949 	u16 band, idx;
1950 	u16 tuner_bands[HPI_TUNER_BAND_LAST];
1951 	u32 num_bands = 0;
1952 
1953 	num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1954 				HPI_TUNER_BAND_LAST);
1955 
1956 	hpi_handle_error(hpi_tuner_get_band(h_control, &band));
1957 
1958 	ucontrol->value.enumerated.item[0] = -1;
1959 	for (idx = 0; idx < HPI_TUNER_BAND_LAST; idx++)
1960 		if (tuner_bands[idx] == band) {
1961 			ucontrol->value.enumerated.item[0] = idx;
1962 			break;
1963 		}
1964 
1965 	return 0;
1966 }
1967 
1968 static int snd_asihpi_tuner_band_put(struct snd_kcontrol *kcontrol,
1969 				 struct snd_ctl_elem_value *ucontrol)
1970 {
1971 	/*
1972 	struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1973 	*/
1974 	u32 h_control = kcontrol->private_value;
1975 	unsigned int idx;
1976 	u16 band;
1977 	u16 tuner_bands[HPI_TUNER_BAND_LAST];
1978 	u32 num_bands = 0;
1979 
1980 	num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1981 			HPI_TUNER_BAND_LAST);
1982 
1983 	idx = ucontrol->value.enumerated.item[0];
1984 	if (idx >= ARRAY_SIZE(tuner_bands))
1985 		idx = ARRAY_SIZE(tuner_bands) - 1;
1986 	band = tuner_bands[idx];
1987 	hpi_handle_error(hpi_tuner_set_band(h_control, band));
1988 
1989 	return 1;
1990 }
1991 
1992 /* Freq */
1993 
1994 static int snd_asihpi_tuner_freq_info(struct snd_kcontrol *kcontrol,
1995 				  struct snd_ctl_elem_info *uinfo)
1996 {
1997 	u32 h_control = kcontrol->private_value;
1998 	u16 err;
1999 	u16 tuner_bands[HPI_TUNER_BAND_LAST];
2000 	u16 num_bands = 0, band_iter, idx;
2001 	u32 freq_range[3], temp_freq_range[3];
2002 
2003 	num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
2004 			HPI_TUNER_BAND_LAST);
2005 
2006 	freq_range[0] = INT_MAX;
2007 	freq_range[1] = 0;
2008 	freq_range[2] = INT_MAX;
2009 
2010 	for (band_iter = 0; band_iter < num_bands; band_iter++) {
2011 		for (idx = 0; idx < 3; idx++) {
2012 			err = hpi_tuner_query_frequency(h_control,
2013 				idx, tuner_bands[band_iter],
2014 				&temp_freq_range[idx]);
2015 			if (err != 0)
2016 				return err;
2017 		}
2018 
2019 		/* skip band with bogus stepping */
2020 		if (temp_freq_range[2] <= 0)
2021 			continue;
2022 
2023 		if (temp_freq_range[0] < freq_range[0])
2024 			freq_range[0] = temp_freq_range[0];
2025 		if (temp_freq_range[1] > freq_range[1])
2026 			freq_range[1] = temp_freq_range[1];
2027 		if (temp_freq_range[2] < freq_range[2])
2028 			freq_range[2] = temp_freq_range[2];
2029 	}
2030 
2031 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2032 	uinfo->count = 1;
2033 	uinfo->value.integer.min = ((int)freq_range[0]);
2034 	uinfo->value.integer.max = ((int)freq_range[1]);
2035 	uinfo->value.integer.step = ((int)freq_range[2]);
2036 	return 0;
2037 }
2038 
2039 static int snd_asihpi_tuner_freq_get(struct snd_kcontrol *kcontrol,
2040 				 struct snd_ctl_elem_value *ucontrol)
2041 {
2042 	u32 h_control = kcontrol->private_value;
2043 	u32 freq;
2044 
2045 	hpi_handle_error(hpi_tuner_get_frequency(h_control, &freq));
2046 	ucontrol->value.integer.value[0] = freq;
2047 
2048 	return 0;
2049 }
2050 
2051 static int snd_asihpi_tuner_freq_put(struct snd_kcontrol *kcontrol,
2052 				 struct snd_ctl_elem_value *ucontrol)
2053 {
2054 	u32 h_control = kcontrol->private_value;
2055 	u32 freq;
2056 
2057 	freq = ucontrol->value.integer.value[0];
2058 	hpi_handle_error(hpi_tuner_set_frequency(h_control, freq));
2059 
2060 	return 1;
2061 }
2062 
2063 /* Tuner control group initializer  */
2064 static int snd_asihpi_tuner_add(struct snd_card_asihpi *asihpi,
2065 				struct hpi_control *hpi_ctl)
2066 {
2067 	struct snd_card *card = asihpi->card;
2068 	struct snd_kcontrol_new snd_control;
2069 
2070 	snd_control.private_value = hpi_ctl->h_control;
2071 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2072 
2073 	if (!hpi_tuner_get_gain(hpi_ctl->h_control, NULL)) {
2074 		asihpi_ctl_init(&snd_control, hpi_ctl, "Gain");
2075 		snd_control.info = snd_asihpi_tuner_gain_info;
2076 		snd_control.get = snd_asihpi_tuner_gain_get;
2077 		snd_control.put = snd_asihpi_tuner_gain_put;
2078 
2079 		if (ctl_add(card, &snd_control, asihpi) < 0)
2080 			return -EINVAL;
2081 	}
2082 
2083 	asihpi_ctl_init(&snd_control, hpi_ctl, "Band");
2084 	snd_control.info = snd_asihpi_tuner_band_info;
2085 	snd_control.get = snd_asihpi_tuner_band_get;
2086 	snd_control.put = snd_asihpi_tuner_band_put;
2087 
2088 	if (ctl_add(card, &snd_control, asihpi) < 0)
2089 		return -EINVAL;
2090 
2091 	asihpi_ctl_init(&snd_control, hpi_ctl, "Freq");
2092 	snd_control.info = snd_asihpi_tuner_freq_info;
2093 	snd_control.get = snd_asihpi_tuner_freq_get;
2094 	snd_control.put = snd_asihpi_tuner_freq_put;
2095 
2096 	return ctl_add(card, &snd_control, asihpi);
2097 }
2098 
2099 /*------------------------------------------------------------
2100    Meter controls
2101  ------------------------------------------------------------*/
2102 static int snd_asihpi_meter_info(struct snd_kcontrol *kcontrol,
2103 				 struct snd_ctl_elem_info *uinfo)
2104 {
2105 	u32 h_control = kcontrol->private_value;
2106 	u32 count;
2107 	u16 err;
2108 	err = hpi_meter_query_channels(h_control, &count);
2109 	if (err)
2110 		count = HPI_MAX_CHANNELS;
2111 
2112 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2113 	uinfo->count = count;
2114 	uinfo->value.integer.min = 0;
2115 	uinfo->value.integer.max = 0x7FFFFFFF;
2116 	return 0;
2117 }
2118 
2119 /* linear values for 10dB steps */
2120 static int log2lin[] = {
2121 	0x7FFFFFFF, /* 0dB */
2122 	679093956,
2123 	214748365,
2124 	 67909396,
2125 	 21474837,
2126 	  6790940,
2127 	  2147484, /* -60dB */
2128 	   679094,
2129 	   214748, /* -80 */
2130 	    67909,
2131 	    21475, /* -100 */
2132 	     6791,
2133 	     2147,
2134 	      679,
2135 	      214,
2136 	       68,
2137 	       21,
2138 		7,
2139 		2
2140 };
2141 
2142 static int snd_asihpi_meter_get(struct snd_kcontrol *kcontrol,
2143 				struct snd_ctl_elem_value *ucontrol)
2144 {
2145 	u32 h_control = kcontrol->private_value;
2146 	short an_gain_mB[HPI_MAX_CHANNELS], i;
2147 	u16 err;
2148 
2149 	err = hpi_meter_get_peak(h_control, an_gain_mB);
2150 
2151 	for (i = 0; i < HPI_MAX_CHANNELS; i++) {
2152 		if (err) {
2153 			ucontrol->value.integer.value[i] = 0;
2154 		} else if (an_gain_mB[i] >= 0) {
2155 			ucontrol->value.integer.value[i] =
2156 				an_gain_mB[i] << 16;
2157 		} else {
2158 			/* -ve is log value in millibels < -60dB,
2159 			* convert to (roughly!) linear,
2160 			*/
2161 			ucontrol->value.integer.value[i] =
2162 					log2lin[an_gain_mB[i] / -1000];
2163 		}
2164 	}
2165 	return 0;
2166 }
2167 
2168 static int snd_asihpi_meter_add(struct snd_card_asihpi *asihpi,
2169 				struct hpi_control *hpi_ctl, int subidx)
2170 {
2171 	struct snd_card *card = asihpi->card;
2172 	struct snd_kcontrol_new snd_control;
2173 
2174 	asihpi_ctl_init(&snd_control, hpi_ctl, "Meter");
2175 	snd_control.access =
2176 	    SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
2177 	snd_control.info = snd_asihpi_meter_info;
2178 	snd_control.get = snd_asihpi_meter_get;
2179 
2180 	snd_control.index = subidx;
2181 
2182 	return ctl_add(card, &snd_control, asihpi);
2183 }
2184 
2185 /*------------------------------------------------------------
2186    Multiplexer controls
2187  ------------------------------------------------------------*/
2188 static int snd_card_asihpi_mux_count_sources(struct snd_kcontrol *snd_control)
2189 {
2190 	u32 h_control = snd_control->private_value;
2191 	struct hpi_control hpi_ctl;
2192 	int s, err;
2193 	for (s = 0; s < 32; s++) {
2194 		err = hpi_multiplexer_query_source(h_control, s,
2195 						  &hpi_ctl.
2196 						  src_node_type,
2197 						  &hpi_ctl.
2198 						  src_node_index);
2199 		if (err)
2200 			break;
2201 	}
2202 	return s;
2203 }
2204 
2205 static int snd_asihpi_mux_info(struct snd_kcontrol *kcontrol,
2206 			       struct snd_ctl_elem_info *uinfo)
2207 {
2208 	int err;
2209 	u16 src_node_type, src_node_index;
2210 	u32 h_control = kcontrol->private_value;
2211 
2212 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2213 	uinfo->count = 1;
2214 	uinfo->value.enumerated.items =
2215 	    snd_card_asihpi_mux_count_sources(kcontrol);
2216 
2217 	if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
2218 		uinfo->value.enumerated.item =
2219 		    uinfo->value.enumerated.items - 1;
2220 
2221 	err =
2222 	    hpi_multiplexer_query_source(h_control,
2223 					uinfo->value.enumerated.item,
2224 					&src_node_type, &src_node_index);
2225 
2226 	sprintf(uinfo->value.enumerated.name, "%s %d",
2227 		asihpi_src_names[src_node_type - HPI_SOURCENODE_NONE],
2228 		src_node_index);
2229 	return 0;
2230 }
2231 
2232 static int snd_asihpi_mux_get(struct snd_kcontrol *kcontrol,
2233 			      struct snd_ctl_elem_value *ucontrol)
2234 {
2235 	u32 h_control = kcontrol->private_value;
2236 	u16 source_type, source_index;
2237 	u16 src_node_type, src_node_index;
2238 	int s;
2239 
2240 	hpi_handle_error(hpi_multiplexer_get_source(h_control,
2241 				&source_type, &source_index));
2242 	/* Should cache this search result! */
2243 	for (s = 0; s < 256; s++) {
2244 		if (hpi_multiplexer_query_source(h_control, s,
2245 					    &src_node_type, &src_node_index))
2246 			break;
2247 
2248 		if ((source_type == src_node_type)
2249 		    && (source_index == src_node_index)) {
2250 			ucontrol->value.enumerated.item[0] = s;
2251 			return 0;
2252 		}
2253 	}
2254 	snd_printd(KERN_WARNING
2255 		"Control %x failed to match mux source %hu %hu\n",
2256 		h_control, source_type, source_index);
2257 	ucontrol->value.enumerated.item[0] = 0;
2258 	return 0;
2259 }
2260 
2261 static int snd_asihpi_mux_put(struct snd_kcontrol *kcontrol,
2262 			      struct snd_ctl_elem_value *ucontrol)
2263 {
2264 	int change;
2265 	u32 h_control = kcontrol->private_value;
2266 	u16 source_type, source_index;
2267 	u16 e;
2268 
2269 	change = 1;
2270 
2271 	e = hpi_multiplexer_query_source(h_control,
2272 				    ucontrol->value.enumerated.item[0],
2273 				    &source_type, &source_index);
2274 	if (!e)
2275 		hpi_handle_error(
2276 			hpi_multiplexer_set_source(h_control,
2277 						source_type, source_index));
2278 	return change;
2279 }
2280 
2281 
2282 static int  snd_asihpi_mux_add(struct snd_card_asihpi *asihpi,
2283 			       struct hpi_control *hpi_ctl)
2284 {
2285 	struct snd_card *card = asihpi->card;
2286 	struct snd_kcontrol_new snd_control;
2287 
2288 	asihpi_ctl_init(&snd_control, hpi_ctl, "Route");
2289 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2290 	snd_control.info = snd_asihpi_mux_info;
2291 	snd_control.get = snd_asihpi_mux_get;
2292 	snd_control.put = snd_asihpi_mux_put;
2293 
2294 	return ctl_add(card, &snd_control, asihpi);
2295 
2296 }
2297 
2298 /*------------------------------------------------------------
2299    Channel mode controls
2300  ------------------------------------------------------------*/
2301 static int snd_asihpi_cmode_info(struct snd_kcontrol *kcontrol,
2302 				 struct snd_ctl_elem_info *uinfo)
2303 {
2304 	static const char * const mode_names[HPI_CHANNEL_MODE_LAST + 1] = {
2305 		"invalid",
2306 		"Normal", "Swap",
2307 		"From Left", "From Right",
2308 		"To Left", "To Right"
2309 	};
2310 
2311 	u32 h_control = kcontrol->private_value;
2312 	u16 mode;
2313 	int i;
2314 	const char *mapped_names[6];
2315 	int valid_modes = 0;
2316 
2317 	/* HPI channel mode values can be from 1 to 6
2318 	Some adapters only support a contiguous subset
2319 	*/
2320 	for (i = 0; i < HPI_CHANNEL_MODE_LAST; i++)
2321 		if (!hpi_channel_mode_query_mode(
2322 			h_control, i, &mode)) {
2323 			mapped_names[valid_modes] = mode_names[mode];
2324 			valid_modes++;
2325 			}
2326 
2327 	if (!valid_modes)
2328 		return -EINVAL;
2329 
2330 	return snd_ctl_enum_info(uinfo, 1, valid_modes, mapped_names);
2331 }
2332 
2333 static int snd_asihpi_cmode_get(struct snd_kcontrol *kcontrol,
2334 				struct snd_ctl_elem_value *ucontrol)
2335 {
2336 	u32 h_control = kcontrol->private_value;
2337 	u16 mode;
2338 
2339 	if (hpi_channel_mode_get(h_control, &mode))
2340 		mode = 1;
2341 
2342 	ucontrol->value.enumerated.item[0] = mode - 1;
2343 
2344 	return 0;
2345 }
2346 
2347 static int snd_asihpi_cmode_put(struct snd_kcontrol *kcontrol,
2348 				struct snd_ctl_elem_value *ucontrol)
2349 {
2350 	int change;
2351 	u32 h_control = kcontrol->private_value;
2352 
2353 	change = 1;
2354 
2355 	hpi_handle_error(hpi_channel_mode_set(h_control,
2356 			   ucontrol->value.enumerated.item[0] + 1));
2357 	return change;
2358 }
2359 
2360 
2361 static int snd_asihpi_cmode_add(struct snd_card_asihpi *asihpi,
2362 				struct hpi_control *hpi_ctl)
2363 {
2364 	struct snd_card *card = asihpi->card;
2365 	struct snd_kcontrol_new snd_control;
2366 
2367 	asihpi_ctl_init(&snd_control, hpi_ctl, "Mode");
2368 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2369 	snd_control.info = snd_asihpi_cmode_info;
2370 	snd_control.get = snd_asihpi_cmode_get;
2371 	snd_control.put = snd_asihpi_cmode_put;
2372 
2373 	return ctl_add(card, &snd_control, asihpi);
2374 }
2375 
2376 /*------------------------------------------------------------
2377    Sampleclock source  controls
2378  ------------------------------------------------------------*/
2379 static const char * const sampleclock_sources[] = {
2380 	"N/A", "Local PLL", "Digital Sync", "Word External", "Word Header",
2381 	"SMPTE", "Digital1", "Auto", "Network", "Invalid",
2382 	"Prev Module", "BLU-Link",
2383 	"Digital2", "Digital3", "Digital4", "Digital5",
2384 	"Digital6", "Digital7", "Digital8"};
2385 
2386 	/* Number of strings must match expected enumerated values */
2387 	compile_time_assert(
2388 		(ARRAY_SIZE(sampleclock_sources) == MAX_CLOCKSOURCES),
2389 		assert_sampleclock_sources_size);
2390 
2391 static int snd_asihpi_clksrc_info(struct snd_kcontrol *kcontrol,
2392 				  struct snd_ctl_elem_info *uinfo)
2393 {
2394 	struct snd_card_asihpi *asihpi =
2395 			(struct snd_card_asihpi *)(kcontrol->private_data);
2396 	struct clk_cache *clkcache = &asihpi->cc;
2397 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2398 	uinfo->count = 1;
2399 	uinfo->value.enumerated.items = clkcache->count;
2400 
2401 	if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
2402 		uinfo->value.enumerated.item =
2403 				uinfo->value.enumerated.items - 1;
2404 
2405 	strcpy(uinfo->value.enumerated.name,
2406 	       clkcache->s[uinfo->value.enumerated.item].name);
2407 	return 0;
2408 }
2409 
2410 static int snd_asihpi_clksrc_get(struct snd_kcontrol *kcontrol,
2411 				 struct snd_ctl_elem_value *ucontrol)
2412 {
2413 	struct snd_card_asihpi *asihpi =
2414 			(struct snd_card_asihpi *)(kcontrol->private_data);
2415 	struct clk_cache *clkcache = &asihpi->cc;
2416 	u32 h_control = kcontrol->private_value;
2417 	u16 source, srcindex = 0;
2418 	int i;
2419 
2420 	ucontrol->value.enumerated.item[0] = 0;
2421 	if (hpi_sample_clock_get_source(h_control, &source))
2422 		source = 0;
2423 
2424 	if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2425 		if (hpi_sample_clock_get_source_index(h_control, &srcindex))
2426 			srcindex = 0;
2427 
2428 	for (i = 0; i < clkcache->count; i++)
2429 		if ((clkcache->s[i].source == source) &&
2430 			(clkcache->s[i].index == srcindex))
2431 			break;
2432 
2433 	ucontrol->value.enumerated.item[0] = i;
2434 
2435 	return 0;
2436 }
2437 
2438 static int snd_asihpi_clksrc_put(struct snd_kcontrol *kcontrol,
2439 				 struct snd_ctl_elem_value *ucontrol)
2440 {
2441 	struct snd_card_asihpi *asihpi =
2442 			(struct snd_card_asihpi *)(kcontrol->private_data);
2443 	struct clk_cache *clkcache = &asihpi->cc;
2444 	unsigned int item;
2445 	int change;
2446 	u32 h_control = kcontrol->private_value;
2447 
2448 	change = 1;
2449 	item = ucontrol->value.enumerated.item[0];
2450 	if (item >= clkcache->count)
2451 		item = clkcache->count-1;
2452 
2453 	hpi_handle_error(hpi_sample_clock_set_source(
2454 				h_control, clkcache->s[item].source));
2455 
2456 	if (clkcache->s[item].source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2457 		hpi_handle_error(hpi_sample_clock_set_source_index(
2458 				h_control, clkcache->s[item].index));
2459 	return change;
2460 }
2461 
2462 /*------------------------------------------------------------
2463    Clkrate controls
2464  ------------------------------------------------------------*/
2465 /* Need to change this to enumerated control with list of rates */
2466 static int snd_asihpi_clklocal_info(struct snd_kcontrol *kcontrol,
2467 				   struct snd_ctl_elem_info *uinfo)
2468 {
2469 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2470 	uinfo->count = 1;
2471 	uinfo->value.integer.min = 8000;
2472 	uinfo->value.integer.max = 192000;
2473 	uinfo->value.integer.step = 100;
2474 
2475 	return 0;
2476 }
2477 
2478 static int snd_asihpi_clklocal_get(struct snd_kcontrol *kcontrol,
2479 				  struct snd_ctl_elem_value *ucontrol)
2480 {
2481 	u32 h_control = kcontrol->private_value;
2482 	u32 rate;
2483 	u16 e;
2484 
2485 	e = hpi_sample_clock_get_local_rate(h_control, &rate);
2486 	if (!e)
2487 		ucontrol->value.integer.value[0] = rate;
2488 	else
2489 		ucontrol->value.integer.value[0] = 0;
2490 	return 0;
2491 }
2492 
2493 static int snd_asihpi_clklocal_put(struct snd_kcontrol *kcontrol,
2494 				  struct snd_ctl_elem_value *ucontrol)
2495 {
2496 	int change;
2497 	u32 h_control = kcontrol->private_value;
2498 
2499 	/*  change = asihpi->mixer_clkrate[addr][0] != left ||
2500 	   asihpi->mixer_clkrate[addr][1] != right;
2501 	 */
2502 	change = 1;
2503 	hpi_handle_error(hpi_sample_clock_set_local_rate(h_control,
2504 				      ucontrol->value.integer.value[0]));
2505 	return change;
2506 }
2507 
2508 static int snd_asihpi_clkrate_info(struct snd_kcontrol *kcontrol,
2509 				   struct snd_ctl_elem_info *uinfo)
2510 {
2511 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2512 	uinfo->count = 1;
2513 	uinfo->value.integer.min = 8000;
2514 	uinfo->value.integer.max = 192000;
2515 	uinfo->value.integer.step = 100;
2516 
2517 	return 0;
2518 }
2519 
2520 static int snd_asihpi_clkrate_get(struct snd_kcontrol *kcontrol,
2521 				  struct snd_ctl_elem_value *ucontrol)
2522 {
2523 	u32 h_control = kcontrol->private_value;
2524 	u32 rate;
2525 	u16 e;
2526 
2527 	e = hpi_sample_clock_get_sample_rate(h_control, &rate);
2528 	if (!e)
2529 		ucontrol->value.integer.value[0] = rate;
2530 	else
2531 		ucontrol->value.integer.value[0] = 0;
2532 	return 0;
2533 }
2534 
2535 static int snd_asihpi_sampleclock_add(struct snd_card_asihpi *asihpi,
2536 				      struct hpi_control *hpi_ctl)
2537 {
2538 	struct snd_card *card;
2539 	struct snd_kcontrol_new snd_control;
2540 
2541 	struct clk_cache *clkcache;
2542 	u32 hSC =  hpi_ctl->h_control;
2543 	int has_aes_in = 0;
2544 	int i, j;
2545 	u16 source;
2546 
2547 	if (snd_BUG_ON(!asihpi))
2548 		return -EINVAL;
2549 	card = asihpi->card;
2550 	clkcache = &asihpi->cc;
2551 	snd_control.private_value = hpi_ctl->h_control;
2552 
2553 	clkcache->has_local = 0;
2554 
2555 	for (i = 0; i <= HPI_SAMPLECLOCK_SOURCE_LAST; i++) {
2556 		if  (hpi_sample_clock_query_source(hSC,
2557 				i, &source))
2558 			break;
2559 		clkcache->s[i].source = source;
2560 		clkcache->s[i].index = 0;
2561 		clkcache->s[i].name = sampleclock_sources[source];
2562 		if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2563 			has_aes_in = 1;
2564 		if (source == HPI_SAMPLECLOCK_SOURCE_LOCAL)
2565 			clkcache->has_local = 1;
2566 	}
2567 	if (has_aes_in)
2568 		/* already will have picked up index 0 above */
2569 		for (j = 1; j < 8; j++) {
2570 			if (hpi_sample_clock_query_source_index(hSC,
2571 				j, HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT,
2572 				&source))
2573 				break;
2574 			clkcache->s[i].source =
2575 				HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT;
2576 			clkcache->s[i].index = j;
2577 			clkcache->s[i].name = sampleclock_sources[
2578 					j+HPI_SAMPLECLOCK_SOURCE_LAST];
2579 			i++;
2580 		}
2581 	clkcache->count = i;
2582 
2583 	asihpi_ctl_init(&snd_control, hpi_ctl, "Source");
2584 	snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
2585 	snd_control.info = snd_asihpi_clksrc_info;
2586 	snd_control.get = snd_asihpi_clksrc_get;
2587 	snd_control.put = snd_asihpi_clksrc_put;
2588 	if (ctl_add(card, &snd_control, asihpi) < 0)
2589 		return -EINVAL;
2590 
2591 
2592 	if (clkcache->has_local) {
2593 		asihpi_ctl_init(&snd_control, hpi_ctl, "Localrate");
2594 		snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
2595 		snd_control.info = snd_asihpi_clklocal_info;
2596 		snd_control.get = snd_asihpi_clklocal_get;
2597 		snd_control.put = snd_asihpi_clklocal_put;
2598 
2599 
2600 		if (ctl_add(card, &snd_control, asihpi) < 0)
2601 			return -EINVAL;
2602 	}
2603 
2604 	asihpi_ctl_init(&snd_control, hpi_ctl, "Rate");
2605 	snd_control.access =
2606 	    SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
2607 	snd_control.info = snd_asihpi_clkrate_info;
2608 	snd_control.get = snd_asihpi_clkrate_get;
2609 
2610 	return ctl_add(card, &snd_control, asihpi);
2611 }
2612 /*------------------------------------------------------------
2613    Mixer
2614  ------------------------------------------------------------*/
2615 
2616 static int snd_card_asihpi_mixer_new(struct snd_card_asihpi *asihpi)
2617 {
2618 	struct snd_card *card;
2619 	unsigned int idx = 0;
2620 	unsigned int subindex = 0;
2621 	int err;
2622 	struct hpi_control hpi_ctl, prev_ctl;
2623 
2624 	if (snd_BUG_ON(!asihpi))
2625 		return -EINVAL;
2626 	card = asihpi->card;
2627 	strcpy(card->mixername, "Asihpi Mixer");
2628 
2629 	err =
2630 	    hpi_mixer_open(asihpi->hpi->adapter->index,
2631 			  &asihpi->h_mixer);
2632 	hpi_handle_error(err);
2633 	if (err)
2634 		return -err;
2635 
2636 	memset(&prev_ctl, 0, sizeof(prev_ctl));
2637 	prev_ctl.control_type = -1;
2638 
2639 	for (idx = 0; idx < 2000; idx++) {
2640 		err = hpi_mixer_get_control_by_index(
2641 				asihpi->h_mixer,
2642 				idx,
2643 				&hpi_ctl.src_node_type,
2644 				&hpi_ctl.src_node_index,
2645 				&hpi_ctl.dst_node_type,
2646 				&hpi_ctl.dst_node_index,
2647 				&hpi_ctl.control_type,
2648 				&hpi_ctl.h_control);
2649 		if (err) {
2650 			if (err == HPI_ERROR_CONTROL_DISABLED) {
2651 				if (mixer_dump)
2652 					dev_info(&asihpi->pci->dev,
2653 						   "Disabled HPI Control(%d)\n",
2654 						   idx);
2655 				continue;
2656 			} else
2657 				break;
2658 
2659 		}
2660 
2661 		hpi_ctl.src_node_type -= HPI_SOURCENODE_NONE;
2662 		hpi_ctl.dst_node_type -= HPI_DESTNODE_NONE;
2663 
2664 		/* ASI50xx in SSX mode has multiple meters on the same node.
2665 		   Use subindex to create distinct ALSA controls
2666 		   for any duplicated controls.
2667 		*/
2668 		if ((hpi_ctl.control_type == prev_ctl.control_type) &&
2669 		    (hpi_ctl.src_node_type == prev_ctl.src_node_type) &&
2670 		    (hpi_ctl.src_node_index == prev_ctl.src_node_index) &&
2671 		    (hpi_ctl.dst_node_type == prev_ctl.dst_node_type) &&
2672 		    (hpi_ctl.dst_node_index == prev_ctl.dst_node_index))
2673 			subindex++;
2674 		else
2675 			subindex = 0;
2676 
2677 		prev_ctl = hpi_ctl;
2678 
2679 		switch (hpi_ctl.control_type) {
2680 		case HPI_CONTROL_VOLUME:
2681 			err = snd_asihpi_volume_add(asihpi, &hpi_ctl);
2682 			break;
2683 		case HPI_CONTROL_LEVEL:
2684 			err = snd_asihpi_level_add(asihpi, &hpi_ctl);
2685 			break;
2686 		case HPI_CONTROL_MULTIPLEXER:
2687 			err = snd_asihpi_mux_add(asihpi, &hpi_ctl);
2688 			break;
2689 		case HPI_CONTROL_CHANNEL_MODE:
2690 			err = snd_asihpi_cmode_add(asihpi, &hpi_ctl);
2691 			break;
2692 		case HPI_CONTROL_METER:
2693 			err = snd_asihpi_meter_add(asihpi, &hpi_ctl, subindex);
2694 			break;
2695 		case HPI_CONTROL_SAMPLECLOCK:
2696 			err = snd_asihpi_sampleclock_add(
2697 						asihpi, &hpi_ctl);
2698 			break;
2699 		case HPI_CONTROL_CONNECTION:	/* ignore these */
2700 			continue;
2701 		case HPI_CONTROL_TUNER:
2702 			err = snd_asihpi_tuner_add(asihpi, &hpi_ctl);
2703 			break;
2704 		case HPI_CONTROL_AESEBU_TRANSMITTER:
2705 			err = snd_asihpi_aesebu_tx_add(asihpi, &hpi_ctl);
2706 			break;
2707 		case HPI_CONTROL_AESEBU_RECEIVER:
2708 			err = snd_asihpi_aesebu_rx_add(asihpi, &hpi_ctl);
2709 			break;
2710 		case HPI_CONTROL_VOX:
2711 		case HPI_CONTROL_BITSTREAM:
2712 		case HPI_CONTROL_MICROPHONE:
2713 		case HPI_CONTROL_PARAMETRIC_EQ:
2714 		case HPI_CONTROL_COMPANDER:
2715 		default:
2716 			if (mixer_dump)
2717 				dev_info(&asihpi->pci->dev,
2718 					"Untranslated HPI Control (%d) %d %d %d %d %d\n",
2719 					idx,
2720 					hpi_ctl.control_type,
2721 					hpi_ctl.src_node_type,
2722 					hpi_ctl.src_node_index,
2723 					hpi_ctl.dst_node_type,
2724 					hpi_ctl.dst_node_index);
2725 			continue;
2726 		}
2727 		if (err < 0)
2728 			return err;
2729 	}
2730 	if (HPI_ERROR_INVALID_OBJ_INDEX != err)
2731 		hpi_handle_error(err);
2732 
2733 	dev_info(&asihpi->pci->dev, "%d mixer controls found\n", idx);
2734 
2735 	return 0;
2736 }
2737 
2738 /*------------------------------------------------------------
2739    /proc interface
2740  ------------------------------------------------------------*/
2741 
2742 static void
2743 snd_asihpi_proc_read(struct snd_info_entry *entry,
2744 			struct snd_info_buffer *buffer)
2745 {
2746 	struct snd_card_asihpi *asihpi = entry->private_data;
2747 	u32 h_control;
2748 	u32 rate = 0;
2749 	u16 source = 0;
2750 
2751 	u16 num_outstreams;
2752 	u16 num_instreams;
2753 	u16 version;
2754 	u32 serial_number;
2755 	u16 type;
2756 
2757 	int err;
2758 
2759 	snd_iprintf(buffer, "ASIHPI driver proc file\n");
2760 
2761 	hpi_handle_error(hpi_adapter_get_info(asihpi->hpi->adapter->index,
2762 			&num_outstreams, &num_instreams,
2763 			&version, &serial_number, &type));
2764 
2765 	snd_iprintf(buffer,
2766 			"Adapter type ASI%4X\nHardware Index %d\n"
2767 			"%d outstreams\n%d instreams\n",
2768 			type, asihpi->hpi->adapter->index,
2769 			num_outstreams, num_instreams);
2770 
2771 	snd_iprintf(buffer,
2772 		"Serial#%d\nHardware version %c%d\nDSP code version %03d\n",
2773 		serial_number, ((version >> 3) & 0xf) + 'A', version & 0x7,
2774 		((version >> 13) * 100) + ((version >> 7) & 0x3f));
2775 
2776 	err = hpi_mixer_get_control(asihpi->h_mixer,
2777 				  HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
2778 				  HPI_CONTROL_SAMPLECLOCK, &h_control);
2779 
2780 	if (!err) {
2781 		err = hpi_sample_clock_get_sample_rate(h_control, &rate);
2782 		err += hpi_sample_clock_get_source(h_control, &source);
2783 
2784 		if (!err)
2785 			snd_iprintf(buffer, "Sample Clock %dHz, source %s\n",
2786 			rate, sampleclock_sources[source]);
2787 	}
2788 }
2789 
2790 static void snd_asihpi_proc_init(struct snd_card_asihpi *asihpi)
2791 {
2792 	struct snd_info_entry *entry;
2793 
2794 	if (!snd_card_proc_new(asihpi->card, "info", &entry))
2795 		snd_info_set_text_ops(entry, asihpi, snd_asihpi_proc_read);
2796 }
2797 
2798 /*------------------------------------------------------------
2799    HWDEP
2800  ------------------------------------------------------------*/
2801 
2802 static int snd_asihpi_hpi_open(struct snd_hwdep *hw, struct file *file)
2803 {
2804 	if (enable_hpi_hwdep)
2805 		return 0;
2806 	else
2807 		return -ENODEV;
2808 
2809 }
2810 
2811 static int snd_asihpi_hpi_release(struct snd_hwdep *hw, struct file *file)
2812 {
2813 	if (enable_hpi_hwdep)
2814 		return asihpi_hpi_release(file);
2815 	else
2816 		return -ENODEV;
2817 }
2818 
2819 static int snd_asihpi_hpi_ioctl(struct snd_hwdep *hw, struct file *file,
2820 				unsigned int cmd, unsigned long arg)
2821 {
2822 	if (enable_hpi_hwdep)
2823 		return asihpi_hpi_ioctl(file, cmd, arg);
2824 	else
2825 		return -ENODEV;
2826 }
2827 
2828 
2829 /* results in /dev/snd/hwC#D0 file for each card with index #
2830    also /proc/asound/hwdep will contain '#-00: asihpi (HPI) for each card'
2831 */
2832 static int snd_asihpi_hpi_new(struct snd_card_asihpi *asihpi, int device)
2833 {
2834 	struct snd_hwdep *hw;
2835 	int err;
2836 
2837 	err = snd_hwdep_new(asihpi->card, "HPI", device, &hw);
2838 	if (err < 0)
2839 		return err;
2840 	strcpy(hw->name, "asihpi (HPI)");
2841 	hw->iface = SNDRV_HWDEP_IFACE_LAST;
2842 	hw->ops.open = snd_asihpi_hpi_open;
2843 	hw->ops.ioctl = snd_asihpi_hpi_ioctl;
2844 	hw->ops.release = snd_asihpi_hpi_release;
2845 	hw->private_data = asihpi;
2846 	return 0;
2847 }
2848 
2849 /*------------------------------------------------------------
2850    CARD
2851  ------------------------------------------------------------*/
2852 static int snd_asihpi_probe(struct pci_dev *pci_dev,
2853 			    const struct pci_device_id *pci_id)
2854 {
2855 	int err;
2856 	struct hpi_adapter *hpi;
2857 	struct snd_card *card;
2858 	struct snd_card_asihpi *asihpi;
2859 
2860 	u32 h_control;
2861 	u32 h_stream;
2862 	u32 adapter_index;
2863 
2864 	static int dev;
2865 	if (dev >= SNDRV_CARDS)
2866 		return -ENODEV;
2867 
2868 	/* Should this be enable[hpi->index] ? */
2869 	if (!enable[dev]) {
2870 		dev++;
2871 		return -ENOENT;
2872 	}
2873 
2874 	/* Initialise low-level HPI driver */
2875 	err = asihpi_adapter_probe(pci_dev, pci_id);
2876 	if (err < 0)
2877 		return err;
2878 
2879 	hpi = pci_get_drvdata(pci_dev);
2880 	adapter_index = hpi->adapter->index;
2881 	/* first try to give the card the same index as its hardware index */
2882 	err = snd_card_new(&pci_dev->dev, adapter_index, id[adapter_index],
2883 			   THIS_MODULE, sizeof(struct snd_card_asihpi), &card);
2884 	if (err < 0) {
2885 		/* if that fails, try the default index==next available */
2886 		err = snd_card_new(&pci_dev->dev, index[dev], id[dev],
2887 				   THIS_MODULE, sizeof(struct snd_card_asihpi),
2888 				   &card);
2889 		if (err < 0)
2890 			return err;
2891 		dev_warn(&pci_dev->dev, "Adapter index %d->ALSA index %d\n",
2892 			adapter_index, card->number);
2893 	}
2894 
2895 	asihpi = card->private_data;
2896 	asihpi->card = card;
2897 	asihpi->pci = pci_dev;
2898 	asihpi->hpi = hpi;
2899 	hpi->snd_card = card;
2900 
2901 	err = hpi_adapter_get_property(adapter_index,
2902 		HPI_ADAPTER_PROPERTY_CAPS1,
2903 		NULL, &asihpi->support_grouping);
2904 	if (err)
2905 		asihpi->support_grouping = 0;
2906 
2907 	err = hpi_adapter_get_property(adapter_index,
2908 		HPI_ADAPTER_PROPERTY_CAPS2,
2909 		&asihpi->support_mrx, NULL);
2910 	if (err)
2911 		asihpi->support_mrx = 0;
2912 
2913 	err = hpi_adapter_get_property(adapter_index,
2914 		HPI_ADAPTER_PROPERTY_INTERVAL,
2915 		NULL, &asihpi->update_interval_frames);
2916 	if (err)
2917 		asihpi->update_interval_frames = 512;
2918 
2919 	if (hpi->interrupt_mode) {
2920 		asihpi->pcm_start = snd_card_asihpi_pcm_int_start;
2921 		asihpi->pcm_stop = snd_card_asihpi_pcm_int_stop;
2922 		tasklet_init(&asihpi->t, snd_card_asihpi_int_task,
2923 			(unsigned long)hpi);
2924 		hpi->interrupt_callback = snd_card_asihpi_isr;
2925 	} else {
2926 		asihpi->pcm_start = snd_card_asihpi_pcm_timer_start;
2927 		asihpi->pcm_stop = snd_card_asihpi_pcm_timer_stop;
2928 	}
2929 
2930 	hpi_handle_error(hpi_instream_open(adapter_index,
2931 			     0, &h_stream));
2932 
2933 	err = hpi_instream_host_buffer_free(h_stream);
2934 	asihpi->can_dma = (!err);
2935 
2936 	hpi_handle_error(hpi_instream_close(h_stream));
2937 
2938 	if (!asihpi->can_dma)
2939 		asihpi->update_interval_frames *= 2;
2940 
2941 	err = hpi_adapter_get_property(adapter_index,
2942 		HPI_ADAPTER_PROPERTY_CURCHANNELS,
2943 		&asihpi->in_max_chans, &asihpi->out_max_chans);
2944 	if (err) {
2945 		asihpi->in_max_chans = 2;
2946 		asihpi->out_max_chans = 2;
2947 	}
2948 
2949 	if (asihpi->out_max_chans > 2) { /* assume LL mode */
2950 		asihpi->out_min_chans = asihpi->out_max_chans;
2951 		asihpi->in_min_chans = asihpi->in_max_chans;
2952 		asihpi->support_grouping = 0;
2953 	} else {
2954 		asihpi->out_min_chans = 1;
2955 		asihpi->in_min_chans = 1;
2956 	}
2957 
2958 	dev_info(&pci_dev->dev, "Has dma:%d, grouping:%d, mrx:%d, uif:%d\n",
2959 			asihpi->can_dma,
2960 			asihpi->support_grouping,
2961 			asihpi->support_mrx,
2962 			asihpi->update_interval_frames
2963 	      );
2964 
2965 	err = snd_card_asihpi_pcm_new(asihpi, 0);
2966 	if (err < 0) {
2967 		dev_err(&pci_dev->dev, "pcm_new failed\n");
2968 		goto __nodev;
2969 	}
2970 	err = snd_card_asihpi_mixer_new(asihpi);
2971 	if (err < 0) {
2972 		dev_err(&pci_dev->dev, "mixer_new failed\n");
2973 		goto __nodev;
2974 	}
2975 
2976 	err = hpi_mixer_get_control(asihpi->h_mixer,
2977 				  HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
2978 				  HPI_CONTROL_SAMPLECLOCK, &h_control);
2979 
2980 	if (!err)
2981 		err = hpi_sample_clock_set_local_rate(
2982 			h_control, adapter_fs);
2983 
2984 	snd_asihpi_proc_init(asihpi);
2985 
2986 	/* always create, can be enabled or disabled dynamically
2987 	    by enable_hwdep  module param*/
2988 	snd_asihpi_hpi_new(asihpi, 0);
2989 
2990 	strcpy(card->driver, "ASIHPI");
2991 
2992 	sprintf(card->shortname, "AudioScience ASI%4X",
2993 			asihpi->hpi->adapter->type);
2994 	sprintf(card->longname, "%s %i",
2995 			card->shortname, adapter_index);
2996 	err = snd_card_register(card);
2997 
2998 	if (!err) {
2999 		dev++;
3000 		return 0;
3001 	}
3002 __nodev:
3003 	snd_card_free(card);
3004 	dev_err(&pci_dev->dev, "snd_asihpi_probe error %d\n", err);
3005 	return err;
3006 
3007 }
3008 
3009 static void snd_asihpi_remove(struct pci_dev *pci_dev)
3010 {
3011 	struct hpi_adapter *hpi = pci_get_drvdata(pci_dev);
3012 	struct snd_card_asihpi *asihpi = hpi->snd_card->private_data;
3013 
3014 	/* Stop interrupts */
3015 	if (hpi->interrupt_mode) {
3016 		hpi->interrupt_callback = NULL;
3017 		hpi_handle_error(hpi_adapter_set_property(hpi->adapter->index,
3018 			HPI_ADAPTER_PROPERTY_IRQ_RATE, 0, 0));
3019 		tasklet_kill(&asihpi->t);
3020 	}
3021 
3022 	snd_card_free(hpi->snd_card);
3023 	hpi->snd_card = NULL;
3024 	asihpi_adapter_remove(pci_dev);
3025 }
3026 
3027 static const struct pci_device_id asihpi_pci_tbl[] = {
3028 	{HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_DSP6205,
3029 		HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
3030 		(kernel_ulong_t)HPI_6205},
3031 	{HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_PCI2040,
3032 		HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
3033 		(kernel_ulong_t)HPI_6000},
3034 	{0,}
3035 };
3036 MODULE_DEVICE_TABLE(pci, asihpi_pci_tbl);
3037 
3038 static struct pci_driver driver = {
3039 	.name = KBUILD_MODNAME,
3040 	.id_table = asihpi_pci_tbl,
3041 	.probe = snd_asihpi_probe,
3042 	.remove = snd_asihpi_remove,
3043 };
3044 
3045 static int __init snd_asihpi_init(void)
3046 {
3047 	asihpi_init();
3048 	return pci_register_driver(&driver);
3049 }
3050 
3051 static void __exit snd_asihpi_exit(void)
3052 {
3053 
3054 	pci_unregister_driver(&driver);
3055 	asihpi_exit();
3056 }
3057 
3058 module_init(snd_asihpi_init)
3059 module_exit(snd_asihpi_exit)
3060 
3061