mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-08 17:18:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
5
sound/usb/usx2y/Makefile
Normal file
5
sound/usb/usx2y/Makefile
Normal file
|
@ -0,0 +1,5 @@
|
|||
snd-usb-usx2y-objs := usbusx2y.o usX2Yhwdep.o usx2yhwdeppcm.o
|
||||
snd-usb-us122l-objs := us122l.o
|
||||
|
||||
obj-$(CONFIG_SND_USB_USX2Y) += snd-usb-usx2y.o
|
||||
obj-$(CONFIG_SND_USB_US122L) += snd-usb-us122l.o
|
778
sound/usb/usx2y/us122l.c
Normal file
778
sound/usb/usx2y/us122l.c
Normal file
|
@ -0,0 +1,778 @@
|
|||
/*
|
||||
* Copyright (C) 2007, 2008 Karsten Wiese <fzu@wemgehoertderstaat.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful, but
|
||||
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
||||
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
||||
* for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software Foundation,
|
||||
* Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*/
|
||||
|
||||
#include <linux/slab.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/usb/audio.h>
|
||||
#include <linux/module.h>
|
||||
#include <sound/core.h>
|
||||
#include <sound/hwdep.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/initval.h>
|
||||
#define MODNAME "US122L"
|
||||
#include "usb_stream.c"
|
||||
#include "../usbaudio.h"
|
||||
#include "../midi.h"
|
||||
#include "us122l.h"
|
||||
|
||||
MODULE_AUTHOR("Karsten Wiese <fzu@wemgehoertderstaat.de>");
|
||||
MODULE_DESCRIPTION("TASCAM "NAME_ALLCAPS" Version 0.5");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-max */
|
||||
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* Id for this card */
|
||||
/* Enable this card */
|
||||
static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
|
||||
|
||||
module_param_array(index, int, NULL, 0444);
|
||||
MODULE_PARM_DESC(index, "Index value for "NAME_ALLCAPS".");
|
||||
module_param_array(id, charp, NULL, 0444);
|
||||
MODULE_PARM_DESC(id, "ID string for "NAME_ALLCAPS".");
|
||||
module_param_array(enable, bool, NULL, 0444);
|
||||
MODULE_PARM_DESC(enable, "Enable "NAME_ALLCAPS".");
|
||||
|
||||
static int snd_us122l_card_used[SNDRV_CARDS];
|
||||
|
||||
|
||||
static int us122l_create_usbmidi(struct snd_card *card)
|
||||
{
|
||||
static struct snd_usb_midi_endpoint_info quirk_data = {
|
||||
.out_ep = 4,
|
||||
.in_ep = 3,
|
||||
.out_cables = 0x001,
|
||||
.in_cables = 0x001
|
||||
};
|
||||
static struct snd_usb_audio_quirk quirk = {
|
||||
.vendor_name = "US122L",
|
||||
.product_name = NAME_ALLCAPS,
|
||||
.ifnum = 1,
|
||||
.type = QUIRK_MIDI_US122L,
|
||||
.data = &quirk_data
|
||||
};
|
||||
struct usb_device *dev = US122L(card)->dev;
|
||||
struct usb_interface *iface = usb_ifnum_to_if(dev, 1);
|
||||
|
||||
return snd_usbmidi_create(card, iface,
|
||||
&US122L(card)->midi_list, &quirk);
|
||||
}
|
||||
|
||||
static int us144_create_usbmidi(struct snd_card *card)
|
||||
{
|
||||
static struct snd_usb_midi_endpoint_info quirk_data = {
|
||||
.out_ep = 4,
|
||||
.in_ep = 3,
|
||||
.out_cables = 0x001,
|
||||
.in_cables = 0x001
|
||||
};
|
||||
static struct snd_usb_audio_quirk quirk = {
|
||||
.vendor_name = "US144",
|
||||
.product_name = NAME_ALLCAPS,
|
||||
.ifnum = 0,
|
||||
.type = QUIRK_MIDI_US122L,
|
||||
.data = &quirk_data
|
||||
};
|
||||
struct usb_device *dev = US122L(card)->dev;
|
||||
struct usb_interface *iface = usb_ifnum_to_if(dev, 0);
|
||||
|
||||
return snd_usbmidi_create(card, iface,
|
||||
&US122L(card)->midi_list, &quirk);
|
||||
}
|
||||
|
||||
/*
|
||||
* Wrapper for usb_control_msg().
|
||||
* Allocates a temp buffer to prevent dmaing from/to the stack.
|
||||
*/
|
||||
static int us122l_ctl_msg(struct usb_device *dev, unsigned int pipe,
|
||||
__u8 request, __u8 requesttype,
|
||||
__u16 value, __u16 index, void *data,
|
||||
__u16 size, int timeout)
|
||||
{
|
||||
int err;
|
||||
void *buf = NULL;
|
||||
|
||||
if (size > 0) {
|
||||
buf = kmemdup(data, size, GFP_KERNEL);
|
||||
if (!buf)
|
||||
return -ENOMEM;
|
||||
}
|
||||
err = usb_control_msg(dev, pipe, request, requesttype,
|
||||
value, index, buf, size, timeout);
|
||||
if (size > 0) {
|
||||
memcpy(data, buf, size);
|
||||
kfree(buf);
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
static void pt_info_set(struct usb_device *dev, u8 v)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
|
||||
'I',
|
||||
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
||||
v, 0, NULL, 0, 1000);
|
||||
snd_printdd(KERN_DEBUG "%i\n", ret);
|
||||
}
|
||||
|
||||
static void usb_stream_hwdep_vm_open(struct vm_area_struct *area)
|
||||
{
|
||||
struct us122l *us122l = area->vm_private_data;
|
||||
atomic_inc(&us122l->mmap_count);
|
||||
snd_printdd(KERN_DEBUG "%i\n", atomic_read(&us122l->mmap_count));
|
||||
}
|
||||
|
||||
static int usb_stream_hwdep_vm_fault(struct vm_area_struct *area,
|
||||
struct vm_fault *vmf)
|
||||
{
|
||||
unsigned long offset;
|
||||
struct page *page;
|
||||
void *vaddr;
|
||||
struct us122l *us122l = area->vm_private_data;
|
||||
struct usb_stream *s;
|
||||
|
||||
mutex_lock(&us122l->mutex);
|
||||
s = us122l->sk.s;
|
||||
if (!s)
|
||||
goto unlock;
|
||||
|
||||
offset = vmf->pgoff << PAGE_SHIFT;
|
||||
if (offset < PAGE_ALIGN(s->read_size))
|
||||
vaddr = (char *)s + offset;
|
||||
else {
|
||||
offset -= PAGE_ALIGN(s->read_size);
|
||||
if (offset >= PAGE_ALIGN(s->write_size))
|
||||
goto unlock;
|
||||
|
||||
vaddr = us122l->sk.write_page + offset;
|
||||
}
|
||||
page = virt_to_page(vaddr);
|
||||
|
||||
get_page(page);
|
||||
mutex_unlock(&us122l->mutex);
|
||||
|
||||
vmf->page = page;
|
||||
|
||||
return 0;
|
||||
unlock:
|
||||
mutex_unlock(&us122l->mutex);
|
||||
return VM_FAULT_SIGBUS;
|
||||
}
|
||||
|
||||
static void usb_stream_hwdep_vm_close(struct vm_area_struct *area)
|
||||
{
|
||||
struct us122l *us122l = area->vm_private_data;
|
||||
atomic_dec(&us122l->mmap_count);
|
||||
snd_printdd(KERN_DEBUG "%i\n", atomic_read(&us122l->mmap_count));
|
||||
}
|
||||
|
||||
static const struct vm_operations_struct usb_stream_hwdep_vm_ops = {
|
||||
.open = usb_stream_hwdep_vm_open,
|
||||
.fault = usb_stream_hwdep_vm_fault,
|
||||
.close = usb_stream_hwdep_vm_close,
|
||||
};
|
||||
|
||||
|
||||
static int usb_stream_hwdep_open(struct snd_hwdep *hw, struct file *file)
|
||||
{
|
||||
struct us122l *us122l = hw->private_data;
|
||||
struct usb_interface *iface;
|
||||
snd_printdd(KERN_DEBUG "%p %p\n", hw, file);
|
||||
if (hw->used >= 2)
|
||||
return -EBUSY;
|
||||
|
||||
if (!us122l->first)
|
||||
us122l->first = file;
|
||||
|
||||
if (us122l->dev->descriptor.idProduct == USB_ID_US144 ||
|
||||
us122l->dev->descriptor.idProduct == USB_ID_US144MKII) {
|
||||
iface = usb_ifnum_to_if(us122l->dev, 0);
|
||||
usb_autopm_get_interface(iface);
|
||||
}
|
||||
iface = usb_ifnum_to_if(us122l->dev, 1);
|
||||
usb_autopm_get_interface(iface);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int usb_stream_hwdep_release(struct snd_hwdep *hw, struct file *file)
|
||||
{
|
||||
struct us122l *us122l = hw->private_data;
|
||||
struct usb_interface *iface;
|
||||
snd_printdd(KERN_DEBUG "%p %p\n", hw, file);
|
||||
|
||||
if (us122l->dev->descriptor.idProduct == USB_ID_US144 ||
|
||||
us122l->dev->descriptor.idProduct == USB_ID_US144MKII) {
|
||||
iface = usb_ifnum_to_if(us122l->dev, 0);
|
||||
usb_autopm_put_interface(iface);
|
||||
}
|
||||
iface = usb_ifnum_to_if(us122l->dev, 1);
|
||||
usb_autopm_put_interface(iface);
|
||||
if (us122l->first == file)
|
||||
us122l->first = NULL;
|
||||
mutex_lock(&us122l->mutex);
|
||||
if (us122l->master == file)
|
||||
us122l->master = us122l->slave;
|
||||
|
||||
us122l->slave = NULL;
|
||||
mutex_unlock(&us122l->mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int usb_stream_hwdep_mmap(struct snd_hwdep *hw,
|
||||
struct file *filp, struct vm_area_struct *area)
|
||||
{
|
||||
unsigned long size = area->vm_end - area->vm_start;
|
||||
struct us122l *us122l = hw->private_data;
|
||||
unsigned long offset;
|
||||
struct usb_stream *s;
|
||||
int err = 0;
|
||||
bool read;
|
||||
|
||||
offset = area->vm_pgoff << PAGE_SHIFT;
|
||||
mutex_lock(&us122l->mutex);
|
||||
s = us122l->sk.s;
|
||||
read = offset < s->read_size;
|
||||
if (read && area->vm_flags & VM_WRITE) {
|
||||
err = -EPERM;
|
||||
goto out;
|
||||
}
|
||||
snd_printdd(KERN_DEBUG "%lu %u\n", size,
|
||||
read ? s->read_size : s->write_size);
|
||||
/* if userspace tries to mmap beyond end of our buffer, fail */
|
||||
if (size > PAGE_ALIGN(read ? s->read_size : s->write_size)) {
|
||||
snd_printk(KERN_WARNING "%lu > %u\n", size,
|
||||
read ? s->read_size : s->write_size);
|
||||
err = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
|
||||
area->vm_ops = &usb_stream_hwdep_vm_ops;
|
||||
area->vm_flags |= VM_DONTDUMP;
|
||||
if (!read)
|
||||
area->vm_flags |= VM_DONTEXPAND;
|
||||
area->vm_private_data = us122l;
|
||||
atomic_inc(&us122l->mmap_count);
|
||||
out:
|
||||
mutex_unlock(&us122l->mutex);
|
||||
return err;
|
||||
}
|
||||
|
||||
static unsigned int usb_stream_hwdep_poll(struct snd_hwdep *hw,
|
||||
struct file *file, poll_table *wait)
|
||||
{
|
||||
struct us122l *us122l = hw->private_data;
|
||||
unsigned *polled;
|
||||
unsigned int mask;
|
||||
|
||||
poll_wait(file, &us122l->sk.sleep, wait);
|
||||
|
||||
mask = POLLIN | POLLOUT | POLLWRNORM | POLLERR;
|
||||
if (mutex_trylock(&us122l->mutex)) {
|
||||
struct usb_stream *s = us122l->sk.s;
|
||||
if (s && s->state == usb_stream_ready) {
|
||||
if (us122l->first == file)
|
||||
polled = &s->periods_polled;
|
||||
else
|
||||
polled = &us122l->second_periods_polled;
|
||||
if (*polled != s->periods_done) {
|
||||
*polled = s->periods_done;
|
||||
mask = POLLIN | POLLOUT | POLLWRNORM;
|
||||
} else
|
||||
mask = 0;
|
||||
}
|
||||
mutex_unlock(&us122l->mutex);
|
||||
}
|
||||
return mask;
|
||||
}
|
||||
|
||||
static void us122l_stop(struct us122l *us122l)
|
||||
{
|
||||
struct list_head *p;
|
||||
list_for_each(p, &us122l->midi_list)
|
||||
snd_usbmidi_input_stop(p);
|
||||
|
||||
usb_stream_stop(&us122l->sk);
|
||||
usb_stream_free(&us122l->sk);
|
||||
}
|
||||
|
||||
static int us122l_set_sample_rate(struct usb_device *dev, int rate)
|
||||
{
|
||||
unsigned int ep = 0x81;
|
||||
unsigned char data[3];
|
||||
int err;
|
||||
|
||||
data[0] = rate;
|
||||
data[1] = rate >> 8;
|
||||
data[2] = rate >> 16;
|
||||
err = us122l_ctl_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
|
||||
USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_OUT,
|
||||
UAC_EP_CS_ATTR_SAMPLE_RATE << 8, ep, data, 3, 1000);
|
||||
if (err < 0)
|
||||
snd_printk(KERN_ERR "%d: cannot set freq %d to ep 0x%x\n",
|
||||
dev->devnum, rate, ep);
|
||||
return err;
|
||||
}
|
||||
|
||||
static bool us122l_start(struct us122l *us122l,
|
||||
unsigned rate, unsigned period_frames)
|
||||
{
|
||||
struct list_head *p;
|
||||
int err;
|
||||
unsigned use_packsize = 0;
|
||||
bool success = false;
|
||||
|
||||
if (us122l->dev->speed == USB_SPEED_HIGH) {
|
||||
/* The us-122l's descriptor defaults to iso max_packsize 78,
|
||||
which isn't needed for samplerates <= 48000.
|
||||
Lets save some memory:
|
||||
*/
|
||||
switch (rate) {
|
||||
case 44100:
|
||||
use_packsize = 36;
|
||||
break;
|
||||
case 48000:
|
||||
use_packsize = 42;
|
||||
break;
|
||||
case 88200:
|
||||
use_packsize = 72;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (!usb_stream_new(&us122l->sk, us122l->dev, 1, 2,
|
||||
rate, use_packsize, period_frames, 6))
|
||||
goto out;
|
||||
|
||||
err = us122l_set_sample_rate(us122l->dev, rate);
|
||||
if (err < 0) {
|
||||
us122l_stop(us122l);
|
||||
snd_printk(KERN_ERR "us122l_set_sample_rate error \n");
|
||||
goto out;
|
||||
}
|
||||
err = usb_stream_start(&us122l->sk);
|
||||
if (err < 0) {
|
||||
us122l_stop(us122l);
|
||||
snd_printk(KERN_ERR "us122l_start error %i \n", err);
|
||||
goto out;
|
||||
}
|
||||
list_for_each(p, &us122l->midi_list)
|
||||
snd_usbmidi_input_start(p);
|
||||
success = true;
|
||||
out:
|
||||
return success;
|
||||
}
|
||||
|
||||
static int usb_stream_hwdep_ioctl(struct snd_hwdep *hw, struct file *file,
|
||||
unsigned cmd, unsigned long arg)
|
||||
{
|
||||
struct usb_stream_config *cfg;
|
||||
struct us122l *us122l = hw->private_data;
|
||||
struct usb_stream *s;
|
||||
unsigned min_period_frames;
|
||||
int err = 0;
|
||||
bool high_speed;
|
||||
|
||||
if (cmd != SNDRV_USB_STREAM_IOCTL_SET_PARAMS)
|
||||
return -ENOTTY;
|
||||
|
||||
cfg = memdup_user((void *)arg, sizeof(*cfg));
|
||||
if (IS_ERR(cfg))
|
||||
return PTR_ERR(cfg);
|
||||
|
||||
if (cfg->version != USB_STREAM_INTERFACE_VERSION) {
|
||||
err = -ENXIO;
|
||||
goto free;
|
||||
}
|
||||
high_speed = us122l->dev->speed == USB_SPEED_HIGH;
|
||||
if ((cfg->sample_rate != 44100 && cfg->sample_rate != 48000 &&
|
||||
(!high_speed ||
|
||||
(cfg->sample_rate != 88200 && cfg->sample_rate != 96000))) ||
|
||||
cfg->frame_size != 6 ||
|
||||
cfg->period_frames > 0x3000) {
|
||||
err = -EINVAL;
|
||||
goto free;
|
||||
}
|
||||
switch (cfg->sample_rate) {
|
||||
case 44100:
|
||||
min_period_frames = 48;
|
||||
break;
|
||||
case 48000:
|
||||
min_period_frames = 52;
|
||||
break;
|
||||
default:
|
||||
min_period_frames = 104;
|
||||
break;
|
||||
}
|
||||
if (!high_speed)
|
||||
min_period_frames <<= 1;
|
||||
if (cfg->period_frames < min_period_frames) {
|
||||
err = -EINVAL;
|
||||
goto free;
|
||||
}
|
||||
|
||||
snd_power_wait(hw->card, SNDRV_CTL_POWER_D0);
|
||||
|
||||
mutex_lock(&us122l->mutex);
|
||||
s = us122l->sk.s;
|
||||
if (!us122l->master)
|
||||
us122l->master = file;
|
||||
else if (us122l->master != file) {
|
||||
if (!s || memcmp(cfg, &s->cfg, sizeof(*cfg))) {
|
||||
err = -EIO;
|
||||
goto unlock;
|
||||
}
|
||||
us122l->slave = file;
|
||||
}
|
||||
if (!s || memcmp(cfg, &s->cfg, sizeof(*cfg)) ||
|
||||
s->state == usb_stream_xrun) {
|
||||
us122l_stop(us122l);
|
||||
if (!us122l_start(us122l, cfg->sample_rate, cfg->period_frames))
|
||||
err = -EIO;
|
||||
else
|
||||
err = 1;
|
||||
}
|
||||
unlock:
|
||||
mutex_unlock(&us122l->mutex);
|
||||
free:
|
||||
kfree(cfg);
|
||||
wake_up_all(&us122l->sk.sleep);
|
||||
return err;
|
||||
}
|
||||
|
||||
#define SND_USB_STREAM_ID "USB STREAM"
|
||||
static int usb_stream_hwdep_new(struct snd_card *card)
|
||||
{
|
||||
int err;
|
||||
struct snd_hwdep *hw;
|
||||
struct usb_device *dev = US122L(card)->dev;
|
||||
|
||||
err = snd_hwdep_new(card, SND_USB_STREAM_ID, 0, &hw);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
hw->iface = SNDRV_HWDEP_IFACE_USB_STREAM;
|
||||
hw->private_data = US122L(card);
|
||||
hw->ops.open = usb_stream_hwdep_open;
|
||||
hw->ops.release = usb_stream_hwdep_release;
|
||||
hw->ops.ioctl = usb_stream_hwdep_ioctl;
|
||||
hw->ops.ioctl_compat = usb_stream_hwdep_ioctl;
|
||||
hw->ops.mmap = usb_stream_hwdep_mmap;
|
||||
hw->ops.poll = usb_stream_hwdep_poll;
|
||||
|
||||
sprintf(hw->name, "/proc/bus/usb/%03d/%03d/hwdeppcm",
|
||||
dev->bus->busnum, dev->devnum);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static bool us122l_create_card(struct snd_card *card)
|
||||
{
|
||||
int err;
|
||||
struct us122l *us122l = US122L(card);
|
||||
|
||||
if (us122l->dev->descriptor.idProduct == USB_ID_US144 ||
|
||||
us122l->dev->descriptor.idProduct == USB_ID_US144MKII) {
|
||||
err = usb_set_interface(us122l->dev, 0, 1);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usb_set_interface error \n");
|
||||
return false;
|
||||
}
|
||||
}
|
||||
err = usb_set_interface(us122l->dev, 1, 1);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usb_set_interface error \n");
|
||||
return false;
|
||||
}
|
||||
|
||||
pt_info_set(us122l->dev, 0x11);
|
||||
pt_info_set(us122l->dev, 0x10);
|
||||
|
||||
if (!us122l_start(us122l, 44100, 256))
|
||||
return false;
|
||||
|
||||
if (us122l->dev->descriptor.idProduct == USB_ID_US144 ||
|
||||
us122l->dev->descriptor.idProduct == USB_ID_US144MKII)
|
||||
err = us144_create_usbmidi(card);
|
||||
else
|
||||
err = us122l_create_usbmidi(card);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR "us122l_create_usbmidi error %i \n", err);
|
||||
us122l_stop(us122l);
|
||||
return false;
|
||||
}
|
||||
err = usb_stream_hwdep_new(card);
|
||||
if (err < 0) {
|
||||
/* release the midi resources */
|
||||
struct list_head *p;
|
||||
list_for_each(p, &us122l->midi_list)
|
||||
snd_usbmidi_disconnect(p);
|
||||
|
||||
us122l_stop(us122l);
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
static void snd_us122l_free(struct snd_card *card)
|
||||
{
|
||||
struct us122l *us122l = US122L(card);
|
||||
int index = us122l->card_index;
|
||||
if (index >= 0 && index < SNDRV_CARDS)
|
||||
snd_us122l_card_used[index] = 0;
|
||||
}
|
||||
|
||||
static int usx2y_create_card(struct usb_device *device,
|
||||
struct usb_interface *intf,
|
||||
struct snd_card **cardp)
|
||||
{
|
||||
int dev;
|
||||
struct snd_card *card;
|
||||
int err;
|
||||
|
||||
for (dev = 0; dev < SNDRV_CARDS; ++dev)
|
||||
if (enable[dev] && !snd_us122l_card_used[dev])
|
||||
break;
|
||||
if (dev >= SNDRV_CARDS)
|
||||
return -ENODEV;
|
||||
err = snd_card_new(&intf->dev, index[dev], id[dev], THIS_MODULE,
|
||||
sizeof(struct us122l), &card);
|
||||
if (err < 0)
|
||||
return err;
|
||||
snd_us122l_card_used[US122L(card)->card_index = dev] = 1;
|
||||
card->private_free = snd_us122l_free;
|
||||
US122L(card)->dev = device;
|
||||
mutex_init(&US122L(card)->mutex);
|
||||
init_waitqueue_head(&US122L(card)->sk.sleep);
|
||||
INIT_LIST_HEAD(&US122L(card)->midi_list);
|
||||
strcpy(card->driver, "USB "NAME_ALLCAPS"");
|
||||
sprintf(card->shortname, "TASCAM "NAME_ALLCAPS"");
|
||||
sprintf(card->longname, "%s (%x:%x if %d at %03d/%03d)",
|
||||
card->shortname,
|
||||
le16_to_cpu(device->descriptor.idVendor),
|
||||
le16_to_cpu(device->descriptor.idProduct),
|
||||
0,
|
||||
US122L(card)->dev->bus->busnum,
|
||||
US122L(card)->dev->devnum
|
||||
);
|
||||
*cardp = card;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int us122l_usb_probe(struct usb_interface *intf,
|
||||
const struct usb_device_id *device_id,
|
||||
struct snd_card **cardp)
|
||||
{
|
||||
struct usb_device *device = interface_to_usbdev(intf);
|
||||
struct snd_card *card;
|
||||
int err;
|
||||
|
||||
err = usx2y_create_card(device, intf, &card);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!us122l_create_card(card)) {
|
||||
snd_card_free(card);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
err = snd_card_register(card);
|
||||
if (err < 0) {
|
||||
snd_card_free(card);
|
||||
return err;
|
||||
}
|
||||
|
||||
usb_get_intf(usb_ifnum_to_if(device, 0));
|
||||
usb_get_dev(device);
|
||||
*cardp = card;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int snd_us122l_probe(struct usb_interface *intf,
|
||||
const struct usb_device_id *id)
|
||||
{
|
||||
struct usb_device *device = interface_to_usbdev(intf);
|
||||
struct snd_card *card;
|
||||
int err;
|
||||
|
||||
if ((device->descriptor.idProduct == USB_ID_US144 ||
|
||||
device->descriptor.idProduct == USB_ID_US144MKII)
|
||||
&& device->speed == USB_SPEED_HIGH) {
|
||||
snd_printk(KERN_ERR "disable ehci-hcd to run US-144 \n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
snd_printdd(KERN_DEBUG"%p:%i\n",
|
||||
intf, intf->cur_altsetting->desc.bInterfaceNumber);
|
||||
if (intf->cur_altsetting->desc.bInterfaceNumber != 1)
|
||||
return 0;
|
||||
|
||||
err = us122l_usb_probe(usb_get_intf(intf), id, &card);
|
||||
if (err < 0) {
|
||||
usb_put_intf(intf);
|
||||
return err;
|
||||
}
|
||||
|
||||
usb_set_intfdata(intf, card);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void snd_us122l_disconnect(struct usb_interface *intf)
|
||||
{
|
||||
struct snd_card *card;
|
||||
struct us122l *us122l;
|
||||
struct list_head *p;
|
||||
|
||||
card = usb_get_intfdata(intf);
|
||||
if (!card)
|
||||
return;
|
||||
|
||||
snd_card_disconnect(card);
|
||||
|
||||
us122l = US122L(card);
|
||||
mutex_lock(&us122l->mutex);
|
||||
us122l_stop(us122l);
|
||||
mutex_unlock(&us122l->mutex);
|
||||
|
||||
/* release the midi resources */
|
||||
list_for_each(p, &us122l->midi_list) {
|
||||
snd_usbmidi_disconnect(p);
|
||||
}
|
||||
|
||||
usb_put_intf(usb_ifnum_to_if(us122l->dev, 0));
|
||||
usb_put_intf(usb_ifnum_to_if(us122l->dev, 1));
|
||||
usb_put_dev(us122l->dev);
|
||||
|
||||
while (atomic_read(&us122l->mmap_count))
|
||||
msleep(500);
|
||||
|
||||
snd_card_free(card);
|
||||
}
|
||||
|
||||
static int snd_us122l_suspend(struct usb_interface *intf, pm_message_t message)
|
||||
{
|
||||
struct snd_card *card;
|
||||
struct us122l *us122l;
|
||||
struct list_head *p;
|
||||
|
||||
card = usb_get_intfdata(intf);
|
||||
if (!card)
|
||||
return 0;
|
||||
snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
|
||||
|
||||
us122l = US122L(card);
|
||||
if (!us122l)
|
||||
return 0;
|
||||
|
||||
list_for_each(p, &us122l->midi_list)
|
||||
snd_usbmidi_input_stop(p);
|
||||
|
||||
mutex_lock(&us122l->mutex);
|
||||
usb_stream_stop(&us122l->sk);
|
||||
mutex_unlock(&us122l->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int snd_us122l_resume(struct usb_interface *intf)
|
||||
{
|
||||
struct snd_card *card;
|
||||
struct us122l *us122l;
|
||||
struct list_head *p;
|
||||
int err;
|
||||
|
||||
card = usb_get_intfdata(intf);
|
||||
if (!card)
|
||||
return 0;
|
||||
|
||||
us122l = US122L(card);
|
||||
if (!us122l)
|
||||
return 0;
|
||||
|
||||
mutex_lock(&us122l->mutex);
|
||||
/* needed, doesn't restart without: */
|
||||
if (us122l->dev->descriptor.idProduct == USB_ID_US144 ||
|
||||
us122l->dev->descriptor.idProduct == USB_ID_US144MKII) {
|
||||
err = usb_set_interface(us122l->dev, 0, 1);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usb_set_interface error \n");
|
||||
goto unlock;
|
||||
}
|
||||
}
|
||||
err = usb_set_interface(us122l->dev, 1, 1);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usb_set_interface error \n");
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
pt_info_set(us122l->dev, 0x11);
|
||||
pt_info_set(us122l->dev, 0x10);
|
||||
|
||||
err = us122l_set_sample_rate(us122l->dev,
|
||||
us122l->sk.s->cfg.sample_rate);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR "us122l_set_sample_rate error \n");
|
||||
goto unlock;
|
||||
}
|
||||
err = usb_stream_start(&us122l->sk);
|
||||
if (err)
|
||||
goto unlock;
|
||||
|
||||
list_for_each(p, &us122l->midi_list)
|
||||
snd_usbmidi_input_start(p);
|
||||
unlock:
|
||||
mutex_unlock(&us122l->mutex);
|
||||
snd_power_change_state(card, SNDRV_CTL_POWER_D0);
|
||||
return err;
|
||||
}
|
||||
|
||||
static struct usb_device_id snd_us122l_usb_id_table[] = {
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x0644,
|
||||
.idProduct = USB_ID_US122L
|
||||
},
|
||||
{ /* US-144 only works at USB1.1! Disable module ehci-hcd. */
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x0644,
|
||||
.idProduct = USB_ID_US144
|
||||
},
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x0644,
|
||||
.idProduct = USB_ID_US122MKII
|
||||
},
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x0644,
|
||||
.idProduct = USB_ID_US144MKII
|
||||
},
|
||||
{ /* terminator */ }
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(usb, snd_us122l_usb_id_table);
|
||||
static struct usb_driver snd_us122l_usb_driver = {
|
||||
.name = "snd-usb-us122l",
|
||||
.probe = snd_us122l_probe,
|
||||
.disconnect = snd_us122l_disconnect,
|
||||
.suspend = snd_us122l_suspend,
|
||||
.resume = snd_us122l_resume,
|
||||
.reset_resume = snd_us122l_resume,
|
||||
.id_table = snd_us122l_usb_id_table,
|
||||
.supports_autosuspend = 1
|
||||
};
|
||||
|
||||
module_usb_driver(snd_us122l_usb_driver);
|
31
sound/usb/usx2y/us122l.h
Normal file
31
sound/usb/usx2y/us122l.h
Normal file
|
@ -0,0 +1,31 @@
|
|||
#ifndef US122L_H
|
||||
#define US122L_H
|
||||
|
||||
|
||||
struct us122l {
|
||||
struct usb_device *dev;
|
||||
int card_index;
|
||||
int stride;
|
||||
struct usb_stream_kernel sk;
|
||||
|
||||
struct mutex mutex;
|
||||
struct file *first;
|
||||
unsigned second_periods_polled;
|
||||
struct file *master;
|
||||
struct file *slave;
|
||||
struct list_head midi_list;
|
||||
|
||||
atomic_t mmap_count;
|
||||
};
|
||||
|
||||
|
||||
#define US122L(c) ((struct us122l *)(c)->private_data)
|
||||
|
||||
#define NAME_ALLCAPS "US-122L"
|
||||
|
||||
#define USB_ID_US122L 0x800E
|
||||
#define USB_ID_US144 0x800F
|
||||
#define USB_ID_US122MKII 0x8021
|
||||
#define USB_ID_US144MKII 0x8020
|
||||
|
||||
#endif
|
265
sound/usb/usx2y/usX2Yhwdep.c
Normal file
265
sound/usb/usx2y/usX2Yhwdep.c
Normal file
|
@ -0,0 +1,265 @@
|
|||
/*
|
||||
* Driver for Tascam US-X2Y USB soundcards
|
||||
*
|
||||
* FPGA Loader + ALSA Startup
|
||||
*
|
||||
* Copyright (c) 2003 by Karsten Wiese <annabellesgarden@yahoo.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/usb.h>
|
||||
#include <sound/core.h>
|
||||
#include <sound/memalloc.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/hwdep.h>
|
||||
#include "usx2y.h"
|
||||
#include "usbusx2y.h"
|
||||
#include "usX2Yhwdep.h"
|
||||
|
||||
static int snd_us428ctls_vm_fault(struct vm_area_struct *area,
|
||||
struct vm_fault *vmf)
|
||||
{
|
||||
unsigned long offset;
|
||||
struct page * page;
|
||||
void *vaddr;
|
||||
|
||||
snd_printdd("ENTER, start %lXh, pgoff %ld\n",
|
||||
area->vm_start,
|
||||
vmf->pgoff);
|
||||
|
||||
offset = vmf->pgoff << PAGE_SHIFT;
|
||||
vaddr = (char*)((struct usX2Ydev *)area->vm_private_data)->us428ctls_sharedmem + offset;
|
||||
page = virt_to_page(vaddr);
|
||||
get_page(page);
|
||||
vmf->page = page;
|
||||
|
||||
snd_printdd("vaddr=%p made us428ctls_vm_fault() page %p\n",
|
||||
vaddr, page);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct vm_operations_struct us428ctls_vm_ops = {
|
||||
.fault = snd_us428ctls_vm_fault,
|
||||
};
|
||||
|
||||
static int snd_us428ctls_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 *us428 = hw->private_data;
|
||||
|
||||
// FIXME this hwdep interface is used twice: fpga download and mmap for controlling Lights etc. Maybe better using 2 hwdep devs?
|
||||
// so as long as the device isn't fully initialised yet we return -EBUSY here.
|
||||
if (!(us428->chip_status & USX2Y_STAT_CHIP_INIT))
|
||||
return -EBUSY;
|
||||
|
||||
/* if userspace tries to mmap beyond end of our buffer, fail */
|
||||
if (size > PAGE_ALIGN(sizeof(struct us428ctls_sharedmem))) {
|
||||
snd_printd( "%lu > %lu\n", size, (unsigned long)sizeof(struct us428ctls_sharedmem));
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!us428->us428ctls_sharedmem) {
|
||||
init_waitqueue_head(&us428->us428ctls_wait_queue_head);
|
||||
if(!(us428->us428ctls_sharedmem = snd_malloc_pages(sizeof(struct us428ctls_sharedmem), GFP_KERNEL)))
|
||||
return -ENOMEM;
|
||||
memset(us428->us428ctls_sharedmem, -1, sizeof(struct us428ctls_sharedmem));
|
||||
us428->us428ctls_sharedmem->CtlSnapShotLast = -2;
|
||||
}
|
||||
area->vm_ops = &us428ctls_vm_ops;
|
||||
area->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP;
|
||||
area->vm_private_data = hw->private_data;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static unsigned int snd_us428ctls_poll(struct snd_hwdep *hw, struct file *file, poll_table *wait)
|
||||
{
|
||||
unsigned int mask = 0;
|
||||
struct usX2Ydev *us428 = hw->private_data;
|
||||
struct us428ctls_sharedmem *shm = us428->us428ctls_sharedmem;
|
||||
if (us428->chip_status & USX2Y_STAT_CHIP_HUP)
|
||||
return POLLHUP;
|
||||
|
||||
poll_wait(file, &us428->us428ctls_wait_queue_head, wait);
|
||||
|
||||
if (shm != NULL && shm->CtlSnapShotLast != shm->CtlSnapShotRed)
|
||||
mask |= POLLIN;
|
||||
|
||||
return mask;
|
||||
}
|
||||
|
||||
|
||||
static int snd_usX2Y_hwdep_dsp_status(struct snd_hwdep *hw,
|
||||
struct snd_hwdep_dsp_status *info)
|
||||
{
|
||||
static char *type_ids[USX2Y_TYPE_NUMS] = {
|
||||
[USX2Y_TYPE_122] = "us122",
|
||||
[USX2Y_TYPE_224] = "us224",
|
||||
[USX2Y_TYPE_428] = "us428",
|
||||
};
|
||||
struct usX2Ydev *us428 = hw->private_data;
|
||||
int id = -1;
|
||||
|
||||
switch (le16_to_cpu(us428->dev->descriptor.idProduct)) {
|
||||
case USB_ID_US122:
|
||||
id = USX2Y_TYPE_122;
|
||||
break;
|
||||
case USB_ID_US224:
|
||||
id = USX2Y_TYPE_224;
|
||||
break;
|
||||
case USB_ID_US428:
|
||||
id = USX2Y_TYPE_428;
|
||||
break;
|
||||
}
|
||||
if (0 > id)
|
||||
return -ENODEV;
|
||||
strcpy(info->id, type_ids[id]);
|
||||
info->num_dsps = 2; // 0: Prepad Data, 1: FPGA Code
|
||||
if (us428->chip_status & USX2Y_STAT_CHIP_INIT)
|
||||
info->chip_ready = 1;
|
||||
info->version = USX2Y_DRIVER_VERSION;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int usX2Y_create_usbmidi(struct snd_card *card)
|
||||
{
|
||||
static struct snd_usb_midi_endpoint_info quirk_data_1 = {
|
||||
.out_ep = 0x06,
|
||||
.in_ep = 0x06,
|
||||
.out_cables = 0x001,
|
||||
.in_cables = 0x001
|
||||
};
|
||||
static struct snd_usb_audio_quirk quirk_1 = {
|
||||
.vendor_name = "TASCAM",
|
||||
.product_name = NAME_ALLCAPS,
|
||||
.ifnum = 0,
|
||||
.type = QUIRK_MIDI_FIXED_ENDPOINT,
|
||||
.data = &quirk_data_1
|
||||
};
|
||||
static struct snd_usb_midi_endpoint_info quirk_data_2 = {
|
||||
.out_ep = 0x06,
|
||||
.in_ep = 0x06,
|
||||
.out_cables = 0x003,
|
||||
.in_cables = 0x003
|
||||
};
|
||||
static struct snd_usb_audio_quirk quirk_2 = {
|
||||
.vendor_name = "TASCAM",
|
||||
.product_name = "US428",
|
||||
.ifnum = 0,
|
||||
.type = QUIRK_MIDI_FIXED_ENDPOINT,
|
||||
.data = &quirk_data_2
|
||||
};
|
||||
struct usb_device *dev = usX2Y(card)->dev;
|
||||
struct usb_interface *iface = usb_ifnum_to_if(dev, 0);
|
||||
struct snd_usb_audio_quirk *quirk =
|
||||
le16_to_cpu(dev->descriptor.idProduct) == USB_ID_US428 ?
|
||||
&quirk_2 : &quirk_1;
|
||||
|
||||
snd_printdd("usX2Y_create_usbmidi \n");
|
||||
return snd_usbmidi_create(card, iface, &usX2Y(card)->midi_list, quirk);
|
||||
}
|
||||
|
||||
static int usX2Y_create_alsa_devices(struct snd_card *card)
|
||||
{
|
||||
int err;
|
||||
|
||||
do {
|
||||
if ((err = usX2Y_create_usbmidi(card)) < 0) {
|
||||
snd_printk(KERN_ERR "usX2Y_create_alsa_devices: usX2Y_create_usbmidi error %i \n", err);
|
||||
break;
|
||||
}
|
||||
if ((err = usX2Y_audio_create(card)) < 0)
|
||||
break;
|
||||
if ((err = usX2Y_hwdep_pcm_new(card)) < 0)
|
||||
break;
|
||||
if ((err = snd_card_register(card)) < 0)
|
||||
break;
|
||||
} while (0);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int snd_usX2Y_hwdep_dsp_load(struct snd_hwdep *hw,
|
||||
struct snd_hwdep_dsp_image *dsp)
|
||||
{
|
||||
struct usX2Ydev *priv = hw->private_data;
|
||||
int lret, err = -EINVAL;
|
||||
snd_printdd( "dsp_load %s\n", dsp->name);
|
||||
|
||||
if (access_ok(VERIFY_READ, dsp->image, dsp->length)) {
|
||||
struct usb_device* dev = priv->dev;
|
||||
char *buf;
|
||||
|
||||
buf = memdup_user(dsp->image, dsp->length);
|
||||
if (IS_ERR(buf))
|
||||
return PTR_ERR(buf);
|
||||
|
||||
err = usb_set_interface(dev, 0, 1);
|
||||
if (err)
|
||||
snd_printk(KERN_ERR "usb_set_interface error \n");
|
||||
else
|
||||
err = usb_bulk_msg(dev, usb_sndbulkpipe(dev, 2), buf, dsp->length, &lret, 6000);
|
||||
kfree(buf);
|
||||
}
|
||||
if (err)
|
||||
return err;
|
||||
if (dsp->index == 1) {
|
||||
msleep(250); // give the device some time
|
||||
err = usX2Y_AsyncSeq04_init(priv);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usX2Y_AsyncSeq04_init error \n");
|
||||
return err;
|
||||
}
|
||||
err = usX2Y_In04_init(priv);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usX2Y_In04_init error \n");
|
||||
return err;
|
||||
}
|
||||
err = usX2Y_create_alsa_devices(hw->card);
|
||||
if (err) {
|
||||
snd_printk(KERN_ERR "usX2Y_create_alsa_devices error %i \n", err);
|
||||
snd_card_free(hw->card);
|
||||
return err;
|
||||
}
|
||||
priv->chip_status |= USX2Y_STAT_CHIP_INIT;
|
||||
snd_printdd("%s: alsa all started\n", hw->name);
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
|
||||
int usX2Y_hwdep_new(struct snd_card *card, struct usb_device* device)
|
||||
{
|
||||
int err;
|
||||
struct snd_hwdep *hw;
|
||||
|
||||
if ((err = snd_hwdep_new(card, SND_USX2Y_LOADER_ID, 0, &hw)) < 0)
|
||||
return err;
|
||||
|
||||
hw->iface = SNDRV_HWDEP_IFACE_USX2Y;
|
||||
hw->private_data = usX2Y(card);
|
||||
hw->ops.dsp_status = snd_usX2Y_hwdep_dsp_status;
|
||||
hw->ops.dsp_load = snd_usX2Y_hwdep_dsp_load;
|
||||
hw->ops.mmap = snd_us428ctls_mmap;
|
||||
hw->ops.poll = snd_us428ctls_poll;
|
||||
hw->exclusive = 1;
|
||||
sprintf(hw->name, "/proc/bus/usb/%03d/%03d", device->bus->busnum, device->devnum);
|
||||
return 0;
|
||||
}
|
||||
|
6
sound/usb/usx2y/usX2Yhwdep.h
Normal file
6
sound/usb/usx2y/usX2Yhwdep.h
Normal file
|
@ -0,0 +1,6 @@
|
|||
#ifndef USX2YHWDEP_H
|
||||
#define USX2YHWDEP_H
|
||||
|
||||
int usX2Y_hwdep_new(struct snd_card *card, struct usb_device* device);
|
||||
|
||||
#endif
|
753
sound/usb/usx2y/usb_stream.c
Normal file
753
sound/usb/usx2y/usb_stream.c
Normal file
|
@ -0,0 +1,753 @@
|
|||
/*
|
||||
* Copyright (C) 2007, 2008 Karsten Wiese <fzu@wemgehoertderstaat.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful, but
|
||||
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
||||
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
||||
* for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software Foundation,
|
||||
* Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*/
|
||||
|
||||
#include <linux/usb.h>
|
||||
#include <linux/gfp.h>
|
||||
|
||||
#include "usb_stream.h"
|
||||
|
||||
|
||||
/* setup */
|
||||
|
||||
static unsigned usb_stream_next_packet_size(struct usb_stream_kernel *sk)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
sk->out_phase_peeked = (sk->out_phase & 0xffff) + sk->freqn;
|
||||
return (sk->out_phase_peeked >> 16) * s->cfg.frame_size;
|
||||
}
|
||||
|
||||
static void playback_prep_freqn(struct usb_stream_kernel *sk, struct urb *urb)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
int pack, lb = 0;
|
||||
|
||||
for (pack = 0; pack < sk->n_o_ps; pack++) {
|
||||
int l = usb_stream_next_packet_size(sk);
|
||||
if (s->idle_outsize + lb + l > s->period_size)
|
||||
goto check;
|
||||
|
||||
sk->out_phase = sk->out_phase_peeked;
|
||||
urb->iso_frame_desc[pack].offset = lb;
|
||||
urb->iso_frame_desc[pack].length = l;
|
||||
lb += l;
|
||||
}
|
||||
snd_printdd(KERN_DEBUG "%i\n", lb);
|
||||
|
||||
check:
|
||||
urb->number_of_packets = pack;
|
||||
urb->transfer_buffer_length = lb;
|
||||
s->idle_outsize += lb - s->period_size;
|
||||
snd_printdd(KERN_DEBUG "idle=%i ul=%i ps=%i\n", s->idle_outsize,
|
||||
lb, s->period_size);
|
||||
}
|
||||
|
||||
static void init_pipe_urbs(struct usb_stream_kernel *sk, unsigned use_packsize,
|
||||
struct urb **urbs, char *transfer,
|
||||
struct usb_device *dev, int pipe)
|
||||
{
|
||||
int u, p;
|
||||
int maxpacket = use_packsize ?
|
||||
use_packsize : usb_maxpacket(dev, pipe, usb_pipeout(pipe));
|
||||
int transfer_length = maxpacket * sk->n_o_ps;
|
||||
|
||||
for (u = 0; u < USB_STREAM_NURBS;
|
||||
++u, transfer += transfer_length) {
|
||||
struct urb *urb = urbs[u];
|
||||
struct usb_iso_packet_descriptor *desc;
|
||||
urb->transfer_buffer = transfer;
|
||||
urb->dev = dev;
|
||||
urb->pipe = pipe;
|
||||
urb->number_of_packets = sk->n_o_ps;
|
||||
urb->context = sk;
|
||||
urb->interval = 1;
|
||||
if (usb_pipeout(pipe))
|
||||
continue;
|
||||
|
||||
urb->transfer_buffer_length = transfer_length;
|
||||
desc = urb->iso_frame_desc;
|
||||
desc->offset = 0;
|
||||
desc->length = maxpacket;
|
||||
for (p = 1; p < sk->n_o_ps; ++p) {
|
||||
desc[p].offset = desc[p - 1].offset + maxpacket;
|
||||
desc[p].length = maxpacket;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void init_urbs(struct usb_stream_kernel *sk, unsigned use_packsize,
|
||||
struct usb_device *dev, int in_pipe, int out_pipe)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
char *indata = (char *)s + sizeof(*s) +
|
||||
sizeof(struct usb_stream_packet) *
|
||||
s->inpackets;
|
||||
int u;
|
||||
|
||||
for (u = 0; u < USB_STREAM_NURBS; ++u) {
|
||||
sk->inurb[u] = usb_alloc_urb(sk->n_o_ps, GFP_KERNEL);
|
||||
sk->outurb[u] = usb_alloc_urb(sk->n_o_ps, GFP_KERNEL);
|
||||
}
|
||||
|
||||
init_pipe_urbs(sk, use_packsize, sk->inurb, indata, dev, in_pipe);
|
||||
init_pipe_urbs(sk, use_packsize, sk->outurb, sk->write_page, dev,
|
||||
out_pipe);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* convert a sampling rate into our full speed format (fs/1000 in Q16.16)
|
||||
* this will overflow at approx 524 kHz
|
||||
*/
|
||||
static inline unsigned get_usb_full_speed_rate(unsigned rate)
|
||||
{
|
||||
return ((rate << 13) + 62) / 125;
|
||||
}
|
||||
|
||||
/*
|
||||
* convert a sampling rate into USB high speed format (fs/8000 in Q16.16)
|
||||
* this will overflow at approx 4 MHz
|
||||
*/
|
||||
static inline unsigned get_usb_high_speed_rate(unsigned rate)
|
||||
{
|
||||
return ((rate << 10) + 62) / 125;
|
||||
}
|
||||
|
||||
void usb_stream_free(struct usb_stream_kernel *sk)
|
||||
{
|
||||
struct usb_stream *s;
|
||||
unsigned u;
|
||||
|
||||
for (u = 0; u < USB_STREAM_NURBS; ++u) {
|
||||
usb_free_urb(sk->inurb[u]);
|
||||
sk->inurb[u] = NULL;
|
||||
usb_free_urb(sk->outurb[u]);
|
||||
sk->outurb[u] = NULL;
|
||||
}
|
||||
|
||||
s = sk->s;
|
||||
if (!s)
|
||||
return;
|
||||
|
||||
free_pages((unsigned long)sk->write_page, get_order(s->write_size));
|
||||
sk->write_page = NULL;
|
||||
free_pages((unsigned long)s, get_order(s->read_size));
|
||||
sk->s = NULL;
|
||||
}
|
||||
|
||||
struct usb_stream *usb_stream_new(struct usb_stream_kernel *sk,
|
||||
struct usb_device *dev,
|
||||
unsigned in_endpoint, unsigned out_endpoint,
|
||||
unsigned sample_rate, unsigned use_packsize,
|
||||
unsigned period_frames, unsigned frame_size)
|
||||
{
|
||||
int packets, max_packsize;
|
||||
int in_pipe, out_pipe;
|
||||
int read_size = sizeof(struct usb_stream);
|
||||
int write_size;
|
||||
int usb_frames = dev->speed == USB_SPEED_HIGH ? 8000 : 1000;
|
||||
int pg;
|
||||
|
||||
in_pipe = usb_rcvisocpipe(dev, in_endpoint);
|
||||
out_pipe = usb_sndisocpipe(dev, out_endpoint);
|
||||
|
||||
max_packsize = use_packsize ?
|
||||
use_packsize : usb_maxpacket(dev, in_pipe, 0);
|
||||
|
||||
/*
|
||||
t_period = period_frames / sample_rate
|
||||
iso_packs = t_period / t_iso_frame
|
||||
= (period_frames / sample_rate) * (1 / t_iso_frame)
|
||||
*/
|
||||
|
||||
packets = period_frames * usb_frames / sample_rate + 1;
|
||||
|
||||
if (dev->speed == USB_SPEED_HIGH)
|
||||
packets = (packets + 7) & ~7;
|
||||
|
||||
read_size += packets * USB_STREAM_URBDEPTH *
|
||||
(max_packsize + sizeof(struct usb_stream_packet));
|
||||
|
||||
max_packsize = usb_maxpacket(dev, out_pipe, 1);
|
||||
write_size = max_packsize * packets * USB_STREAM_URBDEPTH;
|
||||
|
||||
if (read_size >= 256*PAGE_SIZE || write_size >= 256*PAGE_SIZE) {
|
||||
snd_printk(KERN_WARNING "a size exceeds 128*PAGE_SIZE\n");
|
||||
goto out;
|
||||
}
|
||||
|
||||
pg = get_order(read_size);
|
||||
sk->s = (void *) __get_free_pages(GFP_KERNEL|__GFP_COMP|__GFP_ZERO, pg);
|
||||
if (!sk->s) {
|
||||
snd_printk(KERN_WARNING "couldn't __get_free_pages()\n");
|
||||
goto out;
|
||||
}
|
||||
sk->s->cfg.version = USB_STREAM_INTERFACE_VERSION;
|
||||
|
||||
sk->s->read_size = read_size;
|
||||
|
||||
sk->s->cfg.sample_rate = sample_rate;
|
||||
sk->s->cfg.frame_size = frame_size;
|
||||
sk->n_o_ps = packets;
|
||||
sk->s->inpackets = packets * USB_STREAM_URBDEPTH;
|
||||
sk->s->cfg.period_frames = period_frames;
|
||||
sk->s->period_size = frame_size * period_frames;
|
||||
|
||||
sk->s->write_size = write_size;
|
||||
pg = get_order(write_size);
|
||||
|
||||
sk->write_page =
|
||||
(void *)__get_free_pages(GFP_KERNEL|__GFP_COMP|__GFP_ZERO, pg);
|
||||
if (!sk->write_page) {
|
||||
snd_printk(KERN_WARNING "couldn't __get_free_pages()\n");
|
||||
usb_stream_free(sk);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* calculate the frequency in 16.16 format */
|
||||
if (dev->speed == USB_SPEED_FULL)
|
||||
sk->freqn = get_usb_full_speed_rate(sample_rate);
|
||||
else
|
||||
sk->freqn = get_usb_high_speed_rate(sample_rate);
|
||||
|
||||
init_urbs(sk, use_packsize, dev, in_pipe, out_pipe);
|
||||
sk->s->state = usb_stream_stopped;
|
||||
out:
|
||||
return sk->s;
|
||||
}
|
||||
|
||||
|
||||
/* start */
|
||||
|
||||
static bool balance_check(struct usb_stream_kernel *sk, struct urb *urb)
|
||||
{
|
||||
bool r;
|
||||
if (unlikely(urb->status)) {
|
||||
if (urb->status != -ESHUTDOWN && urb->status != -ENOENT)
|
||||
snd_printk(KERN_WARNING "status=%i\n", urb->status);
|
||||
sk->iso_frame_balance = 0x7FFFFFFF;
|
||||
return false;
|
||||
}
|
||||
r = sk->iso_frame_balance == 0;
|
||||
if (!r)
|
||||
sk->i_urb = urb;
|
||||
return r;
|
||||
}
|
||||
|
||||
static bool balance_playback(struct usb_stream_kernel *sk, struct urb *urb)
|
||||
{
|
||||
sk->iso_frame_balance += urb->number_of_packets;
|
||||
return balance_check(sk, urb);
|
||||
}
|
||||
|
||||
static bool balance_capture(struct usb_stream_kernel *sk, struct urb *urb)
|
||||
{
|
||||
sk->iso_frame_balance -= urb->number_of_packets;
|
||||
return balance_check(sk, urb);
|
||||
}
|
||||
|
||||
static void subs_set_complete(struct urb **urbs, void (*complete)(struct urb *))
|
||||
{
|
||||
int u;
|
||||
|
||||
for (u = 0; u < USB_STREAM_NURBS; u++) {
|
||||
struct urb *urb = urbs[u];
|
||||
urb->complete = complete;
|
||||
}
|
||||
}
|
||||
|
||||
static int usb_stream_prepare_playback(struct usb_stream_kernel *sk,
|
||||
struct urb *inurb)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
struct urb *io;
|
||||
struct usb_iso_packet_descriptor *id, *od;
|
||||
int p = 0, lb = 0, l = 0;
|
||||
|
||||
io = sk->idle_outurb;
|
||||
od = io->iso_frame_desc;
|
||||
|
||||
for (; s->sync_packet < 0; ++p, ++s->sync_packet) {
|
||||
struct urb *ii = sk->completed_inurb;
|
||||
id = ii->iso_frame_desc +
|
||||
ii->number_of_packets + s->sync_packet;
|
||||
l = id->actual_length;
|
||||
|
||||
od[p].length = l;
|
||||
od[p].offset = lb;
|
||||
lb += l;
|
||||
}
|
||||
|
||||
for (;
|
||||
s->sync_packet < inurb->number_of_packets && p < sk->n_o_ps;
|
||||
++p, ++s->sync_packet) {
|
||||
l = inurb->iso_frame_desc[s->sync_packet].actual_length;
|
||||
|
||||
if (s->idle_outsize + lb + l > s->period_size)
|
||||
goto check_ok;
|
||||
|
||||
od[p].length = l;
|
||||
od[p].offset = lb;
|
||||
lb += l;
|
||||
}
|
||||
|
||||
check_ok:
|
||||
s->sync_packet -= inurb->number_of_packets;
|
||||
if (unlikely(s->sync_packet < -2 || s->sync_packet > 0)) {
|
||||
snd_printk(KERN_WARNING "invalid sync_packet = %i;"
|
||||
" p=%i nop=%i %i %x %x %x > %x\n",
|
||||
s->sync_packet, p, inurb->number_of_packets,
|
||||
s->idle_outsize + lb + l,
|
||||
s->idle_outsize, lb, l,
|
||||
s->period_size);
|
||||
return -1;
|
||||
}
|
||||
if (unlikely(lb % s->cfg.frame_size)) {
|
||||
snd_printk(KERN_WARNING"invalid outsize = %i\n",
|
||||
lb);
|
||||
return -1;
|
||||
}
|
||||
s->idle_outsize += lb - s->period_size;
|
||||
io->number_of_packets = p;
|
||||
io->transfer_buffer_length = lb;
|
||||
if (s->idle_outsize <= 0)
|
||||
return 0;
|
||||
|
||||
snd_printk(KERN_WARNING "idle=%i\n", s->idle_outsize);
|
||||
return -1;
|
||||
}
|
||||
|
||||
static void prepare_inurb(int number_of_packets, struct urb *iu)
|
||||
{
|
||||
struct usb_iso_packet_descriptor *id;
|
||||
int p;
|
||||
|
||||
iu->number_of_packets = number_of_packets;
|
||||
id = iu->iso_frame_desc;
|
||||
id->offset = 0;
|
||||
for (p = 0; p < iu->number_of_packets - 1; ++p)
|
||||
id[p + 1].offset = id[p].offset + id[p].length;
|
||||
|
||||
iu->transfer_buffer_length =
|
||||
id[0].length * iu->number_of_packets;
|
||||
}
|
||||
|
||||
static int submit_urbs(struct usb_stream_kernel *sk,
|
||||
struct urb *inurb, struct urb *outurb)
|
||||
{
|
||||
int err;
|
||||
prepare_inurb(sk->idle_outurb->number_of_packets, sk->idle_inurb);
|
||||
err = usb_submit_urb(sk->idle_inurb, GFP_ATOMIC);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR "%i\n", err);
|
||||
return err;
|
||||
}
|
||||
sk->idle_inurb = sk->completed_inurb;
|
||||
sk->completed_inurb = inurb;
|
||||
err = usb_submit_urb(sk->idle_outurb, GFP_ATOMIC);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR "%i\n", err);
|
||||
return err;
|
||||
}
|
||||
sk->idle_outurb = sk->completed_outurb;
|
||||
sk->completed_outurb = outurb;
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef DEBUG_LOOP_BACK
|
||||
/*
|
||||
This loop_back() shows how to read/write the period data.
|
||||
*/
|
||||
static void loop_back(struct usb_stream *s)
|
||||
{
|
||||
char *i, *o;
|
||||
int il, ol, l, p;
|
||||
struct urb *iu;
|
||||
struct usb_iso_packet_descriptor *id;
|
||||
|
||||
o = s->playback1st_to;
|
||||
ol = s->playback1st_size;
|
||||
l = 0;
|
||||
|
||||
if (s->insplit_pack >= 0) {
|
||||
iu = sk->idle_inurb;
|
||||
id = iu->iso_frame_desc;
|
||||
p = s->insplit_pack;
|
||||
} else
|
||||
goto second;
|
||||
loop:
|
||||
for (; p < iu->number_of_packets && l < s->period_size; ++p) {
|
||||
i = iu->transfer_buffer + id[p].offset;
|
||||
il = id[p].actual_length;
|
||||
if (l + il > s->period_size)
|
||||
il = s->period_size - l;
|
||||
if (il <= ol) {
|
||||
memcpy(o, i, il);
|
||||
o += il;
|
||||
ol -= il;
|
||||
} else {
|
||||
memcpy(o, i, ol);
|
||||
singen_6pack(o, ol);
|
||||
o = s->playback_to;
|
||||
memcpy(o, i + ol, il - ol);
|
||||
o += il - ol;
|
||||
ol = s->period_size - s->playback1st_size;
|
||||
}
|
||||
l += il;
|
||||
}
|
||||
if (iu == sk->completed_inurb) {
|
||||
if (l != s->period_size)
|
||||
printk(KERN_DEBUG"%s:%i %i\n", __func__, __LINE__,
|
||||
l/(int)s->cfg.frame_size);
|
||||
|
||||
return;
|
||||
}
|
||||
second:
|
||||
iu = sk->completed_inurb;
|
||||
id = iu->iso_frame_desc;
|
||||
p = 0;
|
||||
goto loop;
|
||||
|
||||
}
|
||||
#else
|
||||
static void loop_back(struct usb_stream *s)
|
||||
{
|
||||
}
|
||||
#endif
|
||||
|
||||
static void stream_idle(struct usb_stream_kernel *sk,
|
||||
struct urb *inurb, struct urb *outurb)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
int l, p;
|
||||
int insize = s->idle_insize;
|
||||
int urb_size = 0;
|
||||
|
||||
s->inpacket_split = s->next_inpacket_split;
|
||||
s->inpacket_split_at = s->next_inpacket_split_at;
|
||||
s->next_inpacket_split = -1;
|
||||
s->next_inpacket_split_at = 0;
|
||||
|
||||
for (p = 0; p < inurb->number_of_packets; ++p) {
|
||||
struct usb_iso_packet_descriptor *id = inurb->iso_frame_desc;
|
||||
l = id[p].actual_length;
|
||||
if (unlikely(l == 0 || id[p].status)) {
|
||||
snd_printk(KERN_WARNING "underrun, status=%u\n",
|
||||
id[p].status);
|
||||
goto err_out;
|
||||
}
|
||||
s->inpacket_head++;
|
||||
s->inpacket_head %= s->inpackets;
|
||||
if (s->inpacket_split == -1)
|
||||
s->inpacket_split = s->inpacket_head;
|
||||
|
||||
s->inpacket[s->inpacket_head].offset =
|
||||
id[p].offset + (inurb->transfer_buffer - (void *)s);
|
||||
s->inpacket[s->inpacket_head].length = l;
|
||||
if (insize + l > s->period_size &&
|
||||
s->next_inpacket_split == -1) {
|
||||
s->next_inpacket_split = s->inpacket_head;
|
||||
s->next_inpacket_split_at = s->period_size - insize;
|
||||
}
|
||||
insize += l;
|
||||
urb_size += l;
|
||||
}
|
||||
s->idle_insize += urb_size - s->period_size;
|
||||
if (s->idle_insize < 0) {
|
||||
snd_printk(KERN_WARNING "%i\n",
|
||||
(s->idle_insize)/(int)s->cfg.frame_size);
|
||||
goto err_out;
|
||||
}
|
||||
s->insize_done += urb_size;
|
||||
|
||||
l = s->idle_outsize;
|
||||
s->outpacket[0].offset = (sk->idle_outurb->transfer_buffer -
|
||||
sk->write_page) - l;
|
||||
|
||||
if (usb_stream_prepare_playback(sk, inurb) < 0)
|
||||
goto err_out;
|
||||
|
||||
s->outpacket[0].length = sk->idle_outurb->transfer_buffer_length + l;
|
||||
s->outpacket[1].offset = sk->completed_outurb->transfer_buffer -
|
||||
sk->write_page;
|
||||
|
||||
if (submit_urbs(sk, inurb, outurb) < 0)
|
||||
goto err_out;
|
||||
|
||||
loop_back(s);
|
||||
s->periods_done++;
|
||||
wake_up_all(&sk->sleep);
|
||||
return;
|
||||
err_out:
|
||||
s->state = usb_stream_xrun;
|
||||
wake_up_all(&sk->sleep);
|
||||
}
|
||||
|
||||
static void i_capture_idle(struct urb *urb)
|
||||
{
|
||||
struct usb_stream_kernel *sk = urb->context;
|
||||
if (balance_capture(sk, urb))
|
||||
stream_idle(sk, urb, sk->i_urb);
|
||||
}
|
||||
|
||||
static void i_playback_idle(struct urb *urb)
|
||||
{
|
||||
struct usb_stream_kernel *sk = urb->context;
|
||||
if (balance_playback(sk, urb))
|
||||
stream_idle(sk, sk->i_urb, urb);
|
||||
}
|
||||
|
||||
static void stream_start(struct usb_stream_kernel *sk,
|
||||
struct urb *inurb, struct urb *outurb)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
if (s->state >= usb_stream_sync1) {
|
||||
int l, p, max_diff, max_diff_0;
|
||||
int urb_size = 0;
|
||||
unsigned frames_per_packet, min_frames = 0;
|
||||
frames_per_packet = (s->period_size - s->idle_insize);
|
||||
frames_per_packet <<= 8;
|
||||
frames_per_packet /=
|
||||
s->cfg.frame_size * inurb->number_of_packets;
|
||||
frames_per_packet++;
|
||||
|
||||
max_diff_0 = s->cfg.frame_size;
|
||||
if (s->cfg.period_frames >= 256)
|
||||
max_diff_0 <<= 1;
|
||||
if (s->cfg.period_frames >= 1024)
|
||||
max_diff_0 <<= 1;
|
||||
max_diff = max_diff_0;
|
||||
for (p = 0; p < inurb->number_of_packets; ++p) {
|
||||
int diff;
|
||||
l = inurb->iso_frame_desc[p].actual_length;
|
||||
urb_size += l;
|
||||
|
||||
min_frames += frames_per_packet;
|
||||
diff = urb_size -
|
||||
(min_frames >> 8) * s->cfg.frame_size;
|
||||
if (diff < max_diff) {
|
||||
snd_printdd(KERN_DEBUG "%i %i %i %i\n",
|
||||
s->insize_done,
|
||||
urb_size / (int)s->cfg.frame_size,
|
||||
inurb->number_of_packets, diff);
|
||||
max_diff = diff;
|
||||
}
|
||||
}
|
||||
s->idle_insize -= max_diff - max_diff_0;
|
||||
s->idle_insize += urb_size - s->period_size;
|
||||
if (s->idle_insize < 0) {
|
||||
snd_printk(KERN_WARNING "%i %i %i\n",
|
||||
s->idle_insize, urb_size, s->period_size);
|
||||
return;
|
||||
} else if (s->idle_insize == 0) {
|
||||
s->next_inpacket_split =
|
||||
(s->inpacket_head + 1) % s->inpackets;
|
||||
s->next_inpacket_split_at = 0;
|
||||
} else {
|
||||
unsigned split = s->inpacket_head;
|
||||
l = s->idle_insize;
|
||||
while (l > s->inpacket[split].length) {
|
||||
l -= s->inpacket[split].length;
|
||||
if (split == 0)
|
||||
split = s->inpackets - 1;
|
||||
else
|
||||
split--;
|
||||
}
|
||||
s->next_inpacket_split = split;
|
||||
s->next_inpacket_split_at =
|
||||
s->inpacket[split].length - l;
|
||||
}
|
||||
|
||||
s->insize_done += urb_size;
|
||||
|
||||
if (usb_stream_prepare_playback(sk, inurb) < 0)
|
||||
return;
|
||||
|
||||
} else
|
||||
playback_prep_freqn(sk, sk->idle_outurb);
|
||||
|
||||
if (submit_urbs(sk, inurb, outurb) < 0)
|
||||
return;
|
||||
|
||||
if (s->state == usb_stream_sync1 && s->insize_done > 360000) {
|
||||
/* just guesswork ^^^^^^ */
|
||||
s->state = usb_stream_ready;
|
||||
subs_set_complete(sk->inurb, i_capture_idle);
|
||||
subs_set_complete(sk->outurb, i_playback_idle);
|
||||
}
|
||||
}
|
||||
|
||||
static void i_capture_start(struct urb *urb)
|
||||
{
|
||||
struct usb_iso_packet_descriptor *id = urb->iso_frame_desc;
|
||||
struct usb_stream_kernel *sk = urb->context;
|
||||
struct usb_stream *s = sk->s;
|
||||
int p;
|
||||
int empty = 0;
|
||||
|
||||
if (urb->status) {
|
||||
snd_printk(KERN_WARNING "status=%i\n", urb->status);
|
||||
return;
|
||||
}
|
||||
|
||||
for (p = 0; p < urb->number_of_packets; ++p) {
|
||||
int l = id[p].actual_length;
|
||||
if (l < s->cfg.frame_size) {
|
||||
++empty;
|
||||
if (s->state >= usb_stream_sync0) {
|
||||
snd_printk(KERN_WARNING "%i\n", l);
|
||||
return;
|
||||
}
|
||||
}
|
||||
s->inpacket_head++;
|
||||
s->inpacket_head %= s->inpackets;
|
||||
s->inpacket[s->inpacket_head].offset =
|
||||
id[p].offset + (urb->transfer_buffer - (void *)s);
|
||||
s->inpacket[s->inpacket_head].length = l;
|
||||
}
|
||||
#ifdef SHOW_EMPTY
|
||||
if (empty) {
|
||||
printk(KERN_DEBUG"%s:%i: %i", __func__, __LINE__,
|
||||
urb->iso_frame_desc[0].actual_length);
|
||||
for (pack = 1; pack < urb->number_of_packets; ++pack) {
|
||||
int l = urb->iso_frame_desc[pack].actual_length;
|
||||
printk(" %i", l);
|
||||
}
|
||||
printk("\n");
|
||||
}
|
||||
#endif
|
||||
if (!empty && s->state < usb_stream_sync1)
|
||||
++s->state;
|
||||
|
||||
if (balance_capture(sk, urb))
|
||||
stream_start(sk, urb, sk->i_urb);
|
||||
}
|
||||
|
||||
static void i_playback_start(struct urb *urb)
|
||||
{
|
||||
struct usb_stream_kernel *sk = urb->context;
|
||||
if (balance_playback(sk, urb))
|
||||
stream_start(sk, sk->i_urb, urb);
|
||||
}
|
||||
|
||||
int usb_stream_start(struct usb_stream_kernel *sk)
|
||||
{
|
||||
struct usb_stream *s = sk->s;
|
||||
int frame = 0, iters = 0;
|
||||
int u, err;
|
||||
int try = 0;
|
||||
|
||||
if (s->state != usb_stream_stopped)
|
||||
return -EAGAIN;
|
||||
|
||||
subs_set_complete(sk->inurb, i_capture_start);
|
||||
subs_set_complete(sk->outurb, i_playback_start);
|
||||
memset(sk->write_page, 0, s->write_size);
|
||||
dotry:
|
||||
s->insize_done = 0;
|
||||
s->idle_insize = 0;
|
||||
s->idle_outsize = 0;
|
||||
s->sync_packet = -1;
|
||||
s->inpacket_head = -1;
|
||||
sk->iso_frame_balance = 0;
|
||||
++try;
|
||||
for (u = 0; u < 2; u++) {
|
||||
struct urb *inurb = sk->inurb[u];
|
||||
struct urb *outurb = sk->outurb[u];
|
||||
playback_prep_freqn(sk, outurb);
|
||||
inurb->number_of_packets = outurb->number_of_packets;
|
||||
inurb->transfer_buffer_length =
|
||||
inurb->number_of_packets *
|
||||
inurb->iso_frame_desc[0].length;
|
||||
|
||||
if (u == 0) {
|
||||
int now;
|
||||
struct usb_device *dev = inurb->dev;
|
||||
frame = usb_get_current_frame_number(dev);
|
||||
do {
|
||||
now = usb_get_current_frame_number(dev);
|
||||
++iters;
|
||||
} while (now > -1 && now == frame);
|
||||
}
|
||||
err = usb_submit_urb(inurb, GFP_ATOMIC);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR"usb_submit_urb(sk->inurb[%i])"
|
||||
" returned %i\n", u, err);
|
||||
return err;
|
||||
}
|
||||
err = usb_submit_urb(outurb, GFP_ATOMIC);
|
||||
if (err < 0) {
|
||||
snd_printk(KERN_ERR"usb_submit_urb(sk->outurb[%i])"
|
||||
" returned %i\n", u, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
if (inurb->start_frame != outurb->start_frame) {
|
||||
snd_printd(KERN_DEBUG
|
||||
"u[%i] start_frames differ in:%u out:%u\n",
|
||||
u, inurb->start_frame, outurb->start_frame);
|
||||
goto check_retry;
|
||||
}
|
||||
}
|
||||
snd_printdd(KERN_DEBUG "%i %i\n", frame, iters);
|
||||
try = 0;
|
||||
check_retry:
|
||||
if (try) {
|
||||
usb_stream_stop(sk);
|
||||
if (try < 5) {
|
||||
msleep(1500);
|
||||
snd_printd(KERN_DEBUG "goto dotry;\n");
|
||||
goto dotry;
|
||||
}
|
||||
snd_printk(KERN_WARNING"couldn't start"
|
||||
" all urbs on the same start_frame.\n");
|
||||
return -EFAULT;
|
||||
}
|
||||
|
||||
sk->idle_inurb = sk->inurb[USB_STREAM_NURBS - 2];
|
||||
sk->idle_outurb = sk->outurb[USB_STREAM_NURBS - 2];
|
||||
sk->completed_inurb = sk->inurb[USB_STREAM_NURBS - 1];
|
||||
sk->completed_outurb = sk->outurb[USB_STREAM_NURBS - 1];
|
||||
|
||||
/* wait, check */
|
||||
{
|
||||
int wait_ms = 3000;
|
||||
while (s->state != usb_stream_ready && wait_ms > 0) {
|
||||
snd_printdd(KERN_DEBUG "%i\n", s->state);
|
||||
msleep(200);
|
||||
wait_ms -= 200;
|
||||
}
|
||||
}
|
||||
|
||||
return s->state == usb_stream_ready ? 0 : -EFAULT;
|
||||
}
|
||||
|
||||
|
||||
/* stop */
|
||||
|
||||
void usb_stream_stop(struct usb_stream_kernel *sk)
|
||||
{
|
||||
int u;
|
||||
if (!sk->s)
|
||||
return;
|
||||
for (u = 0; u < USB_STREAM_NURBS; ++u) {
|
||||
usb_kill_urb(sk->inurb[u]);
|
||||
usb_kill_urb(sk->outurb[u]);
|
||||
}
|
||||
sk->s->state = usb_stream_stopped;
|
||||
msleep(400);
|
||||
}
|
112
sound/usb/usx2y/usb_stream.h
Normal file
112
sound/usb/usx2y/usb_stream.h
Normal file
|
@ -0,0 +1,112 @@
|
|||
/*
|
||||
* Copyright (C) 2007, 2008 Karsten Wiese <fzu@wemgehoertderstaat.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful, but
|
||||
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
||||
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
||||
* for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software Foundation,
|
||||
* Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*/
|
||||
|
||||
#define USB_STREAM_INTERFACE_VERSION 2
|
||||
|
||||
#define SNDRV_USB_STREAM_IOCTL_SET_PARAMS \
|
||||
_IOW('H', 0x90, struct usb_stream_config)
|
||||
|
||||
struct usb_stream_packet {
|
||||
unsigned offset;
|
||||
unsigned length;
|
||||
};
|
||||
|
||||
|
||||
struct usb_stream_config {
|
||||
unsigned version;
|
||||
unsigned sample_rate;
|
||||
unsigned period_frames;
|
||||
unsigned frame_size;
|
||||
};
|
||||
|
||||
struct usb_stream {
|
||||
struct usb_stream_config cfg;
|
||||
unsigned read_size;
|
||||
unsigned write_size;
|
||||
|
||||
int period_size;
|
||||
|
||||
unsigned state;
|
||||
|
||||
int idle_insize;
|
||||
int idle_outsize;
|
||||
int sync_packet;
|
||||
unsigned insize_done;
|
||||
unsigned periods_done;
|
||||
unsigned periods_polled;
|
||||
|
||||
struct usb_stream_packet outpacket[2];
|
||||
unsigned inpackets;
|
||||
unsigned inpacket_head;
|
||||
unsigned inpacket_split;
|
||||
unsigned inpacket_split_at;
|
||||
unsigned next_inpacket_split;
|
||||
unsigned next_inpacket_split_at;
|
||||
struct usb_stream_packet inpacket[0];
|
||||
};
|
||||
|
||||
enum usb_stream_state {
|
||||
usb_stream_invalid,
|
||||
usb_stream_stopped,
|
||||
usb_stream_sync0,
|
||||
usb_stream_sync1,
|
||||
usb_stream_ready,
|
||||
usb_stream_running,
|
||||
usb_stream_xrun,
|
||||
};
|
||||
|
||||
#if __KERNEL__
|
||||
|
||||
#define USB_STREAM_NURBS 4
|
||||
#define USB_STREAM_URBDEPTH 4
|
||||
|
||||
struct usb_stream_kernel {
|
||||
struct usb_stream *s;
|
||||
|
||||
void *write_page;
|
||||
|
||||
unsigned n_o_ps;
|
||||
|
||||
struct urb *inurb[USB_STREAM_NURBS];
|
||||
struct urb *idle_inurb;
|
||||
struct urb *completed_inurb;
|
||||
struct urb *outurb[USB_STREAM_NURBS];
|
||||
struct urb *idle_outurb;
|
||||
struct urb *completed_outurb;
|
||||
struct urb *i_urb;
|
||||
|
||||
int iso_frame_balance;
|
||||
|
||||
wait_queue_head_t sleep;
|
||||
|
||||
unsigned out_phase;
|
||||
unsigned out_phase_peeked;
|
||||
unsigned freqn;
|
||||
};
|
||||
|
||||
struct usb_stream *usb_stream_new(struct usb_stream_kernel *sk,
|
||||
struct usb_device *dev,
|
||||
unsigned in_endpoint, unsigned out_endpoint,
|
||||
unsigned sample_rate, unsigned use_packsize,
|
||||
unsigned period_frames, unsigned frame_size);
|
||||
void usb_stream_free(struct usb_stream_kernel *);
|
||||
int usb_stream_start(struct usb_stream_kernel *);
|
||||
void usb_stream_stop(struct usb_stream_kernel *);
|
||||
|
||||
|
||||
#endif
|
104
sound/usb/usx2y/usbus428ctldefs.h
Normal file
104
sound/usb/usx2y/usbus428ctldefs.h
Normal file
|
@ -0,0 +1,104 @@
|
|||
/*
|
||||
*
|
||||
* Copyright (c) 2003 by Karsten Wiese <annabellesgarden@yahoo.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
enum E_In84{
|
||||
eFader0 = 0,
|
||||
eFader1,
|
||||
eFader2,
|
||||
eFader3,
|
||||
eFader4,
|
||||
eFader5,
|
||||
eFader6,
|
||||
eFader7,
|
||||
eFaderM,
|
||||
eTransport,
|
||||
eModifier = 10,
|
||||
eFilterSelect,
|
||||
eSelect,
|
||||
eMute,
|
||||
|
||||
eSwitch = 15,
|
||||
eWheelGain,
|
||||
eWheelFreq,
|
||||
eWheelQ,
|
||||
eWheelPan,
|
||||
eWheel = 20
|
||||
};
|
||||
|
||||
#define T_RECORD 1
|
||||
#define T_PLAY 2
|
||||
#define T_STOP 4
|
||||
#define T_F_FWD 8
|
||||
#define T_REW 0x10
|
||||
#define T_SOLO 0x20
|
||||
#define T_REC 0x40
|
||||
#define T_NULL 0x80
|
||||
|
||||
|
||||
struct us428_ctls {
|
||||
unsigned char Fader[9];
|
||||
unsigned char Transport;
|
||||
unsigned char Modifier;
|
||||
unsigned char FilterSelect;
|
||||
unsigned char Select;
|
||||
unsigned char Mute;
|
||||
unsigned char UNKNOWN;
|
||||
unsigned char Switch;
|
||||
unsigned char Wheel[5];
|
||||
};
|
||||
|
||||
struct us428_setByte {
|
||||
unsigned char Offset,
|
||||
Value;
|
||||
};
|
||||
|
||||
enum {
|
||||
eLT_Volume = 0,
|
||||
eLT_Light
|
||||
};
|
||||
|
||||
struct usX2Y_volume {
|
||||
unsigned char Channel,
|
||||
LH,
|
||||
LL,
|
||||
RH,
|
||||
RL;
|
||||
};
|
||||
|
||||
struct us428_lights {
|
||||
struct us428_setByte Light[7];
|
||||
};
|
||||
|
||||
struct us428_p4out {
|
||||
char type;
|
||||
union {
|
||||
struct usX2Y_volume vol;
|
||||
struct us428_lights lights;
|
||||
} val;
|
||||
};
|
||||
|
||||
#define N_us428_ctl_BUFS 16
|
||||
#define N_us428_p4out_BUFS 16
|
||||
struct us428ctls_sharedmem{
|
||||
struct us428_ctls CtlSnapShot[N_us428_ctl_BUFS];
|
||||
int CtlSnapShotDiffersAt[N_us428_ctl_BUFS];
|
||||
int CtlSnapShotLast, CtlSnapShotRed;
|
||||
struct us428_p4out p4out[N_us428_p4out_BUFS];
|
||||
int p4outLast, p4outSent;
|
||||
};
|
461
sound/usb/usx2y/usbusx2y.c
Normal file
461
sound/usb/usx2y/usbusx2y.c
Normal file
|
@ -0,0 +1,461 @@
|
|||
/*
|
||||
* usbusy2y.c - ALSA USB US-428 Driver
|
||||
*
|
||||
2005-04-14 Karsten Wiese
|
||||
Version 0.8.7.2:
|
||||
Call snd_card_free() instead of snd_card_free_in_thread() to prevent oops with dead keyboard symptom.
|
||||
Tested ok with kernel 2.6.12-rc2.
|
||||
|
||||
2004-12-14 Karsten Wiese
|
||||
Version 0.8.7.1:
|
||||
snd_pcm_open for rawusb pcm-devices now returns -EBUSY if called without rawusb's hwdep device being open.
|
||||
|
||||
2004-12-02 Karsten Wiese
|
||||
Version 0.8.7:
|
||||
Use macro usb_maxpacket() for portability.
|
||||
|
||||
2004-10-26 Karsten Wiese
|
||||
Version 0.8.6:
|
||||
wake_up() process waiting in usX2Y_urbs_start() on error.
|
||||
|
||||
2004-10-21 Karsten Wiese
|
||||
Version 0.8.5:
|
||||
nrpacks is runtime or compiletime configurable now with tested values from 1 to 4.
|
||||
|
||||
2004-10-03 Karsten Wiese
|
||||
Version 0.8.2:
|
||||
Avoid any possible racing while in prepare callback.
|
||||
|
||||
2004-09-30 Karsten Wiese
|
||||
Version 0.8.0:
|
||||
Simplified things and made ohci work again.
|
||||
|
||||
2004-09-20 Karsten Wiese
|
||||
Version 0.7.3:
|
||||
Use usb_kill_urb() instead of deprecated (kernel 2.6.9) usb_unlink_urb().
|
||||
|
||||
2004-07-13 Karsten Wiese
|
||||
Version 0.7.1:
|
||||
Don't sleep in START/STOP callbacks anymore.
|
||||
us428 channels C/D not handled just for this version, sorry.
|
||||
|
||||
2004-06-21 Karsten Wiese
|
||||
Version 0.6.4:
|
||||
Temporarely suspend midi input
|
||||
to sanely call usb_set_interface() when setting format.
|
||||
|
||||
2004-06-12 Karsten Wiese
|
||||
Version 0.6.3:
|
||||
Made it thus the following rule is enforced:
|
||||
"All pcm substreams of one usX2Y have to operate at the same rate & format."
|
||||
|
||||
2004-04-06 Karsten Wiese
|
||||
Version 0.6.0:
|
||||
Runs on 2.6.5 kernel without any "--with-debug=" things.
|
||||
us224 reported running.
|
||||
|
||||
2004-01-14 Karsten Wiese
|
||||
Version 0.5.1:
|
||||
Runs with 2.6.1 kernel.
|
||||
|
||||
2003-12-30 Karsten Wiese
|
||||
Version 0.4.1:
|
||||
Fix 24Bit 4Channel capturing for the us428.
|
||||
|
||||
2003-11-27 Karsten Wiese, Martin Langer
|
||||
Version 0.4:
|
||||
us122 support.
|
||||
us224 could be tested by uncommenting the sections containing USB_ID_US224
|
||||
|
||||
2003-11-03 Karsten Wiese
|
||||
Version 0.3:
|
||||
24Bit support.
|
||||
"arecord -D hw:1 -c 2 -r 48000 -M -f S24_3LE|aplay -D hw:1 -c 2 -r 48000 -M -f S24_3LE" works.
|
||||
|
||||
2003-08-22 Karsten Wiese
|
||||
Version 0.0.8:
|
||||
Removed EZUSB Firmware. First Stage Firmwaredownload is now done by tascam-firmware downloader.
|
||||
See:
|
||||
http://usb-midi-fw.sourceforge.net/tascam-firmware.tar.gz
|
||||
|
||||
2003-06-18 Karsten Wiese
|
||||
Version 0.0.5:
|
||||
changed to compile with kernel 2.4.21 and alsa 0.9.4
|
||||
|
||||
2002-10-16 Karsten Wiese
|
||||
Version 0.0.4:
|
||||
compiles again with alsa-current.
|
||||
USB_ISO_ASAP not used anymore (most of the time), instead
|
||||
urb->start_frame is calculated here now, some calls inside usb-driver don't need to happen anymore.
|
||||
|
||||
To get the best out of this:
|
||||
Disable APM-support in the kernel as APM-BIOS calls (once each second) hard disable interrupt for many precious milliseconds.
|
||||
This helped me much on my slowish PII 400 & PIII 500.
|
||||
ACPI yet untested but might cause the same bad behaviour.
|
||||
Use a kernel with lowlatency and preemptiv patches applied.
|
||||
To autoload snd-usb-midi append a line
|
||||
post-install snd-usb-us428 modprobe snd-usb-midi
|
||||
to /etc/modules.conf.
|
||||
|
||||
known problems:
|
||||
sliders, knobs, lights not yet handled except MASTER Volume slider.
|
||||
"pcm -c 2" doesn't work. "pcm -c 2 -m direct_interleaved" does.
|
||||
KDE3: "Enable full duplex operation" deadlocks.
|
||||
|
||||
|
||||
2002-08-31 Karsten Wiese
|
||||
Version 0.0.3: audio also simplex;
|
||||
simplifying: iso urbs only 1 packet, melted structs.
|
||||
ASYNC_UNLINK not used anymore: no more crashes so far.....
|
||||
for alsa 0.9 rc3.
|
||||
|
||||
2002-08-09 Karsten Wiese
|
||||
Version 0.0.2: midi works with snd-usb-midi, audio (only fullduplex now) with i.e. bristol.
|
||||
The firmware has been sniffed from win2k us-428 driver 3.09.
|
||||
|
||||
* Copyright (c) 2002 - 2004 Karsten Wiese
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/usb.h>
|
||||
#include <sound/core.h>
|
||||
#include <sound/initval.h>
|
||||
#include <sound/pcm.h>
|
||||
|
||||
#include <sound/rawmidi.h>
|
||||
#include "usx2y.h"
|
||||
#include "usbusx2y.h"
|
||||
#include "usX2Yhwdep.h"
|
||||
|
||||
|
||||
|
||||
MODULE_AUTHOR("Karsten Wiese <annabellesgarden@yahoo.de>");
|
||||
MODULE_DESCRIPTION("TASCAM "NAME_ALLCAPS" Version 0.8.7.2");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_SUPPORTED_DEVICE("{{TASCAM(0x1604),"NAME_ALLCAPS"(0x8001)(0x8005)(0x8007)}}");
|
||||
|
||||
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-max */
|
||||
static char* id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* Id for this card */
|
||||
static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; /* Enable this card */
|
||||
|
||||
module_param_array(index, int, NULL, 0444);
|
||||
MODULE_PARM_DESC(index, "Index value for "NAME_ALLCAPS".");
|
||||
module_param_array(id, charp, NULL, 0444);
|
||||
MODULE_PARM_DESC(id, "ID string for "NAME_ALLCAPS".");
|
||||
module_param_array(enable, bool, NULL, 0444);
|
||||
MODULE_PARM_DESC(enable, "Enable "NAME_ALLCAPS".");
|
||||
|
||||
|
||||
static int snd_usX2Y_card_used[SNDRV_CARDS];
|
||||
|
||||
static void usX2Y_usb_disconnect(struct usb_device* usb_device, void* ptr);
|
||||
static void snd_usX2Y_card_private_free(struct snd_card *card);
|
||||
|
||||
/*
|
||||
* pipe 4 is used for switching the lamps, setting samplerate, volumes ....
|
||||
*/
|
||||
static void i_usX2Y_Out04Int(struct urb *urb)
|
||||
{
|
||||
#ifdef CONFIG_SND_DEBUG
|
||||
if (urb->status) {
|
||||
int i;
|
||||
struct usX2Ydev *usX2Y = urb->context;
|
||||
for (i = 0; i < 10 && usX2Y->AS04.urb[i] != urb; i++);
|
||||
snd_printdd("i_usX2Y_Out04Int() urb %i status=%i\n", i, urb->status);
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
static void i_usX2Y_In04Int(struct urb *urb)
|
||||
{
|
||||
int err = 0;
|
||||
struct usX2Ydev *usX2Y = urb->context;
|
||||
struct us428ctls_sharedmem *us428ctls = usX2Y->us428ctls_sharedmem;
|
||||
|
||||
usX2Y->In04IntCalls++;
|
||||
|
||||
if (urb->status) {
|
||||
snd_printdd("Interrupt Pipe 4 came back with status=%i\n", urb->status);
|
||||
return;
|
||||
}
|
||||
|
||||
// printk("%i:0x%02X ", 8, (int)((unsigned char*)usX2Y->In04Buf)[8]); Master volume shows 0 here if fader is at max during boot ?!?
|
||||
if (us428ctls) {
|
||||
int diff = -1;
|
||||
if (-2 == us428ctls->CtlSnapShotLast) {
|
||||
diff = 0;
|
||||
memcpy(usX2Y->In04Last, usX2Y->In04Buf, sizeof(usX2Y->In04Last));
|
||||
us428ctls->CtlSnapShotLast = -1;
|
||||
} else {
|
||||
int i;
|
||||
for (i = 0; i < 21; i++) {
|
||||
if (usX2Y->In04Last[i] != ((char*)usX2Y->In04Buf)[i]) {
|
||||
if (diff < 0)
|
||||
diff = i;
|
||||
usX2Y->In04Last[i] = ((char*)usX2Y->In04Buf)[i];
|
||||
}
|
||||
}
|
||||
}
|
||||
if (0 <= diff) {
|
||||
int n = us428ctls->CtlSnapShotLast + 1;
|
||||
if (n >= N_us428_ctl_BUFS || n < 0)
|
||||
n = 0;
|
||||
memcpy(us428ctls->CtlSnapShot + n, usX2Y->In04Buf, sizeof(us428ctls->CtlSnapShot[0]));
|
||||
us428ctls->CtlSnapShotDiffersAt[n] = diff;
|
||||
us428ctls->CtlSnapShotLast = n;
|
||||
wake_up(&usX2Y->us428ctls_wait_queue_head);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
if (usX2Y->US04) {
|
||||
if (0 == usX2Y->US04->submitted)
|
||||
do {
|
||||
err = usb_submit_urb(usX2Y->US04->urb[usX2Y->US04->submitted++], GFP_ATOMIC);
|
||||
} while (!err && usX2Y->US04->submitted < usX2Y->US04->len);
|
||||
} else
|
||||
if (us428ctls && us428ctls->p4outLast >= 0 && us428ctls->p4outLast < N_us428_p4out_BUFS) {
|
||||
if (us428ctls->p4outLast != us428ctls->p4outSent) {
|
||||
int j, send = us428ctls->p4outSent + 1;
|
||||
if (send >= N_us428_p4out_BUFS)
|
||||
send = 0;
|
||||
for (j = 0; j < URBS_AsyncSeq && !err; ++j)
|
||||
if (0 == usX2Y->AS04.urb[j]->status) {
|
||||
struct us428_p4out *p4out = us428ctls->p4out + send; // FIXME if more than 1 p4out is new, 1 gets lost.
|
||||
usb_fill_bulk_urb(usX2Y->AS04.urb[j], usX2Y->dev,
|
||||
usb_sndbulkpipe(usX2Y->dev, 0x04), &p4out->val.vol,
|
||||
p4out->type == eLT_Light ? sizeof(struct us428_lights) : 5,
|
||||
i_usX2Y_Out04Int, usX2Y);
|
||||
err = usb_submit_urb(usX2Y->AS04.urb[j], GFP_ATOMIC);
|
||||
us428ctls->p4outSent = send;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (err)
|
||||
snd_printk(KERN_ERR "In04Int() usb_submit_urb err=%i\n", err);
|
||||
|
||||
urb->dev = usX2Y->dev;
|
||||
usb_submit_urb(urb, GFP_ATOMIC);
|
||||
}
|
||||
|
||||
/*
|
||||
* Prepare some urbs
|
||||
*/
|
||||
int usX2Y_AsyncSeq04_init(struct usX2Ydev *usX2Y)
|
||||
{
|
||||
int err = 0,
|
||||
i;
|
||||
|
||||
if (NULL == (usX2Y->AS04.buffer = kmalloc(URB_DataLen_AsyncSeq*URBS_AsyncSeq, GFP_KERNEL))) {
|
||||
err = -ENOMEM;
|
||||
} else
|
||||
for (i = 0; i < URBS_AsyncSeq; ++i) {
|
||||
if (NULL == (usX2Y->AS04.urb[i] = usb_alloc_urb(0, GFP_KERNEL))) {
|
||||
err = -ENOMEM;
|
||||
break;
|
||||
}
|
||||
usb_fill_bulk_urb( usX2Y->AS04.urb[i], usX2Y->dev,
|
||||
usb_sndbulkpipe(usX2Y->dev, 0x04),
|
||||
usX2Y->AS04.buffer + URB_DataLen_AsyncSeq*i, 0,
|
||||
i_usX2Y_Out04Int, usX2Y
|
||||
);
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
int usX2Y_In04_init(struct usX2Ydev *usX2Y)
|
||||
{
|
||||
if (! (usX2Y->In04urb = usb_alloc_urb(0, GFP_KERNEL)))
|
||||
return -ENOMEM;
|
||||
|
||||
if (! (usX2Y->In04Buf = kmalloc(21, GFP_KERNEL))) {
|
||||
usb_free_urb(usX2Y->In04urb);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
init_waitqueue_head(&usX2Y->In04WaitQueue);
|
||||
usb_fill_int_urb(usX2Y->In04urb, usX2Y->dev, usb_rcvintpipe(usX2Y->dev, 0x4),
|
||||
usX2Y->In04Buf, 21,
|
||||
i_usX2Y_In04Int, usX2Y,
|
||||
10);
|
||||
return usb_submit_urb(usX2Y->In04urb, GFP_KERNEL);
|
||||
}
|
||||
|
||||
static void usX2Y_unlinkSeq(struct snd_usX2Y_AsyncSeq *S)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < URBS_AsyncSeq; ++i) {
|
||||
usb_kill_urb(S->urb[i]);
|
||||
usb_free_urb(S->urb[i]);
|
||||
S->urb[i] = NULL;
|
||||
}
|
||||
kfree(S->buffer);
|
||||
}
|
||||
|
||||
|
||||
static struct usb_device_id snd_usX2Y_usb_id_table[] = {
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x1604,
|
||||
.idProduct = USB_ID_US428
|
||||
},
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x1604,
|
||||
.idProduct = USB_ID_US122
|
||||
},
|
||||
{
|
||||
.match_flags = USB_DEVICE_ID_MATCH_DEVICE,
|
||||
.idVendor = 0x1604,
|
||||
.idProduct = USB_ID_US224
|
||||
},
|
||||
{ /* terminator */ }
|
||||
};
|
||||
|
||||
static int usX2Y_create_card(struct usb_device *device,
|
||||
struct usb_interface *intf,
|
||||
struct snd_card **cardp)
|
||||
{
|
||||
int dev;
|
||||
struct snd_card * card;
|
||||
int err;
|
||||
|
||||
for (dev = 0; dev < SNDRV_CARDS; ++dev)
|
||||
if (enable[dev] && !snd_usX2Y_card_used[dev])
|
||||
break;
|
||||
if (dev >= SNDRV_CARDS)
|
||||
return -ENODEV;
|
||||
err = snd_card_new(&intf->dev, index[dev], id[dev], THIS_MODULE,
|
||||
sizeof(struct usX2Ydev), &card);
|
||||
if (err < 0)
|
||||
return err;
|
||||
snd_usX2Y_card_used[usX2Y(card)->card_index = dev] = 1;
|
||||
card->private_free = snd_usX2Y_card_private_free;
|
||||
usX2Y(card)->dev = device;
|
||||
init_waitqueue_head(&usX2Y(card)->prepare_wait_queue);
|
||||
mutex_init(&usX2Y(card)->pcm_mutex);
|
||||
INIT_LIST_HEAD(&usX2Y(card)->midi_list);
|
||||
strcpy(card->driver, "USB "NAME_ALLCAPS"");
|
||||
sprintf(card->shortname, "TASCAM "NAME_ALLCAPS"");
|
||||
sprintf(card->longname, "%s (%x:%x if %d at %03d/%03d)",
|
||||
card->shortname,
|
||||
le16_to_cpu(device->descriptor.idVendor),
|
||||
le16_to_cpu(device->descriptor.idProduct),
|
||||
0,//us428(card)->usbmidi.ifnum,
|
||||
usX2Y(card)->dev->bus->busnum, usX2Y(card)->dev->devnum
|
||||
);
|
||||
*cardp = card;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int usX2Y_usb_probe(struct usb_device *device,
|
||||
struct usb_interface *intf,
|
||||
const struct usb_device_id *device_id,
|
||||
struct snd_card **cardp)
|
||||
{
|
||||
int err;
|
||||
struct snd_card * card;
|
||||
|
||||
*cardp = NULL;
|
||||
if (le16_to_cpu(device->descriptor.idVendor) != 0x1604 ||
|
||||
(le16_to_cpu(device->descriptor.idProduct) != USB_ID_US122 &&
|
||||
le16_to_cpu(device->descriptor.idProduct) != USB_ID_US224 &&
|
||||
le16_to_cpu(device->descriptor.idProduct) != USB_ID_US428))
|
||||
return -EINVAL;
|
||||
|
||||
err = usX2Y_create_card(device, intf, &card);
|
||||
if (err < 0)
|
||||
return err;
|
||||
if ((err = usX2Y_hwdep_new(card, device)) < 0 ||
|
||||
(err = snd_card_register(card)) < 0) {
|
||||
snd_card_free(card);
|
||||
return err;
|
||||
}
|
||||
*cardp = card;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* new 2.5 USB kernel API
|
||||
*/
|
||||
static int snd_usX2Y_probe(struct usb_interface *intf, const struct usb_device_id *id)
|
||||
{
|
||||
struct snd_card *card;
|
||||
int err;
|
||||
|
||||
err = usX2Y_usb_probe(interface_to_usbdev(intf), intf, id, &card);
|
||||
if (err < 0)
|
||||
return err;
|
||||
dev_set_drvdata(&intf->dev, card);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void snd_usX2Y_disconnect(struct usb_interface *intf)
|
||||
{
|
||||
usX2Y_usb_disconnect(interface_to_usbdev(intf),
|
||||
usb_get_intfdata(intf));
|
||||
}
|
||||
|
||||
MODULE_DEVICE_TABLE(usb, snd_usX2Y_usb_id_table);
|
||||
static struct usb_driver snd_usX2Y_usb_driver = {
|
||||
.name = "snd-usb-usx2y",
|
||||
.probe = snd_usX2Y_probe,
|
||||
.disconnect = snd_usX2Y_disconnect,
|
||||
.id_table = snd_usX2Y_usb_id_table,
|
||||
};
|
||||
|
||||
static void snd_usX2Y_card_private_free(struct snd_card *card)
|
||||
{
|
||||
kfree(usX2Y(card)->In04Buf);
|
||||
usb_free_urb(usX2Y(card)->In04urb);
|
||||
if (usX2Y(card)->us428ctls_sharedmem)
|
||||
snd_free_pages(usX2Y(card)->us428ctls_sharedmem, sizeof(*usX2Y(card)->us428ctls_sharedmem));
|
||||
if (usX2Y(card)->card_index >= 0 && usX2Y(card)->card_index < SNDRV_CARDS)
|
||||
snd_usX2Y_card_used[usX2Y(card)->card_index] = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Frees the device.
|
||||
*/
|
||||
static void usX2Y_usb_disconnect(struct usb_device *device, void* ptr)
|
||||
{
|
||||
if (ptr) {
|
||||
struct snd_card *card = ptr;
|
||||
struct usX2Ydev *usX2Y = usX2Y(card);
|
||||
struct list_head *p;
|
||||
usX2Y->chip_status = USX2Y_STAT_CHIP_HUP;
|
||||
usX2Y_unlinkSeq(&usX2Y->AS04);
|
||||
usb_kill_urb(usX2Y->In04urb);
|
||||
snd_card_disconnect(card);
|
||||
/* release the midi resources */
|
||||
list_for_each(p, &usX2Y->midi_list) {
|
||||
snd_usbmidi_disconnect(p);
|
||||
}
|
||||
if (usX2Y->us428ctls_sharedmem)
|
||||
wake_up(&usX2Y->us428ctls_wait_queue_head);
|
||||
snd_card_free(card);
|
||||
}
|
||||
}
|
||||
|
||||
module_usb_driver(snd_usX2Y_usb_driver);
|
88
sound/usb/usx2y/usbusx2y.h
Normal file
88
sound/usb/usx2y/usbusx2y.h
Normal file
|
@ -0,0 +1,88 @@
|
|||
#ifndef USBUSX2Y_H
|
||||
#define USBUSX2Y_H
|
||||
#include "../usbaudio.h"
|
||||
#include "../midi.h"
|
||||
#include "usbus428ctldefs.h"
|
||||
|
||||
#define NRURBS 2
|
||||
|
||||
|
||||
#define URBS_AsyncSeq 10
|
||||
#define URB_DataLen_AsyncSeq 32
|
||||
struct snd_usX2Y_AsyncSeq {
|
||||
struct urb *urb[URBS_AsyncSeq];
|
||||
char *buffer;
|
||||
};
|
||||
|
||||
struct snd_usX2Y_urbSeq {
|
||||
int submitted;
|
||||
int len;
|
||||
struct urb *urb[0];
|
||||
};
|
||||
|
||||
#include "usx2yhwdeppcm.h"
|
||||
|
||||
struct usX2Ydev {
|
||||
struct usb_device *dev;
|
||||
int card_index;
|
||||
int stride;
|
||||
struct urb *In04urb;
|
||||
void *In04Buf;
|
||||
char In04Last[24];
|
||||
unsigned In04IntCalls;
|
||||
struct snd_usX2Y_urbSeq *US04;
|
||||
wait_queue_head_t In04WaitQueue;
|
||||
struct snd_usX2Y_AsyncSeq AS04;
|
||||
unsigned int rate,
|
||||
format;
|
||||
int chip_status;
|
||||
struct mutex pcm_mutex;
|
||||
struct us428ctls_sharedmem *us428ctls_sharedmem;
|
||||
int wait_iso_frame;
|
||||
wait_queue_head_t us428ctls_wait_queue_head;
|
||||
struct snd_usX2Y_hwdep_pcm_shm *hwdep_pcm_shm;
|
||||
struct snd_usX2Y_substream *subs[4];
|
||||
struct snd_usX2Y_substream * volatile prepare_subs;
|
||||
wait_queue_head_t prepare_wait_queue;
|
||||
struct list_head midi_list;
|
||||
struct list_head pcm_list;
|
||||
int pcm_devs;
|
||||
};
|
||||
|
||||
|
||||
struct snd_usX2Y_substream {
|
||||
struct usX2Ydev *usX2Y;
|
||||
struct snd_pcm_substream *pcm_substream;
|
||||
|
||||
int endpoint;
|
||||
unsigned int maxpacksize; /* max packet size in bytes */
|
||||
|
||||
atomic_t state;
|
||||
#define state_STOPPED 0
|
||||
#define state_STARTING1 1
|
||||
#define state_STARTING2 2
|
||||
#define state_STARTING3 3
|
||||
#define state_PREPARED 4
|
||||
#define state_PRERUNNING 6
|
||||
#define state_RUNNING 8
|
||||
|
||||
int hwptr; /* free frame position in the buffer (only for playback) */
|
||||
int hwptr_done; /* processed frame position in the buffer */
|
||||
int transfer_done; /* processed frames since last period update */
|
||||
|
||||
struct urb *urb[NRURBS]; /* data urb table */
|
||||
struct urb *completed_urb;
|
||||
char *tmpbuf; /* temporary buffer for playback */
|
||||
};
|
||||
|
||||
|
||||
#define usX2Y(c) ((struct usX2Ydev *)(c)->private_data)
|
||||
|
||||
int usX2Y_audio_create(struct snd_card *card);
|
||||
|
||||
int usX2Y_AsyncSeq04_init(struct usX2Ydev *usX2Y);
|
||||
int usX2Y_In04_init(struct usX2Ydev *usX2Y);
|
||||
|
||||
#define NAME_ALLCAPS "US-X2Y"
|
||||
|
||||
#endif
|
1020
sound/usb/usx2y/usbusx2yaudio.c
Normal file
1020
sound/usb/usx2y/usbusx2yaudio.c
Normal file
File diff suppressed because it is too large
Load diff
51
sound/usb/usx2y/usx2y.h
Normal file
51
sound/usb/usx2y/usx2y.h
Normal file
|
@ -0,0 +1,51 @@
|
|||
/*
|
||||
* Driver for Tascam US-X2Y USB soundcards
|
||||
*
|
||||
* Copyright (c) 2003 by Karsten Wiese <annabellesgarden@yahoo.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
#ifndef __SOUND_USX2Y_COMMON_H
|
||||
#define __SOUND_USX2Y_COMMON_H
|
||||
|
||||
|
||||
#define USX2Y_DRIVER_VERSION 0x0100 /* 0.1.0 */
|
||||
|
||||
|
||||
/* hwdep id string */
|
||||
#define SND_USX2Y_LOADER_ID "USX2Y Loader"
|
||||
#define SND_USX2Y_USBPCM_ID "USX2Y USBPCM"
|
||||
|
||||
/* hardware type */
|
||||
enum {
|
||||
USX2Y_TYPE_122,
|
||||
USX2Y_TYPE_224,
|
||||
USX2Y_TYPE_428,
|
||||
USX2Y_TYPE_NUMS
|
||||
};
|
||||
|
||||
#define USB_ID_US122 0x8007
|
||||
#define USB_ID_US224 0x8005
|
||||
#define USB_ID_US428 0x8001
|
||||
|
||||
/* chip status */
|
||||
enum {
|
||||
USX2Y_STAT_CHIP_INIT = (1 << 0), /* all operational */
|
||||
USX2Y_STAT_CHIP_MMAP_PCM_URBS = (1 << 1), /* pcm transport over mmaped urbs */
|
||||
USX2Y_STAT_CHIP_HUP = (1 << 31), /* all operational */
|
||||
};
|
||||
|
||||
#endif /* __SOUND_USX2Y_COMMON_H */
|
762
sound/usb/usx2y/usx2yhwdeppcm.c
Normal file
762
sound/usb/usx2y/usx2yhwdeppcm.c
Normal file
|
@ -0,0 +1,762 @@
|
|||
/*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
/* 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;
|
||||
if (0 > usX2Y->hwdep_pcm_shm->capture_iso_start) { //FIXME
|
||||
int 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;
|
||||
}
|
||||
if ((hwptr_done += lens) >= 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 inline 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 (0 > shm->playback_iso_start) {
|
||||
shm->playback_iso_start = shm->captured_iso_head -
|
||||
usX2Y_iso_frames_per_buffer(runtime, usX2Y);
|
||||
if (0 > shm->playback_iso_start)
|
||||
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 inline void usX2Y_usbpcm_urb_capt_iso_advance(struct snd_usX2Y_substream *subs,
|
||||
struct urb *urb)
|
||||
{
|
||||
int pack;
|
||||
for (pack = 0; pack < nr_of_packs(); ++pack) {
|
||||
struct usb_iso_packet_descriptor *desc = urb->iso_frame_desc + pack;
|
||||
if (NULL != subs) {
|
||||
struct snd_usX2Y_hwdep_pcm_shm *shm = subs->usX2Y->hwdep_pcm_shm;
|
||||
int 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++;
|
||||
}
|
||||
if ((desc->offset += desc->length * NRURBS*nr_of_packs()) +
|
||||
desc->length >= SSS)
|
||||
desc->offset -= (SSS - desc->length);
|
||||
}
|
||||
}
|
||||
|
||||
static inline 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 (NULL != 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) {
|
||||
if ((err = usX2Y_hwdep_urb_play_prepare(playbacksubs, urb)) ||
|
||||
(err = usX2Y_urb_submit(playbacksubs, urb, frame))) {
|
||||
return err;
|
||||
}
|
||||
}
|
||||
|
||||
playbacksubs->completed_urb = NULL;
|
||||
|
||||
state = atomic_read(&capsubs->state);
|
||||
if (state >= state_PREPARED) {
|
||||
if (state == state_RUNNING) {
|
||||
if ((err = usX2Y_usbpcm_urb_capt_retire(capsubs)))
|
||||
return err;
|
||||
} else if (state >= state_PRERUNNING)
|
||||
atomic_inc(&capsubs->state);
|
||||
usX2Y_usbpcm_urb_capt_iso_advance(capsubs, capsubs->completed_urb);
|
||||
if (NULL != capsubs2)
|
||||
usX2Y_usbpcm_urb_capt_iso_advance(NULL, capsubs2->completed_urb);
|
||||
if ((err = usX2Y_urb_submit(capsubs, capsubs->completed_urb, frame)))
|
||||
return err;
|
||||
if (NULL != capsubs2)
|
||||
if ((err = usX2Y_urb_submit(capsubs2, capsubs2->completed_urb, frame)))
|
||||
return err;
|
||||
}
|
||||
capsubs->completed_urb = NULL;
|
||||
if (NULL != 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 &&
|
||||
(NULL == 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;
|
||||
if (NULL != 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]) {
|
||||
struct snd_usX2Y_substream *cap_subs2 = usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
|
||||
if (cap_subs2 != NULL)
|
||||
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;
|
||||
|
||||
pipe = is_playback ? usb_sndisocpipe(dev, subs->endpoint) :
|
||||
usb_rcvisocpipe(dev, subs->endpoint);
|
||||
subs->maxpacksize = usb_maxpacket(dev, pipe, is_playback);
|
||||
if (!subs->maxpacksize)
|
||||
return -EINVAL;
|
||||
|
||||
/* allocate and initialize data urbs */
|
||||
for (i = 0; i < NRURBS; i++) {
|
||||
struct urb **purb = subs->urb + i;
|
||||
if (*purb) {
|
||||
usb_kill_urb(*purb);
|
||||
continue;
|
||||
}
|
||||
*purb = usb_alloc_urb(nr_of_packs(), GFP_KERNEL);
|
||||
if (NULL == *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,
|
||||
*cap_subs2 = subs->usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE + 2];
|
||||
mutex_lock(&subs->usX2Y->pcm_mutex);
|
||||
snd_printdd("snd_usX2Y_usbpcm_hw_free(%p)\n", substream);
|
||||
|
||||
if (SNDRV_PCM_STREAM_PLAYBACK == substream->stream) {
|
||||
struct snd_usX2Y_substream *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->status ||
|
||||
cap_subs->pcm_substream->runtime->status->state < SNDRV_PCM_STATE_PREPARED) {
|
||||
atomic_set(&cap_subs->state, state_STOPPED);
|
||||
if (NULL != cap_subs2)
|
||||
atomic_set(&cap_subs2->state, state_STOPPED);
|
||||
usX2Y_usbpcm_urbs_release(cap_subs);
|
||||
if (NULL != cap_subs2)
|
||||
usX2Y_usbpcm_urbs_release(cap_subs2);
|
||||
}
|
||||
} else {
|
||||
struct snd_usX2Y_substream *playback_subs = subs->usX2Y->subs[SNDRV_PCM_STREAM_PLAYBACK];
|
||||
if (atomic_read(&playback_subs->state) < state_PREPARED) {
|
||||
atomic_set(&subs->state, state_STOPPED);
|
||||
if (NULL != cap_subs2)
|
||||
atomic_set(&cap_subs2->state, state_STOPPED);
|
||||
usX2Y_usbpcm_urbs_release(subs);
|
||||
if (NULL != cap_subs2)
|
||||
usX2Y_usbpcm_urbs_release(cap_subs2);
|
||||
}
|
||||
}
|
||||
mutex_unlock(&subs->usX2Y->pcm_mutex);
|
||||
return snd_pcm_lib_free_pages(substream);
|
||||
}
|
||||
|
||||
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;
|
||||
|
||||
if (SNDRV_PCM_STREAM_CAPTURE == stream) {
|
||||
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 != NULL) {
|
||||
if ((err = usX2Y_usbpcm_urbs_allocate(subs)) < 0)
|
||||
return err;
|
||||
subs->completed_urb = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
for (p = 0; p < 4; p++) {
|
||||
struct snd_usX2Y_substream *subs = usX2Y->subs[p];
|
||||
if (subs != NULL && 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 != NULL) {
|
||||
struct urb *urb = subs->urb[u];
|
||||
if (usb_pipein(urb->pipe)) {
|
||||
unsigned long pack;
|
||||
if (0 == 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();
|
||||
if ((err = usb_submit_urb(urb, GFP_KERNEL)) < 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 == 0)
|
||||
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, NULL == 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 wroong > stop evrything
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* 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);
|
||||
|
||||
if (NULL == usX2Y->hwdep_pcm_shm) {
|
||||
if (NULL == (usX2Y->hwdep_pcm_shm = snd_malloc_pages(sizeof(struct snd_usX2Y_hwdep_pcm_shm), GFP_KERNEL)))
|
||||
return -ENOMEM;
|
||||
memset(usX2Y->hwdep_pcm_shm, 0, sizeof(struct snd_usX2Y_hwdep_pcm_shm));
|
||||
}
|
||||
|
||||
mutex_lock(&usX2Y->pcm_mutex);
|
||||
usX2Y_subs_prepare(subs);
|
||||
// Start hardware streams
|
||||
// SyncStream first....
|
||||
if (atomic_read(&capsubs->state) < state_PREPARED) {
|
||||
if (usX2Y->format != runtime->format)
|
||||
if ((err = usX2Y_format_set(usX2Y, runtime->format)) < 0)
|
||||
goto up_prepare_mutex;
|
||||
if (usX2Y->rate != runtime->rate)
|
||||
if ((err = usX2Y_rate_set(usX2Y, runtime->rate)) < 0)
|
||||
goto up_prepare_mutex;
|
||||
snd_printdd("starting capture pipe for %s\n", subs == capsubs ?
|
||||
"self" : "playpipe");
|
||||
if (0 > (err = usX2Y_usbpcm_urbs_start(capsubs)))
|
||||
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;
|
||||
}
|
||||
}
|
||||
if (0 > (err = usX2Y_usbpcm_urbs_start(subs)))
|
||||
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 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;
|
||||
|
||||
runtime->hw = SNDRV_PCM_STREAM_PLAYBACK == substream->stream ? snd_usX2Y_2c :
|
||||
(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 struct snd_pcm_ops snd_usX2Y_usbpcm_ops =
|
||||
{
|
||||
.open = snd_usX2Y_usbpcm_open,
|
||||
.close = snd_usX2Y_usbpcm_close,
|
||||
.ioctl = snd_pcm_lib_ioctl,
|
||||
.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);
|
||||
int i;
|
||||
|
||||
for (i = 0; i < dev->pcm_devs * 2; i++) {
|
||||
struct snd_usX2Y_substream *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 int snd_usX2Y_hwdep_pcm_vm_fault(struct vm_area_struct *area,
|
||||
struct vm_fault *vmf)
|
||||
{
|
||||
unsigned long offset;
|
||||
void *vaddr;
|
||||
|
||||
offset = vmf->pgoff << PAGE_SHIFT;
|
||||
vaddr = (char*)((struct usX2Ydev *)area->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 > PAGE_ALIGN(sizeof(struct snd_usX2Y_hwdep_pcm_shm))) {
|
||||
snd_printd("%lu > %lu\n", size, (unsigned long)sizeof(struct snd_usX2Y_hwdep_pcm_shm));
|
||||
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 (NULL != usX2Y->hwdep_pcm_shm)
|
||||
snd_free_pages(usX2Y->hwdep_pcm_shm, sizeof(struct snd_usX2Y_hwdep_pcm_shm));
|
||||
}
|
||||
|
||||
|
||||
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 (1 != nr_of_packs())
|
||||
return 0;
|
||||
|
||||
if ((err = snd_hwdep_new(card, SND_USX2Y_USBPCM_ID, 1, &hw)) < 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, "/proc/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");
|
||||
if (0 > (err = snd_pcm_lib_preallocate_pages(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
|
||||
SNDRV_DMA_TYPE_CONTINUOUS,
|
||||
snd_dma_continuous_data(GFP_KERNEL),
|
||||
64*1024, 128*1024)) ||
|
||||
0 > (err = snd_pcm_lib_preallocate_pages(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
|
||||
SNDRV_DMA_TYPE_CONTINUOUS,
|
||||
snd_dma_continuous_data(GFP_KERNEL),
|
||||
64*1024, 128*1024))) {
|
||||
return err;
|
||||
}
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#else
|
||||
|
||||
int usX2Y_hwdep_pcm_new(struct snd_card *card)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
#endif
|
22
sound/usb/usx2y/usx2yhwdeppcm.h
Normal file
22
sound/usb/usx2y/usx2yhwdeppcm.h
Normal file
|
@ -0,0 +1,22 @@
|
|||
#define MAXPACK 50
|
||||
#define MAXBUFFERMS 100
|
||||
#define MAXSTRIDE 3
|
||||
|
||||
#define SSS (((MAXPACK*MAXBUFFERMS*MAXSTRIDE + 4096) / 4096) * 4096)
|
||||
struct snd_usX2Y_hwdep_pcm_shm {
|
||||
char playback[SSS];
|
||||
char capture0x8[SSS];
|
||||
char capture0xA[SSS];
|
||||
volatile int playback_iso_head;
|
||||
int playback_iso_start;
|
||||
struct {
|
||||
int frame,
|
||||
offset,
|
||||
length;
|
||||
} captured_iso[128];
|
||||
volatile int captured_iso_head;
|
||||
volatile unsigned captured_iso_frames;
|
||||
int capture_iso_start;
|
||||
};
|
||||
|
||||
int usX2Y_hwdep_pcm_new(struct snd_card *card);
|
Loading…
Add table
Add a link
Reference in a new issue