123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133 |
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <linux/usb.h>
- #include "usbaudio.h"
- #include "helper.h"
- #include "quirks.h"
- unsigned int snd_usb_combine_bytes(unsigned char *bytes, int size)
- {
- switch (size) {
- case 1: return *bytes;
- case 2: return combine_word(bytes);
- case 3: return combine_triple(bytes);
- case 4: return combine_quad(bytes);
- default: return 0;
- }
- }
- void *snd_usb_find_desc(void *descstart, int desclen, void *after, u8 dtype)
- {
- u8 *p, *end, *next;
- p = descstart;
- end = p + desclen;
- for (; p < end;) {
- if (p[0] < 2)
- return NULL;
- next = p + p[0];
- if (next > end)
- return NULL;
- if (p[1] == dtype && (!after || (void *)p > after)) {
- return p;
- }
- p = next;
- }
- return NULL;
- }
- void *snd_usb_find_csint_desc(void *buffer, int buflen, void *after, u8 dsubtype)
- {
- unsigned char *p = after;
- while ((p = snd_usb_find_desc(buffer, buflen, p,
- USB_DT_CS_INTERFACE)) != NULL) {
- if (p[0] >= 3 && p[2] == dsubtype)
- return p;
- }
- return NULL;
- }
- int snd_usb_ctl_msg(struct usb_device *dev, unsigned int pipe, __u8 request,
- __u8 requesttype, __u16 value, __u16 index, void *data,
- __u16 size)
- {
- int err;
- void *buf = NULL;
- int timeout;
- if (size > 0) {
- buf = kmemdup(data, size, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- }
- if (requesttype & USB_DIR_IN)
- timeout = USB_CTRL_GET_TIMEOUT;
- else
- timeout = USB_CTRL_SET_TIMEOUT;
- err = usb_control_msg(dev, pipe, request, requesttype,
- value, index, buf, size, timeout);
- if (size > 0) {
- memcpy(data, buf, size);
- kfree(buf);
- }
- snd_usb_ctl_msg_quirk(dev, pipe, request, requesttype,
- value, index, data, size);
- return err;
- }
- unsigned char snd_usb_parse_datainterval(struct snd_usb_audio *chip,
- struct usb_host_interface *alts)
- {
- switch (snd_usb_get_speed(chip->dev)) {
- case USB_SPEED_HIGH:
- case USB_SPEED_WIRELESS:
- case USB_SPEED_SUPER:
- if (get_endpoint(alts, 0)->bInterval >= 1 &&
- get_endpoint(alts, 0)->bInterval <= 4)
- return get_endpoint(alts, 0)->bInterval - 1;
- break;
- default:
- break;
- }
- return 0;
- }
|