xref: /linux/sound/usb/usx2y/usx2yhwdeppcm.c (revision 3a38ef2b3cb6b63c105247b5ea4a9cf600e673f0)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  */
4 
5 /* USX2Y "rawusb" aka hwdep_pcm implementation
6 
7  Its usb's unableness to atomically handle power of 2 period sized data chuncs
8  at standard samplerates,
9  what led to this part of the usx2y module:
10  It provides the alsa kernel half of the usx2y-alsa-jack driver pair.
11  The pair uses a hardware dependent alsa-device for mmaped pcm transport.
12  Advantage achieved:
13          The usb_hc moves pcm data from/into memory via DMA.
14          That memory is mmaped by jack's usx2y driver.
15          Jack's usx2y driver is the first/last to read/write pcm data.
16          Read/write is a combination of power of 2 period shaping and
17          float/int conversation.
18          Compared to mainline alsa/jack we leave out power of 2 period shaping inside
19          snd-usb-usx2y which needs memcpy() and additional buffers.
20          As a side effect possible unwanted pcm-data coruption resulting of
21          standard alsa's snd-usb-usx2y period shaping scheme falls away.
22          Result is sane jack operation at buffering schemes down to 128frames,
23          2 periods.
24          plain usx2y alsa mode is able to achieve 64frames, 4periods, but only at the
25          cost of easier triggered i.e. aeolus xruns (128 or 256frames,
26          2periods works but is useless cause of crackling).
27 
28  This is a first "proof of concept" implementation.
29  Later, functionalities should migrate to more appropriate places:
30  Userland:
31  - The jackd could mmap its float-pcm buffers directly from alsa-lib.
32  - alsa-lib could provide power of 2 period sized shaping combined with int/float
33    conversation.
34    Currently the usx2y jack driver provides above 2 services.
35  Kernel:
36  - rawusb dma pcm buffer transport should go to snd-usb-lib, so also snd-usb-audio
37    devices can use it.
38    Currently rawusb dma pcm buffer transport (this file) is only available to snd-usb-usx2y.
39 */
40 
41 #include <linux/delay.h>
42 #include <linux/gfp.h>
43 #include "usbusx2yaudio.c"
44 
45 #if defined(USX2Y_NRPACKS_VARIABLE) || USX2Y_NRPACKS == 1
46 
47 #include <sound/hwdep.h>
48 
49 static int usx2y_usbpcm_urb_capt_retire(struct snd_usx2y_substream *subs)
50 {
51 	struct urb	*urb = subs->completed_urb;
52 	struct snd_pcm_runtime *runtime = subs->pcm_substream->runtime;
53 	int		i, lens = 0, hwptr_done = subs->hwptr_done;
54 	struct usx2ydev	*usx2y = subs->usx2y;
55 	int head;
56 
57 	if (usx2y->hwdep_pcm_shm->capture_iso_start < 0) { //FIXME
58 		head = usx2y->hwdep_pcm_shm->captured_iso_head + 1;
59 		if (head >= ARRAY_SIZE(usx2y->hwdep_pcm_shm->captured_iso))
60 			head = 0;
61 		usx2y->hwdep_pcm_shm->capture_iso_start = head;
62 		snd_printdd("cap start %i\n", head);
63 	}
64 	for (i = 0; i < nr_of_packs(); i++) {
65 		if (urb->iso_frame_desc[i].status) { /* active? hmm, skip this */
66 			snd_printk(KERN_ERR
67 				   "active frame status %i. Most probably some hardware problem.\n",
68 				   urb->iso_frame_desc[i].status);
69 			return urb->iso_frame_desc[i].status;
70 		}
71 		lens += urb->iso_frame_desc[i].actual_length / usx2y->stride;
72 	}
73 	hwptr_done += lens;
74 	if (hwptr_done >= runtime->buffer_size)
75 		hwptr_done -= runtime->buffer_size;
76 	subs->hwptr_done = hwptr_done;
77 	subs->transfer_done += lens;
78 	/* update the pointer, call callback if necessary */
79 	if (subs->transfer_done >= runtime->period_size) {
80 		subs->transfer_done -= runtime->period_size;
81 		snd_pcm_period_elapsed(subs->pcm_substream);
82 	}
83 	return 0;
84 }
85 
86 static int usx2y_iso_frames_per_buffer(struct snd_pcm_runtime *runtime,
87 					      struct usx2ydev *usx2y)
88 {
89 	return (runtime->buffer_size * 1000) / usx2y->rate + 1;	//FIXME: so far only correct period_size == 2^x ?
90 }
91 
92 /*
93  * prepare urb for playback data pipe
94  *
95  * we copy the data directly from the pcm buffer.
96  * the current position to be copied is held in hwptr field.
97  * since a urb can handle only a single linear buffer, if the total
98  * transferred area overflows the buffer boundary, we cannot send
99  * it directly from the buffer.  thus the data is once copied to
100  * a temporary buffer and urb points to that.
101  */
102 static int usx2y_hwdep_urb_play_prepare(struct snd_usx2y_substream *subs,
103 					struct urb *urb)
104 {
105 	int count, counts, pack;
106 	struct usx2ydev *usx2y = subs->usx2y;
107 	struct snd_usx2y_hwdep_pcm_shm *shm = usx2y->hwdep_pcm_shm;
108 	struct snd_pcm_runtime *runtime = subs->pcm_substream->runtime;
109 
110 	if (shm->playback_iso_start < 0) {
111 		shm->playback_iso_start = shm->captured_iso_head -
112 			usx2y_iso_frames_per_buffer(runtime, usx2y);
113 		if (shm->playback_iso_start < 0)
114 			shm->playback_iso_start += ARRAY_SIZE(shm->captured_iso);
115 		shm->playback_iso_head = shm->playback_iso_start;
116 	}
117 
118 	count = 0;
119 	for (pack = 0; pack < nr_of_packs(); pack++) {
120 		/* calculate the size of a packet */
121 		counts = shm->captured_iso[shm->playback_iso_head].length / usx2y->stride;
122 		if (counts < 43 || counts > 50) {
123 			snd_printk(KERN_ERR "should not be here with counts=%i\n", counts);
124 			return -EPIPE;
125 		}
126 		/* set up descriptor */
127 		urb->iso_frame_desc[pack].offset = shm->captured_iso[shm->playback_iso_head].offset;
128 		urb->iso_frame_desc[pack].length = shm->captured_iso[shm->playback_iso_head].length;
129 		if (atomic_read(&subs->state) != STATE_RUNNING)
130 			memset((char *)urb->transfer_buffer + urb->iso_frame_desc[pack].offset, 0,
131 			       urb->iso_frame_desc[pack].length);
132 		if (++shm->playback_iso_head >= ARRAY_SIZE(shm->captured_iso))
133 			shm->playback_iso_head = 0;
134 		count += counts;
135 	}
136 	urb->transfer_buffer_length = count * usx2y->stride;
137 	return 0;
138 }
139 
140 static void usx2y_usbpcm_urb_capt_iso_advance(struct snd_usx2y_substream *subs,
141 					      struct urb *urb)
142 {
143 	struct usb_iso_packet_descriptor *desc;
144 	struct snd_usx2y_hwdep_pcm_shm *shm;
145 	int pack, head;
146 
147 	for (pack = 0; pack < nr_of_packs(); ++pack) {
148 		desc = urb->iso_frame_desc + pack;
149 		if (subs) {
150 			shm = subs->usx2y->hwdep_pcm_shm;
151 			head = shm->captured_iso_head + 1;
152 			if (head >= ARRAY_SIZE(shm->captured_iso))
153 				head = 0;
154 			shm->captured_iso[head].frame = urb->start_frame + pack;
155 			shm->captured_iso[head].offset = desc->offset;
156 			shm->captured_iso[head].length = desc->actual_length;
157 			shm->captured_iso_head = head;
158 			shm->captured_iso_frames++;
159 		}
160 		desc->offset += desc->length * NRURBS * nr_of_packs();
161 		if (desc->offset + desc->length >= SSS)
162 			desc->offset -= (SSS - desc->length);
163 	}
164 }
165 
166 static int usx2y_usbpcm_usbframe_complete(struct snd_usx2y_substream *capsubs,
167 					  struct snd_usx2y_substream *capsubs2,
168 					  struct snd_usx2y_substream *playbacksubs,
169 					  int frame)
170 {
171 	int err, state;
172 	struct urb *urb = playbacksubs->completed_urb;
173 
174 	state = atomic_read(&playbacksubs->state);
175 	if (urb) {
176 		if (state == STATE_RUNNING)
177 			usx2y_urb_play_retire(playbacksubs, urb);
178 		else if (state >= STATE_PRERUNNING)
179 			atomic_inc(&playbacksubs->state);
180 	} else {
181 		switch (state) {
182 		case STATE_STARTING1:
183 			urb = playbacksubs->urb[0];
184 			atomic_inc(&playbacksubs->state);
185 			break;
186 		case STATE_STARTING2:
187 			urb = playbacksubs->urb[1];
188 			atomic_inc(&playbacksubs->state);
189 			break;
190 		}
191 	}
192 	if (urb) {
193 		err = usx2y_hwdep_urb_play_prepare(playbacksubs, urb);
194 		if (err)
195 			return err;
196 		err = usx2y_hwdep_urb_play_prepare(playbacksubs, urb);
197 		if (err)
198 			return err;
199 	}
200 
201 	playbacksubs->completed_urb = NULL;
202 
203 	state = atomic_read(&capsubs->state);
204 	if (state >= STATE_PREPARED) {
205 		if (state == STATE_RUNNING) {
206 			err = usx2y_usbpcm_urb_capt_retire(capsubs);
207 			if (err)
208 				return err;
209 		} else if (state >= STATE_PRERUNNING) {
210 			atomic_inc(&capsubs->state);
211 		}
212 		usx2y_usbpcm_urb_capt_iso_advance(capsubs, capsubs->completed_urb);
213 		if (capsubs2)
214 			usx2y_usbpcm_urb_capt_iso_advance(NULL, capsubs2->completed_urb);
215 		err = usx2y_urb_submit(capsubs, capsubs->completed_urb, frame);
216 		if (err)
217 			return err;
218 		if (capsubs2) {
219 			err = usx2y_urb_submit(capsubs2, capsubs2->completed_urb, frame);
220 			if (err)
221 				return err;
222 		}
223 	}
224 	capsubs->completed_urb = NULL;
225 	if (capsubs2)
226 		capsubs2->completed_urb = NULL;
227 	return 0;
228 }
229 
230 static void i_usx2y_usbpcm_urb_complete(struct urb *urb)
231 {
232 	struct snd_usx2y_substream *subs = urb->context;
233 	struct usx2ydev *usx2y = subs->usx2y;
234 	struct snd_usx2y_substream *capsubs, *capsubs2, *playbacksubs;
235 
236 	if (unlikely(atomic_read(&subs->state) < STATE_PREPARED)) {
237 		snd_printdd("hcd_frame=%i ep=%i%s status=%i start_frame=%i\n",
238 			    usb_get_current_frame_number(usx2y->dev),
239 			    subs->endpoint, usb_pipein(urb->pipe) ? "in" : "out",
240 			    urb->status, urb->start_frame);
241 		return;
242 	}
243 	if (unlikely(urb->status)) {
244 		usx2y_error_urb_status(usx2y, subs, urb);
245 		return;
246 	}
247 
248 	subs->completed_urb = urb;
249 	capsubs = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
250 	capsubs2 = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
251 	playbacksubs = usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
252 	if (capsubs->completed_urb && atomic_read(&capsubs->state) >= STATE_PREPARED &&
253 	    (!capsubs2 || capsubs2->completed_urb) &&
254 	    (playbacksubs->completed_urb || atomic_read(&playbacksubs->state) < STATE_PREPARED)) {
255 		if (!usx2y_usbpcm_usbframe_complete(capsubs, capsubs2, playbacksubs, urb->start_frame)) {
256 			usx2y->wait_iso_frame += nr_of_packs();
257 		} else {
258 			snd_printdd("\n");
259 			usx2y_clients_stop(usx2y);
260 		}
261 	}
262 }
263 
264 static void usx2y_hwdep_urb_release(struct urb **urb)
265 {
266 	usb_kill_urb(*urb);
267 	usb_free_urb(*urb);
268 	*urb = NULL;
269 }
270 
271 /*
272  * release a substream
273  */
274 static void usx2y_usbpcm_urbs_release(struct snd_usx2y_substream *subs)
275 {
276 	int i;
277 
278 	snd_printdd("snd_usx2y_urbs_release() %i\n", subs->endpoint);
279 	for (i = 0; i < NRURBS; i++)
280 		usx2y_hwdep_urb_release(subs->urb + i);
281 }
282 
283 static void usx2y_usbpcm_subs_startup_finish(struct usx2ydev *usx2y)
284 {
285 	usx2y_urbs_set_complete(usx2y, i_usx2y_usbpcm_urb_complete);
286 	usx2y->prepare_subs = NULL;
287 }
288 
289 static void i_usx2y_usbpcm_subs_startup(struct urb *urb)
290 {
291 	struct snd_usx2y_substream *subs = urb->context;
292 	struct usx2ydev *usx2y = subs->usx2y;
293 	struct snd_usx2y_substream *prepare_subs = usx2y->prepare_subs;
294 	struct snd_usx2y_substream *cap_subs2;
295 
296 	if (prepare_subs &&
297 	    urb->start_frame == prepare_subs->urb[0]->start_frame) {
298 		atomic_inc(&prepare_subs->state);
299 		if (prepare_subs == usx2y->subs[SNDRV_PCM_STREAM_CAPTURE]) {
300 			cap_subs2 = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
301 			if (cap_subs2)
302 				atomic_inc(&cap_subs2->state);
303 		}
304 		usx2y_usbpcm_subs_startup_finish(usx2y);
305 		wake_up(&usx2y->prepare_wait_queue);
306 	}
307 
308 	i_usx2y_usbpcm_urb_complete(urb);
309 }
310 
311 /*
312  * initialize a substream's urbs
313  */
314 static int usx2y_usbpcm_urbs_allocate(struct snd_usx2y_substream *subs)
315 {
316 	int i;
317 	unsigned int pipe;
318 	int is_playback = subs == subs->usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
319 	struct usb_device *dev = subs->usx2y->dev;
320 	struct urb **purb;
321 
322 	pipe = is_playback ? usb_sndisocpipe(dev, subs->endpoint) :
323 			usb_rcvisocpipe(dev, subs->endpoint);
324 	subs->maxpacksize = usb_maxpacket(dev, pipe);
325 	if (!subs->maxpacksize)
326 		return -EINVAL;
327 
328 	/* allocate and initialize data urbs */
329 	for (i = 0; i < NRURBS; i++) {
330 		purb = subs->urb + i;
331 		if (*purb) {
332 			usb_kill_urb(*purb);
333 			continue;
334 		}
335 		*purb = usb_alloc_urb(nr_of_packs(), GFP_KERNEL);
336 		if (!*purb) {
337 			usx2y_usbpcm_urbs_release(subs);
338 			return -ENOMEM;
339 		}
340 		(*purb)->transfer_buffer = is_playback ?
341 			subs->usx2y->hwdep_pcm_shm->playback : (
342 				subs->endpoint == 0x8 ?
343 				subs->usx2y->hwdep_pcm_shm->capture0x8 :
344 				subs->usx2y->hwdep_pcm_shm->capture0xA);
345 
346 		(*purb)->dev = dev;
347 		(*purb)->pipe = pipe;
348 		(*purb)->number_of_packets = nr_of_packs();
349 		(*purb)->context = subs;
350 		(*purb)->interval = 1;
351 		(*purb)->complete = i_usx2y_usbpcm_subs_startup;
352 	}
353 	return 0;
354 }
355 
356 /*
357  * free the buffer
358  */
359 static int snd_usx2y_usbpcm_hw_free(struct snd_pcm_substream *substream)
360 {
361 	struct snd_pcm_runtime *runtime = substream->runtime;
362 	struct snd_usx2y_substream *subs = runtime->private_data;
363 	struct snd_usx2y_substream *cap_subs;
364 	struct snd_usx2y_substream *playback_subs;
365 	struct snd_usx2y_substream *cap_subs2;
366 
367 	mutex_lock(&subs->usx2y->pcm_mutex);
368 	snd_printdd("%s(%p)\n", __func__, substream);
369 
370 	cap_subs2 = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
371 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
372 		cap_subs = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
373 		atomic_set(&subs->state, STATE_STOPPED);
374 		usx2y_usbpcm_urbs_release(subs);
375 		if (!cap_subs->pcm_substream ||
376 		    !cap_subs->pcm_substream->runtime ||
377 		    cap_subs->pcm_substream->runtime->state < SNDRV_PCM_STATE_PREPARED) {
378 			atomic_set(&cap_subs->state, STATE_STOPPED);
379 			if (cap_subs2)
380 				atomic_set(&cap_subs2->state, STATE_STOPPED);
381 			usx2y_usbpcm_urbs_release(cap_subs);
382 			if (cap_subs2)
383 				usx2y_usbpcm_urbs_release(cap_subs2);
384 		}
385 	} else {
386 		playback_subs = subs->usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
387 		if (atomic_read(&playback_subs->state) < STATE_PREPARED) {
388 			atomic_set(&subs->state, STATE_STOPPED);
389 			if (cap_subs2)
390 				atomic_set(&cap_subs2->state, STATE_STOPPED);
391 			usx2y_usbpcm_urbs_release(subs);
392 			if (cap_subs2)
393 				usx2y_usbpcm_urbs_release(cap_subs2);
394 		}
395 	}
396 	mutex_unlock(&subs->usx2y->pcm_mutex);
397 	return 0;
398 }
399 
400 static void usx2y_usbpcm_subs_startup(struct snd_usx2y_substream *subs)
401 {
402 	struct usx2ydev *usx2y = subs->usx2y;
403 
404 	usx2y->prepare_subs = subs;
405 	subs->urb[0]->start_frame = -1;
406 	smp_wmb();	// Make sure above modifications are seen by i_usx2y_subs_startup()
407 	usx2y_urbs_set_complete(usx2y, i_usx2y_usbpcm_subs_startup);
408 }
409 
410 static int usx2y_usbpcm_urbs_start(struct snd_usx2y_substream *subs)
411 {
412 	int	p, u, err, stream = subs->pcm_substream->stream;
413 	struct usx2ydev *usx2y = subs->usx2y;
414 	struct urb *urb;
415 	unsigned long pack;
416 
417 	if (stream == SNDRV_PCM_STREAM_CAPTURE) {
418 		usx2y->hwdep_pcm_shm->captured_iso_head = -1;
419 		usx2y->hwdep_pcm_shm->captured_iso_frames = 0;
420 	}
421 
422 	for (p = 0; 3 >= (stream + p); p += 2) {
423 		struct snd_usx2y_substream *subs = usx2y->subs[stream + p];
424 		if (subs) {
425 			err = usx2y_usbpcm_urbs_allocate(subs);
426 			if (err < 0)
427 				return err;
428 			subs->completed_urb = NULL;
429 		}
430 	}
431 
432 	for (p = 0; p < 4; p++) {
433 		struct snd_usx2y_substream *subs = usx2y->subs[p];
434 
435 		if (subs && atomic_read(&subs->state) >= STATE_PREPARED)
436 			goto start;
437 	}
438 
439  start:
440 	usx2y_usbpcm_subs_startup(subs);
441 	for (u = 0; u < NRURBS; u++) {
442 		for (p = 0; 3 >= (stream + p); p += 2) {
443 			struct snd_usx2y_substream *subs = usx2y->subs[stream + p];
444 
445 			if (!subs)
446 				continue;
447 			urb = subs->urb[u];
448 			if (usb_pipein(urb->pipe)) {
449 				if (!u)
450 					atomic_set(&subs->state, STATE_STARTING3);
451 				urb->dev = usx2y->dev;
452 				for (pack = 0; pack < nr_of_packs(); pack++) {
453 					urb->iso_frame_desc[pack].offset = subs->maxpacksize * (pack + u * nr_of_packs());
454 					urb->iso_frame_desc[pack].length = subs->maxpacksize;
455 				}
456 				urb->transfer_buffer_length = subs->maxpacksize * nr_of_packs();
457 				err = usb_submit_urb(urb, GFP_KERNEL);
458 				if (err < 0) {
459 					snd_printk(KERN_ERR "cannot usb_submit_urb() for urb %d, err = %d\n", u, err);
460 					err = -EPIPE;
461 					goto cleanup;
462 				}  else {
463 					snd_printdd("%i\n", urb->start_frame);
464 					if (!u)
465 						usx2y->wait_iso_frame = urb->start_frame;
466 				}
467 				urb->transfer_flags = 0;
468 			} else {
469 				atomic_set(&subs->state, STATE_STARTING1);
470 				break;
471 			}
472 		}
473 	}
474 	err = 0;
475 	wait_event(usx2y->prepare_wait_queue, !usx2y->prepare_subs);
476 	if (atomic_read(&subs->state) != STATE_PREPARED)
477 		err = -EPIPE;
478 
479  cleanup:
480 	if (err) {
481 		usx2y_subs_startup_finish(usx2y);	// Call it now
482 		usx2y_clients_stop(usx2y);	// something is completely wrong > stop everything
483 	}
484 	return err;
485 }
486 
487 #define USX2Y_HWDEP_PCM_PAGES	\
488 	PAGE_ALIGN(sizeof(struct snd_usx2y_hwdep_pcm_shm))
489 
490 /*
491  * prepare callback
492  *
493  * set format and initialize urbs
494  */
495 static int snd_usx2y_usbpcm_prepare(struct snd_pcm_substream *substream)
496 {
497 	struct snd_pcm_runtime *runtime = substream->runtime;
498 	struct snd_usx2y_substream *subs = runtime->private_data;
499 	struct usx2ydev *usx2y = subs->usx2y;
500 	struct snd_usx2y_substream *capsubs = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
501 	int err = 0;
502 
503 	snd_printdd("snd_usx2y_pcm_prepare(%p)\n", substream);
504 
505 	mutex_lock(&usx2y->pcm_mutex);
506 
507 	if (!usx2y->hwdep_pcm_shm) {
508 		usx2y->hwdep_pcm_shm = alloc_pages_exact(USX2Y_HWDEP_PCM_PAGES,
509 							 GFP_KERNEL);
510 		if (!usx2y->hwdep_pcm_shm) {
511 			err = -ENOMEM;
512 			goto up_prepare_mutex;
513 		}
514 		memset(usx2y->hwdep_pcm_shm, 0, USX2Y_HWDEP_PCM_PAGES);
515 	}
516 
517 	usx2y_subs_prepare(subs);
518 	// Start hardware streams
519 	// SyncStream first....
520 	if (atomic_read(&capsubs->state) < STATE_PREPARED) {
521 		if (usx2y->format != runtime->format) {
522 			err = usx2y_format_set(usx2y, runtime->format);
523 			if (err < 0)
524 				goto up_prepare_mutex;
525 		}
526 		if (usx2y->rate != runtime->rate) {
527 			err = usx2y_rate_set(usx2y, runtime->rate);
528 			if (err < 0)
529 				goto up_prepare_mutex;
530 		}
531 		snd_printdd("starting capture pipe for %s\n", subs == capsubs ?
532 			    "self" : "playpipe");
533 		err = usx2y_usbpcm_urbs_start(capsubs);
534 		if (err < 0)
535 			goto up_prepare_mutex;
536 	}
537 
538 	if (subs != capsubs) {
539 		usx2y->hwdep_pcm_shm->playback_iso_start = -1;
540 		if (atomic_read(&subs->state) < STATE_PREPARED) {
541 			while (usx2y_iso_frames_per_buffer(runtime, usx2y) >
542 			       usx2y->hwdep_pcm_shm->captured_iso_frames) {
543 				snd_printdd("Wait: iso_frames_per_buffer=%i,captured_iso_frames=%i\n",
544 					    usx2y_iso_frames_per_buffer(runtime, usx2y),
545 					    usx2y->hwdep_pcm_shm->captured_iso_frames);
546 				if (msleep_interruptible(10)) {
547 					err = -ERESTARTSYS;
548 					goto up_prepare_mutex;
549 				}
550 			}
551 			err = usx2y_usbpcm_urbs_start(subs);
552 			if (err < 0)
553 				goto up_prepare_mutex;
554 		}
555 		snd_printdd("Ready: iso_frames_per_buffer=%i,captured_iso_frames=%i\n",
556 			    usx2y_iso_frames_per_buffer(runtime, usx2y),
557 			    usx2y->hwdep_pcm_shm->captured_iso_frames);
558 	} else {
559 		usx2y->hwdep_pcm_shm->capture_iso_start = -1;
560 	}
561 
562  up_prepare_mutex:
563 	mutex_unlock(&usx2y->pcm_mutex);
564 	return err;
565 }
566 
567 static const struct snd_pcm_hardware snd_usx2y_4c = {
568 	.info =			(SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
569 				 SNDRV_PCM_INFO_BLOCK_TRANSFER |
570 				 SNDRV_PCM_INFO_MMAP_VALID),
571 	.formats =                 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE,
572 	.rates =                   SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000,
573 	.rate_min =                44100,
574 	.rate_max =                48000,
575 	.channels_min =            2,
576 	.channels_max =            4,
577 	.buffer_bytes_max =	(2*128*1024),
578 	.period_bytes_min =	64,
579 	.period_bytes_max =	(128*1024),
580 	.periods_min =		2,
581 	.periods_max =		1024,
582 	.fifo_size =              0
583 };
584 
585 static int snd_usx2y_usbpcm_open(struct snd_pcm_substream *substream)
586 {
587 	struct snd_usx2y_substream	*subs =
588 		((struct snd_usx2y_substream **)
589 		 snd_pcm_substream_chip(substream))[substream->stream];
590 	struct snd_pcm_runtime	*runtime = substream->runtime;
591 
592 	if (!(subs->usx2y->chip_status & USX2Y_STAT_CHIP_MMAP_PCM_URBS))
593 		return -EBUSY;
594 
595 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
596 		runtime->hw = snd_usx2y_2c;
597 	else
598 		runtime->hw = (subs->usx2y->subs[3] ? snd_usx2y_4c : snd_usx2y_2c);
599 	runtime->private_data = subs;
600 	subs->pcm_substream = substream;
601 	snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_TIME, 1000, 200000);
602 	return 0;
603 }
604 
605 static int snd_usx2y_usbpcm_close(struct snd_pcm_substream *substream)
606 {
607 	struct snd_pcm_runtime *runtime = substream->runtime;
608 	struct snd_usx2y_substream *subs = runtime->private_data;
609 
610 	subs->pcm_substream = NULL;
611 	return 0;
612 }
613 
614 static const struct snd_pcm_ops snd_usx2y_usbpcm_ops = {
615 	.open =		snd_usx2y_usbpcm_open,
616 	.close =	snd_usx2y_usbpcm_close,
617 	.hw_params =	snd_usx2y_pcm_hw_params,
618 	.hw_free =	snd_usx2y_usbpcm_hw_free,
619 	.prepare =	snd_usx2y_usbpcm_prepare,
620 	.trigger =	snd_usx2y_pcm_trigger,
621 	.pointer =	snd_usx2y_pcm_pointer,
622 };
623 
624 static int usx2y_pcms_busy_check(struct snd_card *card)
625 {
626 	struct usx2ydev	*dev = usx2y(card);
627 	struct snd_usx2y_substream *subs;
628 	int i;
629 
630 	for (i = 0; i < dev->pcm_devs * 2; i++) {
631 		subs = dev->subs[i];
632 		if (subs && subs->pcm_substream &&
633 		    SUBSTREAM_BUSY(subs->pcm_substream))
634 			return -EBUSY;
635 	}
636 	return 0;
637 }
638 
639 static int snd_usx2y_hwdep_pcm_open(struct snd_hwdep *hw, struct file *file)
640 {
641 	struct snd_card *card = hw->card;
642 	int err;
643 
644 	mutex_lock(&usx2y(card)->pcm_mutex);
645 	err = usx2y_pcms_busy_check(card);
646 	if (!err)
647 		usx2y(card)->chip_status |= USX2Y_STAT_CHIP_MMAP_PCM_URBS;
648 	mutex_unlock(&usx2y(card)->pcm_mutex);
649 	return err;
650 }
651 
652 static int snd_usx2y_hwdep_pcm_release(struct snd_hwdep *hw, struct file *file)
653 {
654 	struct snd_card *card = hw->card;
655 	int err;
656 
657 	mutex_lock(&usx2y(card)->pcm_mutex);
658 	err = usx2y_pcms_busy_check(card);
659 	if (!err)
660 		usx2y(hw->card)->chip_status &= ~USX2Y_STAT_CHIP_MMAP_PCM_URBS;
661 	mutex_unlock(&usx2y(card)->pcm_mutex);
662 	return err;
663 }
664 
665 static void snd_usx2y_hwdep_pcm_vm_open(struct vm_area_struct *area)
666 {
667 }
668 
669 static void snd_usx2y_hwdep_pcm_vm_close(struct vm_area_struct *area)
670 {
671 }
672 
673 static vm_fault_t snd_usx2y_hwdep_pcm_vm_fault(struct vm_fault *vmf)
674 {
675 	unsigned long offset;
676 	void *vaddr;
677 
678 	offset = vmf->pgoff << PAGE_SHIFT;
679 	vaddr = (char *)((struct usx2ydev *)vmf->vma->vm_private_data)->hwdep_pcm_shm + offset;
680 	vmf->page = virt_to_page(vaddr);
681 	get_page(vmf->page);
682 	return 0;
683 }
684 
685 static const struct vm_operations_struct snd_usx2y_hwdep_pcm_vm_ops = {
686 	.open = snd_usx2y_hwdep_pcm_vm_open,
687 	.close = snd_usx2y_hwdep_pcm_vm_close,
688 	.fault = snd_usx2y_hwdep_pcm_vm_fault,
689 };
690 
691 static int snd_usx2y_hwdep_pcm_mmap(struct snd_hwdep *hw, struct file *filp, struct vm_area_struct *area)
692 {
693 	unsigned long	size = (unsigned long)(area->vm_end - area->vm_start);
694 	struct usx2ydev	*usx2y = hw->private_data;
695 
696 	if (!(usx2y->chip_status & USX2Y_STAT_CHIP_INIT))
697 		return -EBUSY;
698 
699 	/* if userspace tries to mmap beyond end of our buffer, fail */
700 	if (size > USX2Y_HWDEP_PCM_PAGES) {
701 		snd_printd("%lu > %lu\n", size, (unsigned long)USX2Y_HWDEP_PCM_PAGES);
702 		return -EINVAL;
703 	}
704 
705 	if (!usx2y->hwdep_pcm_shm)
706 		return -ENODEV;
707 
708 	area->vm_ops = &snd_usx2y_hwdep_pcm_vm_ops;
709 	area->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP;
710 	area->vm_private_data = hw->private_data;
711 	return 0;
712 }
713 
714 static void snd_usx2y_hwdep_pcm_private_free(struct snd_hwdep *hwdep)
715 {
716 	struct usx2ydev *usx2y = hwdep->private_data;
717 
718 	if (usx2y->hwdep_pcm_shm)
719 		free_pages_exact(usx2y->hwdep_pcm_shm, USX2Y_HWDEP_PCM_PAGES);
720 }
721 
722 int usx2y_hwdep_pcm_new(struct snd_card *card)
723 {
724 	int err;
725 	struct snd_hwdep *hw;
726 	struct snd_pcm *pcm;
727 	struct usb_device *dev = usx2y(card)->dev;
728 
729 	if (nr_of_packs() != 1)
730 		return 0;
731 
732 	err = snd_hwdep_new(card, SND_USX2Y_USBPCM_ID, 1, &hw);
733 	if (err < 0)
734 		return err;
735 
736 	hw->iface = SNDRV_HWDEP_IFACE_USX2Y_PCM;
737 	hw->private_data = usx2y(card);
738 	hw->private_free = snd_usx2y_hwdep_pcm_private_free;
739 	hw->ops.open = snd_usx2y_hwdep_pcm_open;
740 	hw->ops.release = snd_usx2y_hwdep_pcm_release;
741 	hw->ops.mmap = snd_usx2y_hwdep_pcm_mmap;
742 	hw->exclusive = 1;
743 	sprintf(hw->name, "/dev/bus/usb/%03d/%03d/hwdeppcm", dev->bus->busnum, dev->devnum);
744 
745 	err = snd_pcm_new(card, NAME_ALLCAPS" hwdep Audio", 2, 1, 1, &pcm);
746 	if (err < 0)
747 		return err;
748 
749 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_usx2y_usbpcm_ops);
750 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_usx2y_usbpcm_ops);
751 
752 	pcm->private_data = usx2y(card)->subs;
753 	pcm->info_flags = 0;
754 
755 	sprintf(pcm->name, NAME_ALLCAPS" hwdep Audio");
756 	snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
757 				   SNDRV_DMA_TYPE_CONTINUOUS,
758 				   NULL,
759 				   64*1024, 128*1024);
760 	snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
761 				   SNDRV_DMA_TYPE_CONTINUOUS,
762 				   NULL,
763 				   64*1024, 128*1024);
764 
765 	return 0;
766 }
767 
768 #else
769 
770 int usx2y_hwdep_pcm_new(struct snd_card *card)
771 {
772 	return 0;
773 }
774 
775 #endif
776