776 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			776 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  */
 | |
| 
 | |
| /* USX2Y "rawusb" aka hwdep_pcm implementation
 | |
| 
 | |
|  Its usb's unableness to atomically handle power of 2 period sized data chuncs
 | |
|  at standard samplerates,
 | |
|  what led to this part of the usx2y module:
 | |
|  It provides the alsa kernel half of the usx2y-alsa-jack driver pair.
 | |
|  The pair uses a hardware dependent alsa-device for mmaped pcm transport.
 | |
|  Advantage achieved:
 | |
|          The usb_hc moves pcm data from/into memory via DMA.
 | |
|          That memory is mmaped by jack's usx2y driver.
 | |
|          Jack's usx2y driver is the first/last to read/write pcm data.
 | |
|          Read/write is a combination of power of 2 period shaping and
 | |
|          float/int conversation.
 | |
|          Compared to mainline alsa/jack we leave out power of 2 period shaping inside
 | |
|          snd-usb-usx2y which needs memcpy() and additional buffers.
 | |
|          As a side effect possible unwanted pcm-data coruption resulting of
 | |
|          standard alsa's snd-usb-usx2y period shaping scheme falls away.
 | |
|          Result is sane jack operation at buffering schemes down to 128frames,
 | |
|          2 periods.
 | |
|          plain usx2y alsa mode is able to achieve 64frames, 4periods, but only at the
 | |
|          cost of easier triggered i.e. aeolus xruns (128 or 256frames,
 | |
|          2periods works but is useless cause of crackling).
 | |
| 
 | |
|  This is a first "proof of concept" implementation.
 | |
|  Later, functionalities should migrate to more appropriate places:
 | |
|  Userland:
 | |
|  - The jackd could mmap its float-pcm buffers directly from alsa-lib.
 | |
|  - alsa-lib could provide power of 2 period sized shaping combined with int/float
 | |
|    conversation.
 | |
|    Currently the usx2y jack driver provides above 2 services.
 | |
|  Kernel:
 | |
|  - rawusb dma pcm buffer transport should go to snd-usb-lib, so also snd-usb-audio
 | |
|    devices can use it.
 | |
|    Currently rawusb dma pcm buffer transport (this file) is only available to snd-usb-usx2y.
 | |
| */
 | |
| 
 | |
| #include <linux/delay.h>
 | |
| #include <linux/gfp.h>
 | |
| #include "usbusx2yaudio.c"
 | |
| 
 | |
| #if defined(USX2Y_NRPACKS_VARIABLE) || USX2Y_NRPACKS == 1
 | |
| 
 | |
| #include <sound/hwdep.h>
 | |
| 
 | |
| static int usx2y_usbpcm_urb_capt_retire(struct snd_usx2y_substream *subs)
 | |
| {
 | |
| 	struct urb	*urb = subs->completed_urb;
 | |
| 	struct snd_pcm_runtime *runtime = subs->pcm_substream->runtime;
 | |
| 	int		i, lens = 0, hwptr_done = subs->hwptr_done;
 | |
| 	struct usx2ydev	*usx2y = subs->usx2y;
 | |
| 	int head;
 | |
| 
 | |
| 	if (usx2y->hwdep_pcm_shm->capture_iso_start < 0) { //FIXME
 | |
| 		head = usx2y->hwdep_pcm_shm->captured_iso_head + 1;
 | |
| 		if (head >= ARRAY_SIZE(usx2y->hwdep_pcm_shm->captured_iso))
 | |
| 			head = 0;
 | |
| 		usx2y->hwdep_pcm_shm->capture_iso_start = head;
 | |
| 		snd_printdd("cap start %i\n", head);
 | |
| 	}
 | |
| 	for (i = 0; i < nr_of_packs(); i++) {
 | |
| 		if (urb->iso_frame_desc[i].status) { /* active? hmm, skip this */
 | |
| 			snd_printk(KERN_ERR
 | |
| 				   "active frame status %i. Most probably some hardware problem.\n",
 | |
| 				   urb->iso_frame_desc[i].status);
 | |
| 			return urb->iso_frame_desc[i].status;
 | |
| 		}
 | |
| 		lens += urb->iso_frame_desc[i].actual_length / usx2y->stride;
 | |
| 	}
 | |
| 	hwptr_done += lens;
 | |
| 	if (hwptr_done >= runtime->buffer_size)
 | |
| 		hwptr_done -= runtime->buffer_size;
 | |
| 	subs->hwptr_done = hwptr_done;
 | |
| 	subs->transfer_done += lens;
 | |
| 	/* update the pointer, call callback if necessary */
 | |
| 	if (subs->transfer_done >= runtime->period_size) {
 | |
| 		subs->transfer_done -= runtime->period_size;
 | |
| 		snd_pcm_period_elapsed(subs->pcm_substream);
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int usx2y_iso_frames_per_buffer(struct snd_pcm_runtime *runtime,
 | |
| 					      struct usx2ydev *usx2y)
 | |
| {
 | |
| 	return (runtime->buffer_size * 1000) / usx2y->rate + 1;	//FIXME: so far only correct period_size == 2^x ?
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * prepare urb for playback data pipe
 | |
|  *
 | |
|  * we copy the data directly from the pcm buffer.
 | |
|  * the current position to be copied is held in hwptr field.
 | |
|  * since a urb can handle only a single linear buffer, if the total
 | |
|  * transferred area overflows the buffer boundary, we cannot send
 | |
|  * it directly from the buffer.  thus the data is once copied to
 | |
|  * a temporary buffer and urb points to that.
 | |
|  */
 | |
| static int usx2y_hwdep_urb_play_prepare(struct snd_usx2y_substream *subs,
 | |
| 					struct urb *urb)
 | |
| {
 | |
| 	int count, counts, pack;
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 	struct snd_usx2y_hwdep_pcm_shm *shm = usx2y->hwdep_pcm_shm;
 | |
| 	struct snd_pcm_runtime *runtime = subs->pcm_substream->runtime;
 | |
| 
 | |
| 	if (shm->playback_iso_start < 0) {
 | |
| 		shm->playback_iso_start = shm->captured_iso_head -
 | |
| 			usx2y_iso_frames_per_buffer(runtime, usx2y);
 | |
| 		if (shm->playback_iso_start < 0)
 | |
| 			shm->playback_iso_start += ARRAY_SIZE(shm->captured_iso);
 | |
| 		shm->playback_iso_head = shm->playback_iso_start;
 | |
| 	}
 | |
| 
 | |
| 	count = 0;
 | |
| 	for (pack = 0; pack < nr_of_packs(); pack++) {
 | |
| 		/* calculate the size of a packet */
 | |
| 		counts = shm->captured_iso[shm->playback_iso_head].length / usx2y->stride;
 | |
| 		if (counts < 43 || counts > 50) {
 | |
| 			snd_printk(KERN_ERR "should not be here with counts=%i\n", counts);
 | |
| 			return -EPIPE;
 | |
| 		}
 | |
| 		/* set up descriptor */
 | |
| 		urb->iso_frame_desc[pack].offset = shm->captured_iso[shm->playback_iso_head].offset;
 | |
| 		urb->iso_frame_desc[pack].length = shm->captured_iso[shm->playback_iso_head].length;
 | |
| 		if (atomic_read(&subs->state) != STATE_RUNNING)
 | |
| 			memset((char *)urb->transfer_buffer + urb->iso_frame_desc[pack].offset, 0,
 | |
| 			       urb->iso_frame_desc[pack].length);
 | |
| 		if (++shm->playback_iso_head >= ARRAY_SIZE(shm->captured_iso))
 | |
| 			shm->playback_iso_head = 0;
 | |
| 		count += counts;
 | |
| 	}
 | |
| 	urb->transfer_buffer_length = count * usx2y->stride;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void usx2y_usbpcm_urb_capt_iso_advance(struct snd_usx2y_substream *subs,
 | |
| 					      struct urb *urb)
 | |
| {
 | |
| 	struct usb_iso_packet_descriptor *desc;
 | |
| 	struct snd_usx2y_hwdep_pcm_shm *shm;
 | |
| 	int pack, head;
 | |
| 
 | |
| 	for (pack = 0; pack < nr_of_packs(); ++pack) {
 | |
| 		desc = urb->iso_frame_desc + pack;
 | |
| 		if (subs) {
 | |
| 			shm = subs->usx2y->hwdep_pcm_shm;
 | |
| 			head = shm->captured_iso_head + 1;
 | |
| 			if (head >= ARRAY_SIZE(shm->captured_iso))
 | |
| 				head = 0;
 | |
| 			shm->captured_iso[head].frame = urb->start_frame + pack;
 | |
| 			shm->captured_iso[head].offset = desc->offset;
 | |
| 			shm->captured_iso[head].length = desc->actual_length;
 | |
| 			shm->captured_iso_head = head;
 | |
| 			shm->captured_iso_frames++;
 | |
| 		}
 | |
| 		desc->offset += desc->length * NRURBS * nr_of_packs();
 | |
| 		if (desc->offset + desc->length >= SSS)
 | |
| 			desc->offset -= (SSS - desc->length);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int usx2y_usbpcm_usbframe_complete(struct snd_usx2y_substream *capsubs,
 | |
| 					  struct snd_usx2y_substream *capsubs2,
 | |
| 					  struct snd_usx2y_substream *playbacksubs,
 | |
| 					  int frame)
 | |
| {
 | |
| 	int err, state;
 | |
| 	struct urb *urb = playbacksubs->completed_urb;
 | |
| 
 | |
| 	state = atomic_read(&playbacksubs->state);
 | |
| 	if (urb) {
 | |
| 		if (state == STATE_RUNNING)
 | |
| 			usx2y_urb_play_retire(playbacksubs, urb);
 | |
| 		else if (state >= STATE_PRERUNNING)
 | |
| 			atomic_inc(&playbacksubs->state);
 | |
| 	} else {
 | |
| 		switch (state) {
 | |
| 		case STATE_STARTING1:
 | |
| 			urb = playbacksubs->urb[0];
 | |
| 			atomic_inc(&playbacksubs->state);
 | |
| 			break;
 | |
| 		case STATE_STARTING2:
 | |
| 			urb = playbacksubs->urb[1];
 | |
| 			atomic_inc(&playbacksubs->state);
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 	if (urb) {
 | |
| 		err = usx2y_hwdep_urb_play_prepare(playbacksubs, urb);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		err = usx2y_hwdep_urb_play_prepare(playbacksubs, urb);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	playbacksubs->completed_urb = NULL;
 | |
| 
 | |
| 	state = atomic_read(&capsubs->state);
 | |
| 	if (state >= STATE_PREPARED) {
 | |
| 		if (state == STATE_RUNNING) {
 | |
| 			err = usx2y_usbpcm_urb_capt_retire(capsubs);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 		} else if (state >= STATE_PRERUNNING) {
 | |
| 			atomic_inc(&capsubs->state);
 | |
| 		}
 | |
| 		usx2y_usbpcm_urb_capt_iso_advance(capsubs, capsubs->completed_urb);
 | |
| 		if (capsubs2)
 | |
| 			usx2y_usbpcm_urb_capt_iso_advance(NULL, capsubs2->completed_urb);
 | |
| 		err = usx2y_urb_submit(capsubs, capsubs->completed_urb, frame);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		if (capsubs2) {
 | |
| 			err = usx2y_urb_submit(capsubs2, capsubs2->completed_urb, frame);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 		}
 | |
| 	}
 | |
| 	capsubs->completed_urb = NULL;
 | |
| 	if (capsubs2)
 | |
| 		capsubs2->completed_urb = NULL;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void i_usx2y_usbpcm_urb_complete(struct urb *urb)
 | |
| {
 | |
| 	struct snd_usx2y_substream *subs = urb->context;
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 	struct snd_usx2y_substream *capsubs, *capsubs2, *playbacksubs;
 | |
| 
 | |
| 	if (unlikely(atomic_read(&subs->state) < STATE_PREPARED)) {
 | |
| 		snd_printdd("hcd_frame=%i ep=%i%s status=%i start_frame=%i\n",
 | |
| 			    usb_get_current_frame_number(usx2y->dev),
 | |
| 			    subs->endpoint, usb_pipein(urb->pipe) ? "in" : "out",
 | |
| 			    urb->status, urb->start_frame);
 | |
| 		return;
 | |
| 	}
 | |
| 	if (unlikely(urb->status)) {
 | |
| 		usx2y_error_urb_status(usx2y, subs, urb);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	subs->completed_urb = urb;
 | |
| 	capsubs = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
 | |
| 	capsubs2 = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
 | |
| 	playbacksubs = usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
 | |
| 	if (capsubs->completed_urb && atomic_read(&capsubs->state) >= STATE_PREPARED &&
 | |
| 	    (!capsubs2 || capsubs2->completed_urb) &&
 | |
| 	    (playbacksubs->completed_urb || atomic_read(&playbacksubs->state) < STATE_PREPARED)) {
 | |
| 		if (!usx2y_usbpcm_usbframe_complete(capsubs, capsubs2, playbacksubs, urb->start_frame)) {
 | |
| 			usx2y->wait_iso_frame += nr_of_packs();
 | |
| 		} else {
 | |
| 			snd_printdd("\n");
 | |
| 			usx2y_clients_stop(usx2y);
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void usx2y_hwdep_urb_release(struct urb **urb)
 | |
| {
 | |
| 	usb_kill_urb(*urb);
 | |
| 	usb_free_urb(*urb);
 | |
| 	*urb = NULL;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * release a substream
 | |
|  */
 | |
| static void usx2y_usbpcm_urbs_release(struct snd_usx2y_substream *subs)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	snd_printdd("snd_usx2y_urbs_release() %i\n", subs->endpoint);
 | |
| 	for (i = 0; i < NRURBS; i++)
 | |
| 		usx2y_hwdep_urb_release(subs->urb + i);
 | |
| }
 | |
| 
 | |
| static void usx2y_usbpcm_subs_startup_finish(struct usx2ydev *usx2y)
 | |
| {
 | |
| 	usx2y_urbs_set_complete(usx2y, i_usx2y_usbpcm_urb_complete);
 | |
| 	usx2y->prepare_subs = NULL;
 | |
| }
 | |
| 
 | |
| static void i_usx2y_usbpcm_subs_startup(struct urb *urb)
 | |
| {
 | |
| 	struct snd_usx2y_substream *subs = urb->context;
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 	struct snd_usx2y_substream *prepare_subs = usx2y->prepare_subs;
 | |
| 	struct snd_usx2y_substream *cap_subs2;
 | |
| 
 | |
| 	if (prepare_subs &&
 | |
| 	    urb->start_frame == prepare_subs->urb[0]->start_frame) {
 | |
| 		atomic_inc(&prepare_subs->state);
 | |
| 		if (prepare_subs == usx2y->subs[SNDRV_PCM_STREAM_CAPTURE]) {
 | |
| 			cap_subs2 = usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
 | |
| 			if (cap_subs2)
 | |
| 				atomic_inc(&cap_subs2->state);
 | |
| 		}
 | |
| 		usx2y_usbpcm_subs_startup_finish(usx2y);
 | |
| 		wake_up(&usx2y->prepare_wait_queue);
 | |
| 	}
 | |
| 
 | |
| 	i_usx2y_usbpcm_urb_complete(urb);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * initialize a substream's urbs
 | |
|  */
 | |
| static int usx2y_usbpcm_urbs_allocate(struct snd_usx2y_substream *subs)
 | |
| {
 | |
| 	int i;
 | |
| 	unsigned int pipe;
 | |
| 	int is_playback = subs == subs->usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
 | |
| 	struct usb_device *dev = subs->usx2y->dev;
 | |
| 	struct urb **purb;
 | |
| 
 | |
| 	pipe = is_playback ? usb_sndisocpipe(dev, subs->endpoint) :
 | |
| 			usb_rcvisocpipe(dev, subs->endpoint);
 | |
| 	subs->maxpacksize = usb_maxpacket(dev, pipe);
 | |
| 	if (!subs->maxpacksize)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	/* allocate and initialize data urbs */
 | |
| 	for (i = 0; i < NRURBS; i++) {
 | |
| 		purb = subs->urb + i;
 | |
| 		if (*purb) {
 | |
| 			usb_kill_urb(*purb);
 | |
| 			continue;
 | |
| 		}
 | |
| 		*purb = usb_alloc_urb(nr_of_packs(), GFP_KERNEL);
 | |
| 		if (!*purb) {
 | |
| 			usx2y_usbpcm_urbs_release(subs);
 | |
| 			return -ENOMEM;
 | |
| 		}
 | |
| 		(*purb)->transfer_buffer = is_playback ?
 | |
| 			subs->usx2y->hwdep_pcm_shm->playback : (
 | |
| 				subs->endpoint == 0x8 ?
 | |
| 				subs->usx2y->hwdep_pcm_shm->capture0x8 :
 | |
| 				subs->usx2y->hwdep_pcm_shm->capture0xA);
 | |
| 
 | |
| 		(*purb)->dev = dev;
 | |
| 		(*purb)->pipe = pipe;
 | |
| 		(*purb)->number_of_packets = nr_of_packs();
 | |
| 		(*purb)->context = subs;
 | |
| 		(*purb)->interval = 1;
 | |
| 		(*purb)->complete = i_usx2y_usbpcm_subs_startup;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * free the buffer
 | |
|  */
 | |
| static int snd_usx2y_usbpcm_hw_free(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	struct snd_usx2y_substream *subs = runtime->private_data;
 | |
| 	struct snd_usx2y_substream *cap_subs;
 | |
| 	struct snd_usx2y_substream *playback_subs;
 | |
| 	struct snd_usx2y_substream *cap_subs2;
 | |
| 
 | |
| 	mutex_lock(&subs->usx2y->pcm_mutex);
 | |
| 	snd_printdd("%s(%p)\n", __func__, substream);
 | |
| 
 | |
| 	cap_subs2 = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
 | |
| 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 | |
| 		cap_subs = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
 | |
| 		atomic_set(&subs->state, STATE_STOPPED);
 | |
| 		usx2y_usbpcm_urbs_release(subs);
 | |
| 		if (!cap_subs->pcm_substream ||
 | |
| 		    !cap_subs->pcm_substream->runtime ||
 | |
| 		    cap_subs->pcm_substream->runtime->state < SNDRV_PCM_STATE_PREPARED) {
 | |
| 			atomic_set(&cap_subs->state, STATE_STOPPED);
 | |
| 			if (cap_subs2)
 | |
| 				atomic_set(&cap_subs2->state, STATE_STOPPED);
 | |
| 			usx2y_usbpcm_urbs_release(cap_subs);
 | |
| 			if (cap_subs2)
 | |
| 				usx2y_usbpcm_urbs_release(cap_subs2);
 | |
| 		}
 | |
| 	} else {
 | |
| 		playback_subs = subs->usx2y->subs[SNDRV_PCM_STREAM_PLAYBACK];
 | |
| 		if (atomic_read(&playback_subs->state) < STATE_PREPARED) {
 | |
| 			atomic_set(&subs->state, STATE_STOPPED);
 | |
| 			if (cap_subs2)
 | |
| 				atomic_set(&cap_subs2->state, STATE_STOPPED);
 | |
| 			usx2y_usbpcm_urbs_release(subs);
 | |
| 			if (cap_subs2)
 | |
| 				usx2y_usbpcm_urbs_release(cap_subs2);
 | |
| 		}
 | |
| 	}
 | |
| 	mutex_unlock(&subs->usx2y->pcm_mutex);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void usx2y_usbpcm_subs_startup(struct snd_usx2y_substream *subs)
 | |
| {
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 
 | |
| 	usx2y->prepare_subs = subs;
 | |
| 	subs->urb[0]->start_frame = -1;
 | |
| 	smp_wmb();	// Make sure above modifications are seen by i_usx2y_subs_startup()
 | |
| 	usx2y_urbs_set_complete(usx2y, i_usx2y_usbpcm_subs_startup);
 | |
| }
 | |
| 
 | |
| static int usx2y_usbpcm_urbs_start(struct snd_usx2y_substream *subs)
 | |
| {
 | |
| 	int	p, u, err, stream = subs->pcm_substream->stream;
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 	struct urb *urb;
 | |
| 	unsigned long pack;
 | |
| 
 | |
| 	if (stream == SNDRV_PCM_STREAM_CAPTURE) {
 | |
| 		usx2y->hwdep_pcm_shm->captured_iso_head = -1;
 | |
| 		usx2y->hwdep_pcm_shm->captured_iso_frames = 0;
 | |
| 	}
 | |
| 
 | |
| 	for (p = 0; 3 >= (stream + p); p += 2) {
 | |
| 		struct snd_usx2y_substream *subs = usx2y->subs[stream + p];
 | |
| 		if (subs) {
 | |
| 			err = usx2y_usbpcm_urbs_allocate(subs);
 | |
| 			if (err < 0)
 | |
| 				return err;
 | |
| 			subs->completed_urb = NULL;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	for (p = 0; p < 4; p++) {
 | |
| 		struct snd_usx2y_substream *subs = usx2y->subs[p];
 | |
| 
 | |
| 		if (subs && atomic_read(&subs->state) >= STATE_PREPARED)
 | |
| 			goto start;
 | |
| 	}
 | |
| 
 | |
|  start:
 | |
| 	usx2y_usbpcm_subs_startup(subs);
 | |
| 	for (u = 0; u < NRURBS; u++) {
 | |
| 		for (p = 0; 3 >= (stream + p); p += 2) {
 | |
| 			struct snd_usx2y_substream *subs = usx2y->subs[stream + p];
 | |
| 
 | |
| 			if (!subs)
 | |
| 				continue;
 | |
| 			urb = subs->urb[u];
 | |
| 			if (usb_pipein(urb->pipe)) {
 | |
| 				if (!u)
 | |
| 					atomic_set(&subs->state, STATE_STARTING3);
 | |
| 				urb->dev = usx2y->dev;
 | |
| 				for (pack = 0; pack < nr_of_packs(); pack++) {
 | |
| 					urb->iso_frame_desc[pack].offset = subs->maxpacksize * (pack + u * nr_of_packs());
 | |
| 					urb->iso_frame_desc[pack].length = subs->maxpacksize;
 | |
| 				}
 | |
| 				urb->transfer_buffer_length = subs->maxpacksize * nr_of_packs();
 | |
| 				err = usb_submit_urb(urb, GFP_KERNEL);
 | |
| 				if (err < 0) {
 | |
| 					snd_printk(KERN_ERR "cannot usb_submit_urb() for urb %d, err = %d\n", u, err);
 | |
| 					err = -EPIPE;
 | |
| 					goto cleanup;
 | |
| 				}  else {
 | |
| 					snd_printdd("%i\n", urb->start_frame);
 | |
| 					if (!u)
 | |
| 						usx2y->wait_iso_frame = urb->start_frame;
 | |
| 				}
 | |
| 				urb->transfer_flags = 0;
 | |
| 			} else {
 | |
| 				atomic_set(&subs->state, STATE_STARTING1);
 | |
| 				break;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| 	err = 0;
 | |
| 	wait_event(usx2y->prepare_wait_queue, !usx2y->prepare_subs);
 | |
| 	if (atomic_read(&subs->state) != STATE_PREPARED)
 | |
| 		err = -EPIPE;
 | |
| 
 | |
|  cleanup:
 | |
| 	if (err) {
 | |
| 		usx2y_subs_startup_finish(usx2y);	// Call it now
 | |
| 		usx2y_clients_stop(usx2y);	// something is completely wrong > stop everything
 | |
| 	}
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| #define USX2Y_HWDEP_PCM_PAGES	\
 | |
| 	PAGE_ALIGN(sizeof(struct snd_usx2y_hwdep_pcm_shm))
 | |
| 
 | |
| /*
 | |
|  * prepare callback
 | |
|  *
 | |
|  * set format and initialize urbs
 | |
|  */
 | |
| static int snd_usx2y_usbpcm_prepare(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	struct snd_usx2y_substream *subs = runtime->private_data;
 | |
| 	struct usx2ydev *usx2y = subs->usx2y;
 | |
| 	struct snd_usx2y_substream *capsubs = subs->usx2y->subs[SNDRV_PCM_STREAM_CAPTURE];
 | |
| 	int err = 0;
 | |
| 
 | |
| 	snd_printdd("snd_usx2y_pcm_prepare(%p)\n", substream);
 | |
| 
 | |
| 	mutex_lock(&usx2y->pcm_mutex);
 | |
| 
 | |
| 	if (!usx2y->hwdep_pcm_shm) {
 | |
| 		usx2y->hwdep_pcm_shm = alloc_pages_exact(USX2Y_HWDEP_PCM_PAGES,
 | |
| 							 GFP_KERNEL);
 | |
| 		if (!usx2y->hwdep_pcm_shm) {
 | |
| 			err = -ENOMEM;
 | |
| 			goto up_prepare_mutex;
 | |
| 		}
 | |
| 		memset(usx2y->hwdep_pcm_shm, 0, USX2Y_HWDEP_PCM_PAGES);
 | |
| 	}
 | |
| 
 | |
| 	usx2y_subs_prepare(subs);
 | |
| 	// Start hardware streams
 | |
| 	// SyncStream first....
 | |
| 	if (atomic_read(&capsubs->state) < STATE_PREPARED) {
 | |
| 		if (usx2y->format != runtime->format) {
 | |
| 			err = usx2y_format_set(usx2y, runtime->format);
 | |
| 			if (err < 0)
 | |
| 				goto up_prepare_mutex;
 | |
| 		}
 | |
| 		if (usx2y->rate != runtime->rate) {
 | |
| 			err = usx2y_rate_set(usx2y, runtime->rate);
 | |
| 			if (err < 0)
 | |
| 				goto up_prepare_mutex;
 | |
| 		}
 | |
| 		snd_printdd("starting capture pipe for %s\n", subs == capsubs ?
 | |
| 			    "self" : "playpipe");
 | |
| 		err = usx2y_usbpcm_urbs_start(capsubs);
 | |
| 		if (err < 0)
 | |
| 			goto up_prepare_mutex;
 | |
| 	}
 | |
| 
 | |
| 	if (subs != capsubs) {
 | |
| 		usx2y->hwdep_pcm_shm->playback_iso_start = -1;
 | |
| 		if (atomic_read(&subs->state) < STATE_PREPARED) {
 | |
| 			while (usx2y_iso_frames_per_buffer(runtime, usx2y) >
 | |
| 			       usx2y->hwdep_pcm_shm->captured_iso_frames) {
 | |
| 				snd_printdd("Wait: iso_frames_per_buffer=%i,captured_iso_frames=%i\n",
 | |
| 					    usx2y_iso_frames_per_buffer(runtime, usx2y),
 | |
| 					    usx2y->hwdep_pcm_shm->captured_iso_frames);
 | |
| 				if (msleep_interruptible(10)) {
 | |
| 					err = -ERESTARTSYS;
 | |
| 					goto up_prepare_mutex;
 | |
| 				}
 | |
| 			}
 | |
| 			err = usx2y_usbpcm_urbs_start(subs);
 | |
| 			if (err < 0)
 | |
| 				goto up_prepare_mutex;
 | |
| 		}
 | |
| 		snd_printdd("Ready: iso_frames_per_buffer=%i,captured_iso_frames=%i\n",
 | |
| 			    usx2y_iso_frames_per_buffer(runtime, usx2y),
 | |
| 			    usx2y->hwdep_pcm_shm->captured_iso_frames);
 | |
| 	} else {
 | |
| 		usx2y->hwdep_pcm_shm->capture_iso_start = -1;
 | |
| 	}
 | |
| 
 | |
|  up_prepare_mutex:
 | |
| 	mutex_unlock(&usx2y->pcm_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static const struct snd_pcm_hardware snd_usx2y_4c = {
 | |
| 	.info =			(SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
 | |
| 				 SNDRV_PCM_INFO_BLOCK_TRANSFER |
 | |
| 				 SNDRV_PCM_INFO_MMAP_VALID),
 | |
| 	.formats =                 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE,
 | |
| 	.rates =                   SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000,
 | |
| 	.rate_min =                44100,
 | |
| 	.rate_max =                48000,
 | |
| 	.channels_min =            2,
 | |
| 	.channels_max =            4,
 | |
| 	.buffer_bytes_max =	(2*128*1024),
 | |
| 	.period_bytes_min =	64,
 | |
| 	.period_bytes_max =	(128*1024),
 | |
| 	.periods_min =		2,
 | |
| 	.periods_max =		1024,
 | |
| 	.fifo_size =              0
 | |
| };
 | |
| 
 | |
| static int snd_usx2y_usbpcm_open(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct snd_usx2y_substream	*subs =
 | |
| 		((struct snd_usx2y_substream **)
 | |
| 		 snd_pcm_substream_chip(substream))[substream->stream];
 | |
| 	struct snd_pcm_runtime	*runtime = substream->runtime;
 | |
| 
 | |
| 	if (!(subs->usx2y->chip_status & USX2Y_STAT_CHIP_MMAP_PCM_URBS))
 | |
| 		return -EBUSY;
 | |
| 
 | |
| 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 | |
| 		runtime->hw = snd_usx2y_2c;
 | |
| 	else
 | |
| 		runtime->hw = (subs->usx2y->subs[3] ? snd_usx2y_4c : snd_usx2y_2c);
 | |
| 	runtime->private_data = subs;
 | |
| 	subs->pcm_substream = substream;
 | |
| 	snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_TIME, 1000, 200000);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_usx2y_usbpcm_close(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	struct snd_usx2y_substream *subs = runtime->private_data;
 | |
| 
 | |
| 	subs->pcm_substream = NULL;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct snd_pcm_ops snd_usx2y_usbpcm_ops = {
 | |
| 	.open =		snd_usx2y_usbpcm_open,
 | |
| 	.close =	snd_usx2y_usbpcm_close,
 | |
| 	.hw_params =	snd_usx2y_pcm_hw_params,
 | |
| 	.hw_free =	snd_usx2y_usbpcm_hw_free,
 | |
| 	.prepare =	snd_usx2y_usbpcm_prepare,
 | |
| 	.trigger =	snd_usx2y_pcm_trigger,
 | |
| 	.pointer =	snd_usx2y_pcm_pointer,
 | |
| };
 | |
| 
 | |
| static int usx2y_pcms_busy_check(struct snd_card *card)
 | |
| {
 | |
| 	struct usx2ydev	*dev = usx2y(card);
 | |
| 	struct snd_usx2y_substream *subs;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < dev->pcm_devs * 2; i++) {
 | |
| 		subs = dev->subs[i];
 | |
| 		if (subs && subs->pcm_substream &&
 | |
| 		    SUBSTREAM_BUSY(subs->pcm_substream))
 | |
| 			return -EBUSY;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_usx2y_hwdep_pcm_open(struct snd_hwdep *hw, struct file *file)
 | |
| {
 | |
| 	struct snd_card *card = hw->card;
 | |
| 	int err;
 | |
| 
 | |
| 	mutex_lock(&usx2y(card)->pcm_mutex);
 | |
| 	err = usx2y_pcms_busy_check(card);
 | |
| 	if (!err)
 | |
| 		usx2y(card)->chip_status |= USX2Y_STAT_CHIP_MMAP_PCM_URBS;
 | |
| 	mutex_unlock(&usx2y(card)->pcm_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int snd_usx2y_hwdep_pcm_release(struct snd_hwdep *hw, struct file *file)
 | |
| {
 | |
| 	struct snd_card *card = hw->card;
 | |
| 	int err;
 | |
| 
 | |
| 	mutex_lock(&usx2y(card)->pcm_mutex);
 | |
| 	err = usx2y_pcms_busy_check(card);
 | |
| 	if (!err)
 | |
| 		usx2y(hw->card)->chip_status &= ~USX2Y_STAT_CHIP_MMAP_PCM_URBS;
 | |
| 	mutex_unlock(&usx2y(card)->pcm_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void snd_usx2y_hwdep_pcm_vm_open(struct vm_area_struct *area)
 | |
| {
 | |
| }
 | |
| 
 | |
| static void snd_usx2y_hwdep_pcm_vm_close(struct vm_area_struct *area)
 | |
| {
 | |
| }
 | |
| 
 | |
| static vm_fault_t snd_usx2y_hwdep_pcm_vm_fault(struct vm_fault *vmf)
 | |
| {
 | |
| 	unsigned long offset;
 | |
| 	void *vaddr;
 | |
| 
 | |
| 	offset = vmf->pgoff << PAGE_SHIFT;
 | |
| 	vaddr = (char *)((struct usx2ydev *)vmf->vma->vm_private_data)->hwdep_pcm_shm + offset;
 | |
| 	vmf->page = virt_to_page(vaddr);
 | |
| 	get_page(vmf->page);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct vm_operations_struct snd_usx2y_hwdep_pcm_vm_ops = {
 | |
| 	.open = snd_usx2y_hwdep_pcm_vm_open,
 | |
| 	.close = snd_usx2y_hwdep_pcm_vm_close,
 | |
| 	.fault = snd_usx2y_hwdep_pcm_vm_fault,
 | |
| };
 | |
| 
 | |
| static int snd_usx2y_hwdep_pcm_mmap(struct snd_hwdep *hw, struct file *filp, struct vm_area_struct *area)
 | |
| {
 | |
| 	unsigned long	size = (unsigned long)(area->vm_end - area->vm_start);
 | |
| 	struct usx2ydev	*usx2y = hw->private_data;
 | |
| 
 | |
| 	if (!(usx2y->chip_status & USX2Y_STAT_CHIP_INIT))
 | |
| 		return -EBUSY;
 | |
| 
 | |
| 	/* if userspace tries to mmap beyond end of our buffer, fail */
 | |
| 	if (size > USX2Y_HWDEP_PCM_PAGES) {
 | |
| 		snd_printd("%lu > %lu\n", size, (unsigned long)USX2Y_HWDEP_PCM_PAGES);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if (!usx2y->hwdep_pcm_shm)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	area->vm_ops = &snd_usx2y_hwdep_pcm_vm_ops;
 | |
| 	area->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP;
 | |
| 	area->vm_private_data = hw->private_data;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void snd_usx2y_hwdep_pcm_private_free(struct snd_hwdep *hwdep)
 | |
| {
 | |
| 	struct usx2ydev *usx2y = hwdep->private_data;
 | |
| 
 | |
| 	if (usx2y->hwdep_pcm_shm)
 | |
| 		free_pages_exact(usx2y->hwdep_pcm_shm, USX2Y_HWDEP_PCM_PAGES);
 | |
| }
 | |
| 
 | |
| int usx2y_hwdep_pcm_new(struct snd_card *card)
 | |
| {
 | |
| 	int err;
 | |
| 	struct snd_hwdep *hw;
 | |
| 	struct snd_pcm *pcm;
 | |
| 	struct usb_device *dev = usx2y(card)->dev;
 | |
| 
 | |
| 	if (nr_of_packs() != 1)
 | |
| 		return 0;
 | |
| 
 | |
| 	err = snd_hwdep_new(card, SND_USX2Y_USBPCM_ID, 1, &hw);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	hw->iface = SNDRV_HWDEP_IFACE_USX2Y_PCM;
 | |
| 	hw->private_data = usx2y(card);
 | |
| 	hw->private_free = snd_usx2y_hwdep_pcm_private_free;
 | |
| 	hw->ops.open = snd_usx2y_hwdep_pcm_open;
 | |
| 	hw->ops.release = snd_usx2y_hwdep_pcm_release;
 | |
| 	hw->ops.mmap = snd_usx2y_hwdep_pcm_mmap;
 | |
| 	hw->exclusive = 1;
 | |
| 	sprintf(hw->name, "/dev/bus/usb/%03d/%03d/hwdeppcm", dev->bus->busnum, dev->devnum);
 | |
| 
 | |
| 	err = snd_pcm_new(card, NAME_ALLCAPS" hwdep Audio", 2, 1, 1, &pcm);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_usx2y_usbpcm_ops);
 | |
| 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_usx2y_usbpcm_ops);
 | |
| 
 | |
| 	pcm->private_data = usx2y(card)->subs;
 | |
| 	pcm->info_flags = 0;
 | |
| 
 | |
| 	sprintf(pcm->name, NAME_ALLCAPS" hwdep Audio");
 | |
| 	snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
 | |
| 				   SNDRV_DMA_TYPE_CONTINUOUS,
 | |
| 				   NULL,
 | |
| 				   64*1024, 128*1024);
 | |
| 	snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
 | |
| 				   SNDRV_DMA_TYPE_CONTINUOUS,
 | |
| 				   NULL,
 | |
| 				   64*1024, 128*1024);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| int usx2y_hwdep_pcm_new(struct snd_card *card)
 | |
| {
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #endif
 |