git.oblomov.eu Git - linux-2.6/blob - drivers/usb/class/audio.c

   1 /*****************************************************************************/
   2
   3 /*
   4  *      audio.c  --  USB Audio Class driver
   5  *
   6  *      Copyright (C) 1999, 2000, 2001, 2003, 2004
   7  *          Alan Cox (alan@lxorguk.ukuu.org.uk)
   8  *          Thomas Sailer (sailer@ife.ee.ethz.ch)
   9  *
  10  *      This program is free software; you can redistribute it and/or modify
  11  *      it under the terms of the GNU General Public License as published by
  12  *      the Free Software Foundation; either version 2 of the License, or
  13  *      (at your option) any later version.
  14  *
  15  * Debugging:
  16  *      Use the 'lsusb' utility to dump the descriptors.
  17  *
  18  * 1999-09-07:  Alan Cox
  19  *              Parsing Audio descriptor patch
  20  * 1999-09-08:  Thomas Sailer
  21  *              Added OSS compatible data io functions; both parts of the
  22  *              driver remain to be glued together
  23  * 1999-09-10:  Thomas Sailer
  24  *              Beautified the driver. Added sample format conversions.
  25  *              Still not properly glued with the parsing code.
  26  *              The parsing code seems to have its problems btw,
  27  *              Since it parses all available configs but doesn't
  28  *              store which iface/altsetting belongs to which config.
  29  * 1999-09-20:  Thomas Sailer
  30  *              Threw out Alan's parsing code and implemented my own one.
  31  *              You cannot reasonnably linearly parse audio descriptors,
  32  *              especially the AudioClass descriptors have to be considered
  33  *              pointer lists. Mixer parsing untested, due to lack of device.
  34  *              First stab at synch pipe implementation, the Dallas USB DAC
  35  *              wants to use an Asynch out pipe. usb_audio_state now basically
  36  *              only contains lists of mixer and wave devices. We can therefore
  37  *              now have multiple mixer/wave devices per USB device.
  38  * 1999-10-28:  Thomas Sailer
  39  *              Converted to URB API. Fixed a taskstate/wakeup semantics mistake
  40  *              that made the driver consume all available CPU cycles.
  41  *              Now runs stable on UHCI-Acher/Fliegl/Sailer.
  42  * 1999-10-31:  Thomas Sailer
  43  *              Audio can now be unloaded if it is not in use by any mixer
  44  *              or dsp client (formerly you had to disconnect the audio devices
  45  *              from the USB port)
  46  *              Finally, about three months after ordering, my "Maxxtro SPK222"
  47  *              speakers arrived, isn't disdata a great mail order company 8-)
  48  *              Parse class specific endpoint descriptor of the audiostreaming
  49  *              interfaces and take the endpoint attributes from there.
  50  *              Unbelievably, the Philips USB DAC has a sampling rate range
  51  *              of over a decade, yet does not support the sampling rate control!
  52  *              No wonder it sounds so bad, has very audible sampling rate
  53  *              conversion distortion. Don't try to listen to it using
  54  *              decent headphones!
  55  *              "Let's make things better" -> but please Philips start with your
  56  *              own stuff!!!!
  57  * 1999-11-02:  Thomas Sailer
  58  *              It takes the Philips boxes several seconds to acquire synchronisation
  59  *              that means they won't play short sounds. Should probably maintain
  60  *              the ISO datastream even if there's nothing to play.
  61  *              Fix counting the total_bytes counter, RealPlayer G2 depends on it.
  62  * 1999-12-20:  Thomas Sailer
  63  *              Fix bad bug in conversion to per interface probing.
  64  *              disconnect was called multiple times for the audio device,
  65  *              leading to a premature freeing of the audio structures
  66  * 2000-05-13:  Thomas Sailer
  67  *              I don't remember who changed the find_format routine,
  68  *              but the change was completely broken for the Dallas
  69  *              chip. Anyway taking sampling rate into account in find_format
  70  *              is bad and should not be done unless there are devices with
  71  *              completely broken audio descriptors. Unless someone shows
  72  *              me such a descriptor, I will not allow find_format to
  73  *              take the sampling rate into account.
  74  *              Also, the former find_format made:
  75  *              - mpg123 play mono instead of stereo
  76  *              - sox completely fail for wav's with sample rates < 44.1kHz
  77  *                  for the Dallas chip.
  78  *              Also fix a rather long standing problem with applications that
  79  *              use "small" writes producing no sound at all.
  80  * 2000-05-15:  Thomas Sailer
  81  *              My fears came true, the Philips camera indeed has pretty stupid
  82  *              audio descriptors.
  83  * 2000-05-17:  Thomas Sailer
  84  *              Nemsoft spotted my stupid last minute change, thanks
  85  * 2000-05-19:  Thomas Sailer
  86  *              Fixed FEATURE_UNIT thinkos found thanks to the KC Technology
  87  *              Xtend device. Basically the driver treated FEATURE_UNIT's sourced
  88  *              by mono terminals as stereo.
  89  * 2000-05-20:  Thomas Sailer
  90  *              SELECTOR support (and thus selecting record channels from the mixer).
  91  *              Somewhat peculiar due to OSS interface limitations. Only works
  92  *              for channels where a "slider" is already in front of it (i.e.
  93  *              a MIXER unit or a FEATURE unit with volume capability).
  94  * 2000-11-26:  Thomas Sailer
  95  *              Workaround for Dallas DS4201. The DS4201 uses PCM8 as format tag for
  96  *              its 8 bit modes, but expects signed data (and should therefore have used PCM).
  97  * 2001-03-10:  Thomas Sailer
  98  *              provide abs function, prevent picking up a bogus kernel macro
  99  *              for abs. Bug report by Andrew Morton <andrewm@uow.edu.au>
 100  * 2001-06-16:  Bryce Nesbitt <bryce@obviously.com>
 101  *              Fix SNDCTL_DSP_STEREO API violation
 102  * 2003-04-08:  Oliver Neukum (oliver@neukum.name):
 103  *              Setting a configuration is done by usbcore and must not be overridden
 104  * 2004-02-27:  Workaround for broken synch descriptors
 105  * 2004-03-07:  Alan Stern <stern@rowland.harvard.edu>
 106  *              Add usb_ifnum_to_if() and usb_altnum_to_altsetting() support.
 107  *              Use the in-memory descriptors instead of reading them from the device.
 108  *
 109  */
 110
 111 /*
 112  * Strategy:
 113  *
 114  * Alan Cox and Thomas Sailer are starting to dig at opposite ends and
 115  * are hoping to meet in the middle, just like tunnel diggers :)
 116  * Alan tackles the descriptor parsing, Thomas the actual data IO and the
 117  * OSS compatible interface.
 118  *
 119  * Data IO implementation issues
 120  *
 121  * A mmap'able ring buffer per direction is implemented, because
 122  * almost every OSS app expects it. It is however impractical to
 123  * transmit/receive USB data directly into and out of the ring buffer,
 124  * due to alignment and synchronisation issues. Instead, the ring buffer
 125  * feeds a constant time delay line that handles the USB issues.
 126  *
 127  * Now we first try to find an alternate setting that exactly matches
 128  * the sample format requested by the user. If we find one, we do not
 129  * need to perform any sample rate conversions. If there is no matching
 130  * altsetting, we choose the closest one and perform sample format
 131  * conversions. We never do sample rate conversion; these are too
 132  * expensive to be performed in the kernel.
 133  *
 134  * Current status: no known HCD-specific issues.
 135  *
 136  * Generally: Due to the brokenness of the Audio Class spec
 137  * it seems generally impossible to write a generic Audio Class driver,
 138  * so a reasonable driver should implement the features that are actually
 139  * used.
 140  *
 141  * Parsing implementation issues
 142  *
 143  * One cannot reasonably parse the AudioClass descriptors linearly.
 144  * Therefore the current implementation features routines to look
 145  * for a specific descriptor in the descriptor list.
 146  *
 147  * How does the parsing work? First, all interfaces are searched
 148  * for an AudioControl class interface. If found, the config descriptor
 149  * that belongs to the current configuration is searched and
 150  * the HEADER descriptor is found. It contains a list of
 151  * all AudioStreaming and MIDIStreaming devices. This list is then walked,
 152  * and all AudioStreaming interfaces are classified into input and output
 153  * interfaces (according to the endpoint0 direction in altsetting1) (MIDIStreaming
 154  * is currently not supported). The input & output list is then used
 155  * to group inputs and outputs together and issued pairwise to the
 156  * AudioStreaming class parser. Finally, all OUTPUT_TERMINAL descriptors
 157  * are walked and issued to the mixer construction routine.
 158  *
 159  * The AudioStreaming parser simply enumerates all altsettings belonging
 160  * to the specified interface. It looks for AS_GENERAL and FORMAT_TYPE
 161  * class specific descriptors to extract the sample format/sample rate
 162  * data. Only sample format types PCM and PCM8 are supported right now, and
 163  * only FORMAT_TYPE_I is handled. The isochronous data endpoint needs to
 164  * be the first endpoint of the interface, and the optional synchronisation
 165  * isochronous endpoint the second one.
 166  *
 167  * Mixer construction works as follows: The various TERMINAL and UNIT
 168  * descriptors span a tree from the root (OUTPUT_TERMINAL) through the
 169  * intermediate nodes (UNITs) to the leaves (INPUT_TERMINAL). We walk
 170  * that tree in a depth first manner. FEATURE_UNITs may contribute volume,
 171  * bass and treble sliders to the mixer, MIXER_UNITs volume sliders.
 172  * The terminal type encoded in the INPUT_TERMINALs feeds a heuristic
 173  * to determine "meaningful" OSS slider numbers, however we will see
 174  * how well this works in practice. Other features are not used at the
 175  * moment, they seem less often used. Also, it seems difficult at least
 176  * to construct recording source switches from SELECTOR_UNITs, but
 177  * since there are not many USB ADC's available, we leave that for later.
 178  */
 179
 180 /*****************************************************************************/
 181
 182 #include <linux/kernel.h>
 183 #include <linux/slab.h>
 184 #include <linux/string.h>
 185 #include <linux/timer.h>
 186 #include <linux/sched.h>
 187 #include <linux/smp_lock.h>
 188 #include <linux/module.h>
 189 #include <linux/sound.h>
 190 #include <linux/soundcard.h>
 191 #include <linux/list.h>
 192 #include <linux/vmalloc.h>
 193 #include <linux/init.h>
 194 #include <linux/poll.h>
 195 #include <linux/bitops.h>
 196 #include <asm/uaccess.h>
 197 #include <asm/io.h>
 198 #include <linux/usb.h>
 199
 200 #include "audio.h"
 201
 202 /*
 203  * Version Information
 204  */
 205 #define DRIVER_VERSION "v1.0.0"
 206 #define DRIVER_AUTHOR "Alan Cox <alan@lxorguk.ukuu.org.uk>, Thomas Sailer (sailer@ife.ee.ethz.ch)"
 207 #define DRIVER_DESC "USB Audio Class driver"
 208
 209 #define AUDIO_DEBUG 1
 210
 211 #define SND_DEV_DSP16   5
 212
 213 #define dprintk(x)
 214
 215 /* --------------------------------------------------------------------- */
 216
 217 /*
 218  * Linked list of all audio devices...
 219  */
 220 static struct list_head audiodevs = LIST_HEAD_INIT(audiodevs);
 221 static DECLARE_MUTEX(open_sem);
 222
 223 /*
 224  * wait queue for processes wanting to open an USB audio device
 225  */
 226 static DECLARE_WAIT_QUEUE_HEAD(open_wait);
 227
 228
 229 #define MAXFORMATS        MAX_ALT
 230 #define DMABUFSHIFT       17  /* 128k worth of DMA buffer */
 231 #define NRSGBUF           (1U<<(DMABUFSHIFT-PAGE_SHIFT))
 232
 233 /*
 234  * This influences:
 235  * - Latency
 236  * - Interrupt rate
 237  * - Synchronisation behaviour
 238  * Don't touch this if you don't understand all of the above.
 239  */
 240 #define DESCFRAMES  5
 241 #define SYNCFRAMES  DESCFRAMES
 242
 243 #define MIXFLG_STEREOIN   1
 244 #define MIXFLG_STEREOOUT  2
 245
 246 struct mixerchannel {
 247         __u16 value;
 248         __u16 osschannel;  /* number of the OSS channel */
 249         __s16 minval, maxval;
 250         __u16 slctunitid;
 251         __u8 unitid;
 252         __u8 selector;
 253         __u8 chnum;
 254         __u8 flags;
 255 };
 256
 257 struct audioformat {
 258         unsigned int format;
 259         unsigned int sratelo;
 260         unsigned int sratehi;
 261         unsigned char altsetting;
 262         unsigned char attributes;
 263 };
 264
 265 struct dmabuf {
 266         /* buffer data format */
 267         unsigned int format;
 268         unsigned int srate;
 269         /* physical buffer */
 270         unsigned char *sgbuf[NRSGBUF];
 271         unsigned bufsize;
 272         unsigned numfrag;
 273         unsigned fragshift;
 274         unsigned wrptr, rdptr;
 275         unsigned total_bytes;
 276         int count;
 277         unsigned error; /* over/underrun */
 278         wait_queue_head_t wait;
 279         /* redundant, but makes calculations easier */
 280         unsigned fragsize;
 281         unsigned dmasize;
 282         /* OSS stuff */
 283         unsigned mapped:1;
 284         unsigned ready:1;
 285         unsigned ossfragshift;
 286         int ossmaxfrags;
 287         unsigned subdivision;
 288 };
 289
 290 struct usb_audio_state;
 291
 292 #define FLG_URB0RUNNING   1
 293 #define FLG_URB1RUNNING   2
 294 #define FLG_SYNC0RUNNING  4
 295 #define FLG_SYNC1RUNNING  8
 296 #define FLG_RUNNING      16
 297 #define FLG_CONNECTED    32
 298
 299 struct my_data_urb {
 300         struct urb *urb;
 301 };
 302
 303 struct my_sync_urb {
 304         struct urb *urb;
 305 };
 306
 307
 308 struct usb_audiodev {
 309         struct list_head list;
 310         struct usb_audio_state *state;
 311
 312         /* soundcore stuff */
 313         int dev_audio;
 314
 315         /* wave stuff */
 316         mode_t open_mode;
 317         spinlock_t lock;         /* DMA buffer access spinlock */
 318
 319         struct usbin {
 320                 int interface;           /* Interface number, -1 means not used */
 321                 unsigned int format;     /* USB data format */
 322                 unsigned int datapipe;   /* the data input pipe */
 323                 unsigned int syncpipe;   /* the synchronisation pipe - 0 for anything but adaptive IN mode */
 324                 unsigned int syncinterval;  /* P for adaptive IN mode, 0 otherwise */
 325                 unsigned int freqn;      /* nominal sampling rate in USB format, i.e. fs/1000 in Q10.14 */
 326                 unsigned int freqmax;    /* maximum sampling rate, used for buffer management */
 327                 unsigned int phase;      /* phase accumulator */
 328                 unsigned int flags;      /* see FLG_ defines */
 329
 330                 struct my_data_urb durb[2];  /* ISO descriptors for the data endpoint */
 331                 struct my_sync_urb surb[2];  /* ISO sync pipe descriptor if needed */
 332
 333                 struct dmabuf dma;
 334         } usbin;
 335
 336         struct usbout {
 337                 int interface;           /* Interface number, -1 means not used */
 338                 unsigned int format;     /* USB data format */
 339                 unsigned int datapipe;   /* the data input pipe */
 340                 unsigned int syncpipe;   /* the synchronisation pipe - 0 for anything but asynchronous OUT mode */
 341                 unsigned int syncinterval;  /* P for asynchronous OUT mode, 0 otherwise */
 342                 unsigned int freqn;      /* nominal sampling rate in USB format, i.e. fs/1000 in Q10.14 */
 343                 unsigned int freqm;      /* momentary sampling rate in USB format, i.e. fs/1000 in Q10.14 */
 344                 unsigned int freqmax;    /* maximum sampling rate, used for buffer management */
 345                 unsigned int phase;      /* phase accumulator */
 346                 unsigned int flags;      /* see FLG_ defines */
 347
 348                 struct my_data_urb durb[2];  /* ISO descriptors for the data endpoint */
 349                 struct my_sync_urb surb[2];  /* ISO sync pipe descriptor if needed */
 350
 351                 struct dmabuf dma;
 352         } usbout;
 353
 354
 355         unsigned int numfmtin, numfmtout;
 356         struct audioformat fmtin[MAXFORMATS];
 357         struct audioformat fmtout[MAXFORMATS];
 358 };
 359
 360 struct usb_mixerdev {
 361         struct list_head list;
 362         struct usb_audio_state *state;
 363
 364         /* soundcore stuff */
 365         int dev_mixer;
 366
 367         unsigned char iface;  /* interface number of the AudioControl interface */
 368
 369         /* USB format descriptions */
 370         unsigned int numch, modcnt;
 371
 372         /* mixch is last and gets allocated dynamically */
 373         struct mixerchannel ch[0];
 374 };
 375
 376 struct usb_audio_state {
 377         struct list_head audiodev;
 378
 379         /* USB device */
 380         struct usb_device *usbdev;
 381
 382         struct list_head audiolist;
 383         struct list_head mixerlist;
 384
 385         unsigned count;  /* usage counter; NOTE: the usb stack is also considered a user */
 386 };
 387
 388 /* private audio format extensions */
 389 #define AFMT_STEREO        0x80000000
 390 #define AFMT_ISSTEREO(x)   ((x) & AFMT_STEREO)
 391 #define AFMT_IS16BIT(x)    ((x) & (AFMT_S16_LE|AFMT_S16_BE|AFMT_U16_LE|AFMT_U16_BE))
 392 #define AFMT_ISUNSIGNED(x) ((x) & (AFMT_U8|AFMT_U16_LE|AFMT_U16_BE))
 393 #define AFMT_BYTESSHIFT(x) ((AFMT_ISSTEREO(x) ? 1 : 0) + (AFMT_IS16BIT(x) ? 1 : 0))
 394 #define AFMT_BYTES(x)      (1<<AFMT_BYTESSHFIT(x))
 395
 396 /* --------------------------------------------------------------------- */
 397
 398 static inline unsigned ld2(unsigned int x)
 399 {
 400         unsigned r = 0;
 401
 402         if (x >= 0x10000) {
 403                 x >>= 16;
 404                 r += 16;
 405         }
 406         if (x >= 0x100) {
 407                 x >>= 8;
 408                 r += 8;
 409         }
 410         if (x >= 0x10) {
 411                 x >>= 4;
 412                 r += 4;
 413         }
 414         if (x >= 4) {
 415                 x >>= 2;
 416                 r += 2;
 417         }
 418         if (x >= 2)
 419                 r++;
 420         return r;
 421 }
 422
 423 /* --------------------------------------------------------------------- */
 424
 425 /*
 426  * OSS compatible ring buffer management. The ring buffer may be mmap'ed into
 427  * an application address space.
 428  *
 429  * I first used the rvmalloc stuff copied from bttv. Alan Cox did not like it, so
 430  * we now use an array of pointers to a single page each. This saves us the
 431  * kernel page table manipulations, but we have to do a page table alike mechanism
 432  * (though only one indirection) in software.
 433  */
 434
 435 static void dmabuf_release(struct dmabuf *db)
 436 {
 437         unsigned int nr;
 438         void *p;
 439
 440         for(nr = 0; nr < NRSGBUF; nr++) {
 441                 if (!(p = db->sgbuf[nr]))
 442                         continue;
 443                 ClearPageReserved(virt_to_page(p));
 444                 free_page((unsigned long)p);
 445                 db->sgbuf[nr] = NULL;
 446         }
 447         db->mapped = db->ready = 0;
 448 }
 449
 450 static int dmabuf_init(struct dmabuf *db)
 451 {
 452         unsigned int nr, bytepersec, bufs;
 453         void *p;
 454
 455         /* initialize some fields */
 456         db->rdptr = db->wrptr = db->total_bytes = db->count = db->error = 0;
 457         /* calculate required buffer size */
 458         bytepersec = db->srate << AFMT_BYTESSHIFT(db->format);
 459         bufs = 1U << DMABUFSHIFT;
 460         if (db->ossfragshift) {
 461                 if ((1000 << db->ossfragshift) < bytepersec)
 462                         db->fragshift = ld2(bytepersec/1000);
 463                 else
 464                         db->fragshift = db->ossfragshift;
 465         } else {
 466                 db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
 467                 if (db->fragshift < 3)
 468                         db->fragshift = 3;
 469         }
 470         db->numfrag = bufs >> db->fragshift;
 471         while (db->numfrag < 4 && db->fragshift > 3) {
 472                 db->fragshift--;
 473                 db->numfrag = bufs >> db->fragshift;
 474         }
 475         db->fragsize = 1 << db->fragshift;
 476         if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
 477                 db->numfrag = db->ossmaxfrags;
 478         db->dmasize = db->numfrag << db->fragshift;
 479         for(nr = 0; nr < NRSGBUF; nr++) {
 480                 if (!db->sgbuf[nr]) {
 481                         p = (void *)get_zeroed_page(GFP_KERNEL);
 482                         if (!p)
 483                                 return -ENOMEM;
 484                         db->sgbuf[nr] = p;
 485                         SetPageReserved(virt_to_page(p));
 486                 }
 487                 memset(db->sgbuf[nr], AFMT_ISUNSIGNED(db->format) ? 0x80 : 0, PAGE_SIZE);
 488                 if ((nr << PAGE_SHIFT) >= db->dmasize)
 489                         break;
 490         }
 491         db->bufsize = nr << PAGE_SHIFT;
 492         db->ready = 1;
 493         dprintk((KERN_DEBUG "usbaudio: dmabuf_init bytepersec %d bufs %d ossfragshift %d ossmaxfrags %d "
 494                  "fragshift %d fragsize %d numfrag %d dmasize %d bufsize %d fmt 0x%x srate %d\n",
 495                  bytepersec, bufs, db->ossfragshift, db->ossmaxfrags, db->fragshift, db->fragsize,
 496                  db->numfrag, db->dmasize, db->bufsize, db->format, db->srate));
 497         return 0;
 498 }
 499
 500 static int dmabuf_mmap(struct vm_area_struct *vma, struct dmabuf *db, unsigned long start, unsigned long size, pgprot_t prot)
 501 {
 502         unsigned int nr;
 503
 504         if (!db->ready || db->mapped || (start | size) & (PAGE_SIZE-1) || size > db->bufsize)
 505                 return -EINVAL;
 506         size >>= PAGE_SHIFT;
 507         for(nr = 0; nr < size; nr++)
 508                 if (!db->sgbuf[nr])
 509                         return -EINVAL;
 510         db->mapped = 1;
 511         for(nr = 0; nr < size; nr++) {
 512                 unsigned long pfn;
 513
 514                 pfn = virt_to_phys(db->sgbuf[nr]) >> PAGE_SHIFT;
 515                 if (remap_pfn_range(vma, start, pfn, PAGE_SIZE, prot))
 516                         return -EAGAIN;
 517                 start += PAGE_SIZE;
 518         }
 519         return 0;
 520 }
 521
 522 static void dmabuf_copyin(struct dmabuf *db, const void *buffer, unsigned int size)
 523 {
 524         unsigned int pgrem, rem;
 525
 526         db->total_bytes += size;
 527         for (;;) {
 528                 if (size <= 0)
 529                         return;
 530                 pgrem = ((~db->wrptr) & (PAGE_SIZE-1)) + 1;
 531                 if (pgrem > size)
 532                         pgrem = size;
 533                 rem = db->dmasize - db->wrptr;
 534                 if (pgrem > rem)
 535                         pgrem = rem;
 536                 memcpy((db->sgbuf[db->wrptr >> PAGE_SHIFT]) + (db->wrptr & (PAGE_SIZE-1)), buffer, pgrem);
 537                 size -= pgrem;
 538                 buffer += pgrem;
 539                 db->wrptr += pgrem;
 540                 if (db->wrptr >= db->dmasize)
 541                         db->wrptr = 0;
 542         }
 543 }
 544
 545 static void dmabuf_copyout(struct dmabuf *db, void *buffer, unsigned int size)
 546 {
 547         unsigned int pgrem, rem;
 548
 549         db->total_bytes += size;
 550         for (;;) {
 551                 if (size <= 0)
 552                         return;
 553                 pgrem = ((~db->rdptr) & (PAGE_SIZE-1)) + 1;
 554                 if (pgrem > size)
 555                         pgrem = size;
 556                 rem = db->dmasize - db->rdptr;
 557                 if (pgrem > rem)
 558                         pgrem = rem;
 559                 memcpy(buffer, (db->sgbuf[db->rdptr >> PAGE_SHIFT]) + (db->rdptr & (PAGE_SIZE-1)), pgrem);
 560                 size -= pgrem;
 561                 buffer += pgrem;
 562                 db->rdptr += pgrem;
 563                 if (db->rdptr >= db->dmasize)
 564                         db->rdptr = 0;
 565         }
 566 }
 567
 568 static int dmabuf_copyin_user(struct dmabuf *db, unsigned int ptr, const void __user *buffer, unsigned int size)
 569 {
 570         unsigned int pgrem, rem;
 571
 572         if (!db->ready || db->mapped)
 573                 return -EINVAL;
 574         for (;;) {
 575                 if (size <= 0)
 576                         return 0;
 577                 pgrem = ((~ptr) & (PAGE_SIZE-1)) + 1;
 578                 if (pgrem > size)
 579                         pgrem = size;
 580                 rem = db->dmasize - ptr;
 581                 if (pgrem > rem)
 582                         pgrem = rem;
 583                 if (copy_from_user((db->sgbuf[ptr >> PAGE_SHIFT]) + (ptr & (PAGE_SIZE-1)), buffer, pgrem))
 584                         return -EFAULT;
 585                 size -= pgrem;
 586                 buffer += pgrem;
 587                 ptr += pgrem;
 588                 if (ptr >= db->dmasize)
 589                         ptr = 0;
 590         }
 591 }
 592
 593 static int dmabuf_copyout_user(struct dmabuf *db, unsigned int ptr, void __user *buffer, unsigned int size)
 594 {
 595         unsigned int pgrem, rem;
 596
 597         if (!db->ready || db->mapped)
 598                 return -EINVAL;
 599         for (;;) {
 600                 if (size <= 0)
 601                         return 0;
 602                 pgrem = ((~ptr) & (PAGE_SIZE-1)) + 1;
 603                 if (pgrem > size)
 604                         pgrem = size;
 605                 rem = db->dmasize - ptr;
 606                 if (pgrem > rem)
 607                         pgrem = rem;
 608                 if (copy_to_user(buffer, (db->sgbuf[ptr >> PAGE_SHIFT]) + (ptr & (PAGE_SIZE-1)), pgrem))
 609                         return -EFAULT;
 610                 size -= pgrem;
 611                 buffer += pgrem;
 612                 ptr += pgrem;
 613                 if (ptr >= db->dmasize)
 614                         ptr = 0;
 615         }
 616 }
 617
 618 /* --------------------------------------------------------------------- */
 619 /*
 620  * USB I/O code. We do sample format conversion if necessary
 621  */
 622
 623 static void usbin_stop(struct usb_audiodev *as)
 624 {
 625         struct usbin *u = &as->usbin;
 626         unsigned long flags;
 627         unsigned int i, notkilled = 1;
 628
 629         spin_lock_irqsave(&as->lock, flags);
 630         u->flags &= ~FLG_RUNNING;
 631         i = u->flags;
 632         spin_unlock_irqrestore(&as->lock, flags);
 633         while (i & (FLG_URB0RUNNING|FLG_URB1RUNNING|FLG_SYNC0RUNNING|FLG_SYNC1RUNNING)) {
 634                 if (notkilled)
 635                         schedule_timeout_interruptible(1);
 636                 else
 637                         schedule_timeout_uninterruptible(1);
 638                 spin_lock_irqsave(&as->lock, flags);
 639                 i = u->flags;
 640                 spin_unlock_irqrestore(&as->lock, flags);
 641                 if (notkilled && signal_pending(current)) {
 642                         if (i & FLG_URB0RUNNING)
 643                                 usb_kill_urb(u->durb[0].urb);
 644                         if (i & FLG_URB1RUNNING)
 645                                 usb_kill_urb(u->durb[1].urb);
 646                         if (i & FLG_SYNC0RUNNING)
 647                                 usb_kill_urb(u->surb[0].urb);
 648                         if (i & FLG_SYNC1RUNNING)
 649                                 usb_kill_urb(u->surb[1].urb);
 650                         notkilled = 0;
 651                 }
 652         }
 653         set_current_state(TASK_RUNNING);
 654         kfree(u->durb[0].urb->transfer_buffer);
 655         kfree(u->durb[1].urb->transfer_buffer);
 656         kfree(u->surb[0].urb->transfer_buffer);
 657         kfree(u->surb[1].urb->transfer_buffer);
 658         u->durb[0].urb->transfer_buffer = u->durb[1].urb->transfer_buffer =
 659                 u->surb[0].urb->transfer_buffer = u->surb[1].urb->transfer_buffer = NULL;
 660 }
 661
 662 static inline void usbin_release(struct usb_audiodev *as)
 663 {
 664         usbin_stop(as);
 665 }
 666
 667 static void usbin_disc(struct usb_audiodev *as)
 668 {
 669         struct usbin *u = &as->usbin;
 670
 671         unsigned long flags;
 672
 673         spin_lock_irqsave(&as->lock, flags);
 674         u->flags &= ~(FLG_RUNNING | FLG_CONNECTED);
 675         spin_unlock_irqrestore(&as->lock, flags);
 676         usbin_stop(as);
 677 }
 678
 679 static void conversion(const void *ibuf, unsigned int ifmt, void *obuf, unsigned int ofmt, void *tmp, unsigned int scnt)
 680 {
 681         unsigned int cnt, i;
 682         __s16 *sp, *sp2, s;
 683         unsigned char *bp;
 684
 685         cnt = scnt;
 686         if (AFMT_ISSTEREO(ifmt))
 687                 cnt <<= 1;
 688         sp = ((__s16 *)tmp) + cnt;
 689         switch (ifmt & ~AFMT_STEREO) {
 690         case AFMT_U8:
 691                 for (bp = ((unsigned char *)ibuf)+cnt, i = 0; i < cnt; i++) {
 692                         bp--;
 693                         sp--;
 694                         *sp = (*bp ^ 0x80) << 8;
 695                 }
 696                 break;
 697
 698         case AFMT_S8:
 699                 for (bp = ((unsigned char *)ibuf)+cnt, i = 0; i < cnt; i++) {
 700                         bp--;
 701                         sp--;
 702                         *sp = *bp << 8;
 703                 }
 704                 break;
 705
 706         case AFMT_U16_LE:
 707                 for (bp = ((unsigned char *)ibuf)+2*cnt, i = 0; i < cnt; i++) {
 708                         bp -= 2;
 709                         sp--;
 710                         *sp = (bp[0] | (bp[1] << 8)) ^ 0x8000;
 711                 }
 712                 break;
 713
 714         case AFMT_U16_BE:
 715                 for (bp = ((unsigned char *)ibuf)+2*cnt, i = 0; i < cnt; i++) {
 716                         bp -= 2;
 717                         sp--;
 718                         *sp = (bp[1] | (bp[0] << 8)) ^ 0x8000;
 719                 }
 720                 break;
 721
 722         case AFMT_S16_LE:
 723                 for (bp = ((unsigned char *)ibuf)+2*cnt, i = 0; i < cnt; i++) {
 724                         bp -= 2;
 725                         sp--;
 726                         *sp = bp[0] | (bp[1] << 8);
 727                 }
 728                 break;
 729
 730         case AFMT_S16_BE:
 731                 for (bp = ((unsigned char *)ibuf)+2*cnt, i = 0; i < cnt; i++) {
 732                         bp -= 2;
 733                         sp--;
 734                         *sp = bp[1] | (bp[0] << 8);
 735                 }
 736                 break;
 737         }
 738         if (!AFMT_ISSTEREO(ifmt) && AFMT_ISSTEREO(ofmt)) {
 739                 /* expand from mono to stereo */
 740                 for (sp = ((__s16 *)tmp)+scnt, sp2 = ((__s16 *)tmp)+2*scnt, i = 0; i < scnt; i++) {
 741                         sp--;
 742                         sp2 -= 2;
 743                         sp2[0] = sp2[1] = sp[0];
 744                 }
 745         }
 746         if (AFMT_ISSTEREO(ifmt) && !AFMT_ISSTEREO(ofmt)) {
 747                 /* contract from stereo to mono */
 748                 for (sp = sp2 = ((__s16 *)tmp), i = 0; i < scnt; i++, sp++, sp2 += 2)
 749                         sp[0] = (sp2[0] + sp2[1]) >> 1;
 750         }
 751         cnt = scnt;
 752         if (AFMT_ISSTEREO(ofmt))
 753                 cnt <<= 1;
 754         sp = ((__s16 *)tmp);
 755         bp = ((unsigned char *)obuf);
 756         switch (ofmt & ~AFMT_STEREO) {
 757         case AFMT_U8:
 758                 for (i = 0; i < cnt; i++, sp++, bp++)
 759                         *bp = (*sp >> 8) ^ 0x80;
 760                 break;
 761
 762         case AFMT_S8:
 763                 for (i = 0; i < cnt; i++, sp++, bp++)
 764                         *bp = *sp >> 8;
 765                 break;
 766
 767         case AFMT_U16_LE:
 768                 for (i = 0; i < cnt; i++, sp++, bp += 2) {
 769                         s = *sp;
 770                         bp[0] = s;
 771                         bp[1] = (s >> 8) ^ 0x80;
 772                 }
 773                 break;
 774
 775         case AFMT_U16_BE:
 776                 for (i = 0; i < cnt; i++, sp++, bp += 2) {
 777                         s = *sp;
 778                         bp[1] = s;
 779                         bp[0] = (s >> 8) ^ 0x80;
 780                 }
 781                 break;
 782
 783         case AFMT_S16_LE:
 784                 for (i = 0; i < cnt; i++, sp++, bp += 2) {
 785                         s = *sp;
 786                         bp[0] = s;
 787                         bp[1] = s >> 8;
 788                 }
 789                 break;
 790
 791         case AFMT_S16_BE:
 792                 for (i = 0; i < cnt; i++, sp++, bp += 2) {
 793                         s = *sp;
 794                         bp[1] = s;
 795                         bp[0] = s >> 8;
 796                 }
 797                 break;
 798         }
 799
 800 }
 801
 802 static void usbin_convert(struct usbin *u, unsigned char *buffer, unsigned int samples)
 803 {
 804         union {
 805                 __s16 s[64];
 806                 unsigned char b[0];
 807         } tmp;
 808         unsigned int scnt, maxs, ufmtsh, dfmtsh;
 809
 810         ufmtsh = AFMT_BYTESSHIFT(u->format);
 811         dfmtsh = AFMT_BYTESSHIFT(u->dma.format);
 812         maxs = (AFMT_ISSTEREO(u->dma.format | u->format)) ? 32 : 64;
 813         while (samples > 0) {
 814                 scnt = samples;
 815                 if (scnt > maxs)
 816                         scnt = maxs;
 817                 conversion(buffer, u->format, tmp.b, u->dma.format, tmp.b, scnt);
 818                 dmabuf_copyin(&u->dma, tmp.b, scnt << dfmtsh);
 819                 buffer += scnt << ufmtsh;
 820                 samples -= scnt;
 821         }
 822 }
 823
 824 static int usbin_prepare_desc(struct usbin *u, struct urb *urb)
 825 {
 826         unsigned int i, maxsize, offs;
 827
 828         maxsize = (u->freqmax + 0x3fff) >> (14 - AFMT_BYTESSHIFT(u->format));
 829         //printk(KERN_DEBUG "usbin_prepare_desc: maxsize %d freq 0x%x format 0x%x\n", maxsize, u->freqn, u->format);
 830         for (i = offs = 0; i < DESCFRAMES; i++, offs += maxsize) {
 831                 urb->iso_frame_desc[i].length = maxsize;
 832                 urb->iso_frame_desc[i].offset = offs;
 833         }
 834         urb->interval = 1;
 835         return 0;
 836 }
 837
 838 /*
 839  * return value: 0 if descriptor should be restarted, -1 otherwise
 840  * convert sample format on the fly if necessary
 841  */
 842 static int usbin_retire_desc(struct usbin *u, struct urb *urb)
 843 {
 844         unsigned int i, ufmtsh, dfmtsh, err = 0, cnt, scnt, dmafree;
 845         unsigned char *cp;
 846
 847         ufmtsh = AFMT_BYTESSHIFT(u->format);
 848         dfmtsh = AFMT_BYTESSHIFT(u->dma.format);
 849         for (i = 0; i < DESCFRAMES; i++) {
 850                 cp = ((unsigned char *)urb->transfer_buffer) + urb->iso_frame_desc[i].offset;
 851                 if (urb->iso_frame_desc[i].status) {
 852                         dprintk((KERN_DEBUG "usbin_retire_desc: frame %u status %d\n", i, urb->iso_frame_desc[i].status));
 853                         continue;
 854                 }
 855                 scnt = urb->iso_frame_desc[i].actual_length >> ufmtsh;
 856                 if (!scnt)
 857                         continue;
 858                 cnt = scnt << dfmtsh;
 859                 if (!u->dma.mapped) {
 860                         dmafree = u->dma.dmasize - u->dma.count;
 861                         if (cnt > dmafree) {
 862                                 scnt = dmafree >> dfmtsh;
 863                                 cnt = scnt << dfmtsh;
 864                                 err++;
 865                         }
 866                 }
 867                 u->dma.count += cnt;
 868                 if (u->format == u->dma.format) {
 869                         /* we do not need format conversion */
 870                         dprintk((KERN_DEBUG "usbaudio: no sample format conversion\n"));
 871                         dmabuf_copyin(&u->dma, cp, cnt);
 872                 } else {
 873                         /* we need sampling format conversion */
 874                         dprintk((KERN_DEBUG "usbaudio: sample format conversion %x != %x\n", u->format, u->dma.format));
 875                         usbin_convert(u, cp, scnt);
 876                 }
 877         }
 878         if (err)
 879                 u->dma.error++;
 880         if (u->dma.count >= (signed)u->dma.fragsize)
 881                 wake_up(&u->dma.wait);
 882         return err ? -1 : 0;
 883 }
 884
 885 static void usbin_completed(struct urb *urb, struct pt_regs *regs)
 886 {
 887         struct usb_audiodev *as = (struct usb_audiodev *)urb->context;
 888         struct usbin *u = &as->usbin;
 889         unsigned long flags;
 890         unsigned int mask;
 891         int suret = 0;
 892
 893 #if 0
 894         printk(KERN_DEBUG "usbin_completed: status %d errcnt %d flags 0x%x\n", urb->status, urb->error_count, u->flags);
 895 #endif
 896         if (urb == u->durb[0].urb)
 897                 mask = FLG_URB0RUNNING;
 898         else if (urb == u->durb[1].urb)
 899                 mask = FLG_URB1RUNNING;
 900         else {
 901                 mask = 0;
 902                 printk(KERN_ERR "usbin_completed: panic: unknown URB\n");
 903         }
 904         urb->dev = as->state->usbdev;
 905         spin_lock_irqsave(&as->lock, flags);
 906         if (!usbin_retire_desc(u, urb) &&
 907             u->flags & FLG_RUNNING &&
 908             !usbin_prepare_desc(u, urb) &&
 909             (suret = usb_submit_urb(urb, GFP_ATOMIC)) == 0) {
 910                 u->flags |= mask;
 911         } else {
 912                 u->flags &= ~(mask | FLG_RUNNING);
 913                 wake_up(&u->dma.wait);
 914                 printk(KERN_DEBUG "usbin_completed: descriptor not restarted (usb_submit_urb: %d)\n", suret);
 915         }
 916         spin_unlock_irqrestore(&as->lock, flags);
 917 }
 918
 919 /*
 920  * we output sync data
 921  */
 922 static int usbin_sync_prepare_desc(struct usbin *u, struct urb *urb)
 923 {
 924         unsigned char *cp = urb->transfer_buffer;
 925         unsigned int i, offs;
 926
 927         for (i = offs = 0; i < SYNCFRAMES; i++, offs += 3, cp += 3) {
 928                 urb->iso_frame_desc[i].length = 3;
 929                 urb->iso_frame_desc[i].offset = offs;
 930                 cp[0] = u->freqn;
 931                 cp[1] = u->freqn >> 8;
 932                 cp[2] = u->freqn >> 16;
 933         }
 934         urb->interval = 1;
 935         return 0;
 936 }
 937
 938 /*
 939  * return value: 0 if descriptor should be restarted, -1 otherwise
 940  */
 941 static int usbin_sync_retire_desc(struct usbin *u, struct urb *urb)
 942 {
 943         unsigned int i;
 944
 945         for (i = 0; i < SYNCFRAMES; i++)
 946                 if (urb->iso_frame_desc[0].status)
 947                         dprintk((KERN_DEBUG "usbin_sync_retire_desc: frame %u status %d\n", i, urb->iso_frame_desc[i].status));
 948         return 0;
 949 }
 950
 951 static void usbin_sync_completed(struct urb *urb, struct pt_regs *regs)
 952 {
 953         struct usb_audiodev *as = (struct usb_audiodev *)urb->context;
 954         struct usbin *u = &as->usbin;
 955         unsigned long flags;
 956         unsigned int mask;
 957         int suret = 0;
 958
 959 #if 0
 960         printk(KERN_DEBUG "usbin_sync_completed: status %d errcnt %d flags 0x%x\n", urb->status, urb->error_count, u->flags);
 961 #endif
 962         if (urb == u->surb[0].urb)
 963                 mask = FLG_SYNC0RUNNING;
 964         else if (urb == u->surb[1].urb)
 965                 mask = FLG_SYNC1RUNNING;
 966         else {
 967                 mask = 0;
 968                 printk(KERN_ERR "usbin_sync_completed: panic: unknown URB\n");
 969         }
 970         urb->dev = as->state->usbdev;
 971         spin_lock_irqsave(&as->lock, flags);
 972         if (!usbin_sync_retire_desc(u, urb) &&
 973             u->flags & FLG_RUNNING &&
 974             !usbin_sync_prepare_desc(u, urb) &&
 975             (suret = usb_submit_urb(urb, GFP_ATOMIC)) == 0) {
 976                 u->flags |= mask;
 977         } else {
 978                 u->flags &= ~(mask | FLG_RUNNING);
 979                 wake_up(&u->dma.wait);
 980                 dprintk((KERN_DEBUG "usbin_sync_completed: descriptor not restarted (usb_submit_urb: %d)\n", suret));
 981         }
 982         spin_unlock_irqrestore(&as->lock, flags);
 983 }
 984
 985 static int usbin_start(struct usb_audiodev *as)
 986 {
 987         struct usb_device *dev = as->state->usbdev;
 988         struct usbin *u = &as->usbin;
 989         struct urb *urb;
 990         unsigned long flags;
 991         unsigned int maxsze, bufsz;
 992
 993 #if 0
 994         printk(KERN_DEBUG "usbin_start: device %d ufmt 0x%08x dfmt 0x%08x srate %d\n",
 995                dev->devnum, u->format, u->dma.format, u->dma.srate);
 996 #endif
 997         /* allocate USB storage if not already done */
 998         spin_lock_irqsave(&as->lock, flags);
 999         if (!(u->flags & FLG_CONNECTED)) {
1000                 spin_unlock_irqrestore(&as->lock, flags);
1001                 return -EIO;
1002         }
1003         if (!(u->flags & FLG_RUNNING)) {
1004                 spin_unlock_irqrestore(&as->lock, flags);
1005                 u->freqn = ((u->dma.srate << 11) + 62) / 125; /* this will overflow at approx 2MSPS */
1006                 u->freqmax = u->freqn + (u->freqn >> 2);
1007                 u->phase = 0;
1008                 maxsze = (u->freqmax + 0x3fff) >> (14 - AFMT_BYTESSHIFT(u->format));
1009                 bufsz = DESCFRAMES * maxsze;
1010                 kfree(u->durb[0].urb->transfer_buffer);
1011                 u->durb[0].urb->transfer_buffer = kmalloc(bufsz, GFP_KERNEL);
1012                 u->durb[0].urb->transfer_buffer_length = bufsz;
1013                 kfree(u->durb[1].urb->transfer_buffer);
1014                 u->durb[1].urb->transfer_buffer = kmalloc(bufsz, GFP_KERNEL);
1015                 u->durb[1].urb->transfer_buffer_length = bufsz;
1016                 if (u->syncpipe) {
1017                         kfree(u->surb[0].urb->transfer_buffer);
1018                         u->surb[0].urb->transfer_buffer = kmalloc(3*SYNCFRAMES, GFP_KERNEL);
1019                         u->surb[0].urb->transfer_buffer_length = 3*SYNCFRAMES;
1020                         kfree(u->surb[1].urb->transfer_buffer);
1021                         u->surb[1].urb->transfer_buffer = kmalloc(3*SYNCFRAMES, GFP_KERNEL);
1022                         u->surb[1].urb->transfer_buffer_length = 3*SYNCFRAMES;
1023                 }
1024                 if (!u->durb[0].urb->transfer_buffer || !u->durb[1].urb->transfer_buffer ||
1025                     (u->syncpipe && (!u->surb[0].urb->transfer_buffer || !u->surb[1].urb->transfer_buffer))) {
1026                         printk(KERN_ERR "usbaudio: cannot start playback device %d\n", dev->devnum);
1027                         return 0;
1028                 }
1029                 spin_lock_irqsave(&as->lock, flags);
1030         }
1031         if (u->dma.count >= u->dma.dmasize && !u->dma.mapped) {
1032                 spin_unlock_irqrestore(&as->lock, flags);
1033                 return 0;
1034         }
1035         u->flags |= FLG_RUNNING;
1036         if (!(u->flags & FLG_URB0RUNNING)) {
1037                 urb = u->durb[0].urb;
1038                 urb->dev = dev;
1039                 urb->pipe = u->datapipe;
1040                 urb->transfer_flags = URB_ISO_ASAP;
1041                 urb->number_of_packets = DESCFRAMES;
1042                 urb->context = as;
1043                 urb->complete = usbin_completed;
1044                 if (!usbin_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_KERNEL))
1045                         u->flags |= FLG_URB0RUNNING;
1046                 else
1047                         u->flags &= ~FLG_RUNNING;
1048         }
1049         if (u->flags & FLG_RUNNING && !(u->flags & FLG_URB1RUNNING)) {
1050                 urb = u->durb[1].urb;
1051                 urb->dev = dev;
1052                 urb->pipe = u->datapipe;
1053                 urb->transfer_flags = URB_ISO_ASAP;
1054                 urb->number_of_packets = DESCFRAMES;
1055                 urb->context = as;
1056                 urb->complete = usbin_completed;
1057                 if (!usbin_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_KERNEL))
1058                         u->flags |= FLG_URB1RUNNING;
1059                 else
1060                         u->flags &= ~FLG_RUNNING;
1061         }
1062         if (u->syncpipe) {
1063                 if (u->flags & FLG_RUNNING && !(u->flags & FLG_SYNC0RUNNING)) {
1064                         urb = u->surb[0].urb;
1065                         urb->dev = dev;
1066                         urb->pipe = u->syncpipe;
1067                         urb->transfer_flags = URB_ISO_ASAP;
1068                         urb->number_of_packets = SYNCFRAMES;
1069                         urb->context = as;
1070                         urb->complete = usbin_sync_completed;
1071                         /* stride: u->syncinterval */
1072                         if (!usbin_sync_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_KERNEL))
1073                                 u->flags |= FLG_SYNC0RUNNING;
1074                         else
1075                                 u->flags &= ~FLG_RUNNING;
1076                 }
1077                 if (u->flags & FLG_RUNNING && !(u->flags & FLG_SYNC1RUNNING)) {
1078                         urb = u->surb[1].urb;
1079                         urb->dev = dev;
1080                         urb->pipe = u->syncpipe;
1081                         urb->transfer_flags = URB_ISO_ASAP;
1082                         urb->number_of_packets = SYNCFRAMES;
1083                         urb->context = as;
1084                         urb->complete = usbin_sync_completed;
1085                         /* stride: u->syncinterval */
1086                         if (!usbin_sync_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_KERNEL))
1087                                 u->flags |= FLG_SYNC1RUNNING;
1088                         else
1089                                 u->flags &= ~FLG_RUNNING;
1090                 }
1091         }
1092         spin_unlock_irqrestore(&as->lock, flags);
1093         return 0;
1094 }
1095
1096 static void usbout_stop(struct usb_audiodev *as)
1097 {
1098         struct usbout *u = &as->usbout;
1099         unsigned long flags;
1100         unsigned int i, notkilled = 1;
1101
1102         spin_lock_irqsave(&as->lock, flags);
1103         u->flags &= ~FLG_RUNNING;
1104         i = u->flags;
1105         spin_unlock_irqrestore(&as->lock, flags);
1106         while (i & (FLG_URB0RUNNING|FLG_URB1RUNNING|FLG_SYNC0RUNNING|FLG_SYNC1RUNNING)) {
1107                 if (notkilled)
1108                         schedule_timeout_interruptible(1);
1109                 else
1110                         schedule_timeout_uninterruptible(1);
1111                 spin_lock_irqsave(&as->lock, flags);
1112                 i = u->flags;
1113                 spin_unlock_irqrestore(&as->lock, flags);
1114                 if (notkilled && signal_pending(current)) {
1115                         if (i & FLG_URB0RUNNING)
1116                                 usb_kill_urb(u->durb[0].urb);
1117                         if (i & FLG_URB1RUNNING)
1118                                 usb_kill_urb(u->durb[1].urb);
1119                         if (i & FLG_SYNC0RUNNING)
1120                                 usb_kill_urb(u->surb[0].urb);
1121                         if (i & FLG_SYNC1RUNNING)
1122                                 usb_kill_urb(u->surb[1].urb);
1123                         notkilled = 0;
1124                 }
1125         }
1126         set_current_state(TASK_RUNNING);
1127         kfree(u->durb[0].urb->transfer_buffer);
1128         kfree(u->durb[1].urb->transfer_buffer);
1129         kfree(u->surb[0].urb->transfer_buffer);
1130         kfree(u->surb[1].urb->transfer_buffer);
1131         u->durb[0].urb->transfer_buffer = u->durb[1].urb->transfer_buffer =
1132                 u->surb[0].urb->transfer_buffer = u->surb[1].urb->transfer_buffer = NULL;
1133 }
1134
1135 static inline void usbout_release(struct usb_audiodev *as)
1136 {
1137         usbout_stop(as);
1138 }
1139
1140 static void usbout_disc(struct usb_audiodev *as)
1141 {
1142         struct usbout *u = &as->usbout;
1143         unsigned long flags;
1144
1145         spin_lock_irqsave(&as->lock, flags);
1146         u->flags &= ~(FLG_RUNNING | FLG_CONNECTED);
1147         spin_unlock_irqrestore(&as->lock, flags);
1148         usbout_stop(as);
1149 }
1150
1151 static void usbout_convert(struct usbout *u, unsigned char *buffer, unsigned int samples)
1152 {
1153         union {
1154                 __s16 s[64];
1155                 unsigned char b[0];
1156         } tmp;
1157         unsigned int scnt, maxs, ufmtsh, dfmtsh;
1158
1159         ufmtsh = AFMT_BYTESSHIFT(u->format);
1160         dfmtsh = AFMT_BYTESSHIFT(u->dma.format);
1161         maxs = (AFMT_ISSTEREO(u->dma.format | u->format)) ? 32 : 64;
1162         while (samples > 0) {
1163                 scnt = samples;
1164                 if (scnt > maxs)
1165                         scnt = maxs;
1166                 dmabuf_copyout(&u->dma, tmp.b, scnt << dfmtsh);
1167                 conversion(tmp.b, u->dma.format, buffer, u->format, tmp.b, scnt);
1168                 buffer += scnt << ufmtsh;
1169                 samples -= scnt;
1170         }
1171 }
1172
1173 static int usbout_prepare_desc(struct usbout *u, struct urb *urb)
1174 {
1175         unsigned int i, ufmtsh, dfmtsh, err = 0, cnt, scnt, offs;
1176         unsigned char *cp = urb->transfer_buffer;
1177
1178         ufmtsh = AFMT_BYTESSHIFT(u->format);
1179         dfmtsh = AFMT_BYTESSHIFT(u->dma.format);
1180         for (i = offs = 0; i < DESCFRAMES; i++) {
1181                 urb->iso_frame_desc[i].offset = offs;
1182                 u->phase = (u->phase & 0x3fff) + u->freqm;
1183                 scnt = u->phase >> 14;
1184                 if (!scnt) {
1185                         urb->iso_frame_desc[i].length = 0;
1186                         continue;
1187                 }
1188                 cnt = scnt << dfmtsh;
1189                 if (!u->dma.mapped) {
1190                         if (cnt > u->dma.count) {
1191                                 scnt = u->dma.count >> dfmtsh;
1192                                 cnt = scnt << dfmtsh;
1193                                 err++;
1194                         }
1195                         u->dma.count -= cnt;
1196                 } else
1197                         u->dma.count += cnt;
1198                 if (u->format == u->dma.format) {
1199                         /* we do not need format conversion */
1200                         dmabuf_copyout(&u->dma, cp, cnt);
1201                 } else {
1202                         /* we need sampling format conversion */
1203                         usbout_convert(u, cp, scnt);
1204                 }
1205                 cnt = scnt << ufmtsh;
1206                 urb->iso_frame_desc[i].length = cnt;
1207                 offs += cnt;
1208                 cp += cnt;
1209         }
1210         urb->interval = 1;
1211         if (err)
1212                 u->dma.error++;
1213         if (u->dma.mapped) {
1214                 if (u->dma.count >= (signed)u->dma.fragsize)
1215                         wake_up(&u->dma.wait);
1216         } else {
1217                 if ((signed)u->dma.dmasize >= u->dma.count + (signed)u->dma.fragsize)
1218                         wake_up(&u->dma.wait);
1219         }
1220         return err ? -1 : 0;
1221 }
1222
1223 /*
1224  * return value: 0 if descriptor should be restarted, -1 otherwise
1225  */
1226 static int usbout_retire_desc(struct usbout *u, struct urb *urb)
1227 {
1228         unsigned int i;
1229
1230         for (i = 0; i < DESCFRAMES; i++) {
1231                 if (urb->iso_frame_desc[i].status) {
1232                         dprintk((KERN_DEBUG "usbout_retire_desc: frame %u status %d\n", i, urb->iso_frame_desc[i].status));
1233                         continue;
1234                 }
1235         }
1236         return 0;
1237 }
1238
1239 static void usbout_completed(struct urb *urb, struct pt_regs *regs)
1240 {
1241         struct usb_audiodev *as = (struct usb_audiodev *)urb->context;
1242         struct usbout *u = &as->usbout;
1243         unsigned long flags;
1244         unsigned int mask;
1245         int suret = 0;
1246
1247 #if 0
1248         printk(KERN_DEBUG "usbout_completed: status %d errcnt %d flags 0x%x\n", urb->status, urb->error_count, u->flags);
1249 #endif
1250         if (urb == u->durb[0].urb)
1251                 mask = FLG_URB0RUNNING;
1252         else if (urb == u->durb[1].urb)
1253                 mask = FLG_URB1RUNNING;
1254         else {
1255                 mask = 0;
1256                 printk(KERN_ERR "usbout_completed: panic: unknown URB\n");
1257         }
1258         urb->dev = as->state->usbdev;
1259         spin_lock_irqsave(&as->lock, flags);
1260         if (!usbout_retire_desc(u, urb) &&
1261             u->flags & FLG_RUNNING &&
1262             !usbout_prepare_desc(u, urb) &&
1263             (suret = usb_submit_urb(urb, GFP_ATOMIC)) == 0) {
1264                 u->flags |= mask;
1265         } else {
1266                 u->flags &= ~(mask | FLG_RUNNING);
1267                 wake_up(&u->dma.wait);
1268                 dprintk((KERN_DEBUG "usbout_completed: descriptor not restarted (usb_submit_urb: %d)\n", suret));
1269         }
1270         spin_unlock_irqrestore(&as->lock, flags);
1271 }
1272
1273 static int usbout_sync_prepare_desc(struct usbout *u, struct urb *urb)
1274 {
1275         unsigned int i, offs;
1276
1277         for (i = offs = 0; i < SYNCFRAMES; i++, offs += 3) {
1278                 urb->iso_frame_desc[i].length = 3;
1279                 urb->iso_frame_desc[i].offset = offs;
1280         }
1281         urb->interval = 1;
1282         return 0;
1283 }
1284
1285 /*
1286  * return value: 0 if descriptor should be restarted, -1 otherwise
1287  */
1288 static int usbout_sync_retire_desc(struct usbout *u, struct urb *urb)
1289 {
1290         unsigned char *cp = urb->transfer_buffer;
1291         unsigned int f, i;
1292
1293         for (i = 0; i < SYNCFRAMES; i++, cp += 3) {
1294                 if (urb->iso_frame_desc[i].status) {
1295                         dprintk((KERN_DEBUG "usbout_sync_retire_desc: frame %u status %d\n", i, urb->iso_frame_desc[i].status));
1296                         continue;
1297                 }
1298                 if (urb->iso_frame_desc[i].actual_length < 3) {
1299                         dprintk((KERN_DEBUG "usbout_sync_retire_desc: frame %u length %d\n", i, urb->iso_frame_desc[i].actual_length));
1300                         continue;
1301                 }
1302                 f = cp[0] | (cp[1] << 8) | (cp[2] << 16);
1303                 if (abs(f - u->freqn) > (u->freqn >> 3) || f > u->freqmax) {
1304                         printk(KERN_WARNING "usbout_sync_retire_desc: requested frequency %u (nominal %u) out of range!\n", f, u->freqn);
1305                         continue;
1306                 }
1307                 u->freqm = f;
1308         }
1309         return 0;
1310 }
1311
1312 static void usbout_sync_completed(struct urb *urb, struct pt_regs *regs)
1313 {
1314         struct usb_audiodev *as = (struct usb_audiodev *)urb->context;
1315         struct usbout *u = &as->usbout;
1316         unsigned long flags;
1317         unsigned int mask;
1318         int suret = 0;
1319
1320 #if 0
1321         printk(KERN_DEBUG "usbout_sync_completed: status %d errcnt %d flags 0x%x\n", urb->status, urb->error_count, u->flags);
1322 #endif
1323         if (urb == u->surb[0].urb)
1324                 mask = FLG_SYNC0RUNNING;
1325         else if (urb == u->surb[1].urb)
1326                 mask = FLG_SYNC1RUNNING;
1327         else {
1328                 mask = 0;
1329                 printk(KERN_ERR "usbout_sync_completed: panic: unknown URB\n");
1330         }
1331         urb->dev = as->state->usbdev;
1332         spin_lock_irqsave(&as->lock, flags);
1333         if (!usbout_sync_retire_desc(u, urb) &&
1334             u->flags & FLG_RUNNING &&
1335             !usbout_sync_prepare_desc(u, urb) &&
1336             (suret = usb_submit_urb(urb, GFP_ATOMIC)) == 0) {
1337                 u->flags |= mask;
1338         } else {
1339                 u->flags &= ~(mask | FLG_RUNNING);
1340                 wake_up(&u->dma.wait);
1341                 dprintk((KERN_DEBUG "usbout_sync_completed: descriptor not restarted (usb_submit_urb: %d)\n", suret));
1342         }
1343         spin_unlock_irqrestore(&as->lock, flags);
1344 }
1345
1346 static int usbout_start(struct usb_audiodev *as)
1347 {
1348         struct usb_device *dev = as->state->usbdev;
1349         struct usbout *u = &as->usbout;
1350         struct urb *urb;
1351         unsigned long flags;
1352         unsigned int maxsze, bufsz;
1353
1354 #if 0
1355         printk(KERN_DEBUG "usbout_start: device %d ufmt 0x%08x dfmt 0x%08x srate %d\n",
1356                dev->devnum, u->format, u->dma.format, u->dma.srate);
1357 #endif
1358         /* allocate USB storage if not already done */
1359         spin_lock_irqsave(&as->lock, flags);
1360         if (!(u->flags & FLG_CONNECTED)) {
1361                 spin_unlock_irqrestore(&as->lock, flags);
1362                 return -EIO;
1363         }
1364         if (!(u->flags & FLG_RUNNING)) {
1365                 spin_unlock_irqrestore(&as->lock, flags);
1366                 u->freqn = u->freqm = ((u->dma.srate << 11) + 62) / 125; /* this will overflow at approx 2MSPS */
1367                 u->freqmax = u->freqn + (u->freqn >> 2);
1368                 u->phase = 0;
1369                 maxsze = (u->freqmax + 0x3fff) >> (14 - AFMT_BYTESSHIFT(u->format));
1370                 bufsz = DESCFRAMES * maxsze;
1371                 kfree(u->durb[0].urb->transfer_buffer);
1372                 u->durb[0].urb->transfer_buffer = kmalloc(bufsz, GFP_KERNEL);
1373                 u->durb[0].urb->transfer_buffer_length = bufsz;
1374                 kfree(u->durb[1].urb->transfer_buffer);
1375                 u->durb[1].urb->transfer_buffer = kmalloc(bufsz, GFP_KERNEL);
1376                 u->durb[1].urb->transfer_buffer_length = bufsz;
1377                 if (u->syncpipe) {
1378                         kfree(u->surb[0].urb->transfer_buffer);
1379                         u->surb[0].urb->transfer_buffer = kmalloc(3*SYNCFRAMES, GFP_KERNEL);
1380                         u->surb[0].urb->transfer_buffer_length = 3*SYNCFRAMES;
1381                         kfree(u->surb[1].urb->transfer_buffer);
1382                         u->surb[1].urb->transfer_buffer = kmalloc(3*SYNCFRAMES, GFP_KERNEL);
1383                         u->surb[1].urb->transfer_buffer_length = 3*SYNCFRAMES;
1384                 }
1385                 if (!u->durb[0].urb->transfer_buffer || !u->durb[1].urb->transfer_buffer ||
1386                     (u->syncpipe && (!u->surb[0].urb->transfer_buffer || !u->surb[1].urb->transfer_buffer))) {
1387                         printk(KERN_ERR "usbaudio: cannot start playback device %d\n", dev->devnum);
1388                         return 0;
1389                 }
1390                 spin_lock_irqsave(&as->lock, flags);
1391         }
1392         if (u->dma.count <= 0 && !u->dma.mapped) {
1393                 spin_unlock_irqrestore(&as->lock, flags);
1394                 return 0;
1395         }
1396         u->flags |= FLG_RUNNING;
1397         if (!(u->flags & FLG_URB0RUNNING)) {
1398                 urb = u->durb[0].urb;
1399                 urb->dev = dev;
1400                 urb->pipe = u->datapipe;
1401                 urb->transfer_flags = URB_ISO_ASAP;
1402                 urb->number_of_packets = DESCFRAMES;
1403                 urb->context = as;
1404                 urb->complete = usbout_completed;
1405                 if (!usbout_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_ATOMIC))
1406                         u->flags |= FLG_URB0RUNNING;
1407                 else
1408                         u->flags &= ~FLG_RUNNING;
1409         }
1410         if (u->flags & FLG_RUNNING && !(u->flags & FLG_URB1RUNNING)) {
1411                 urb = u->durb[1].urb;
1412                 urb->dev = dev;
1413                 urb->pipe = u->datapipe;
1414                 urb->transfer_flags = URB_ISO_ASAP;
1415                 urb->number_of_packets = DESCFRAMES;
1416                 urb->context = as;
1417                 urb->complete = usbout_completed;
1418                 if (!usbout_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_ATOMIC))
1419                         u->flags |= FLG_URB1RUNNING;
1420                 else
1421                         u->flags &= ~FLG_RUNNING;
1422         }
1423         if (u->syncpipe) {
1424                 if (u->flags & FLG_RUNNING && !(u->flags & FLG_SYNC0RUNNING)) {
1425                         urb = u->surb[0].urb;
1426                         urb->dev = dev;
1427                         urb->pipe = u->syncpipe;
1428                         urb->transfer_flags = URB_ISO_ASAP;
1429                         urb->number_of_packets = SYNCFRAMES;
1430                         urb->context = as;
1431                         urb->complete = usbout_sync_completed;
1432                         /* stride: u->syncinterval */
1433                         if (!usbout_sync_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_ATOMIC))
1434                                 u->flags |= FLG_SYNC0RUNNING;
1435                         else
1436                                 u->flags &= ~FLG_RUNNING;
1437                 }
1438                 if (u->flags & FLG_RUNNING && !(u->flags & FLG_SYNC1RUNNING)) {
1439                         urb = u->surb[1].urb;
1440                         urb->dev = dev;
1441                         urb->pipe = u->syncpipe;
1442                         urb->transfer_flags = URB_ISO_ASAP;
1443                         urb->number_of_packets = SYNCFRAMES;
1444                         urb->context = as;
1445                         urb->complete = usbout_sync_completed;
1446                         /* stride: u->syncinterval */
1447                         if (!usbout_sync_prepare_desc(u, urb) && !usb_submit_urb(urb, GFP_ATOMIC))
1448                                 u->flags |= FLG_SYNC1RUNNING;
1449                         else
1450                                 u->flags &= ~FLG_RUNNING;
1451                 }
1452         }
1453         spin_unlock_irqrestore(&as->lock, flags);
1454         return 0;
1455 }
1456
1457 /* --------------------------------------------------------------------- */
1458
1459 static unsigned int format_goodness(struct audioformat *afp, unsigned int fmt, unsigned int srate)
1460 {
1461         unsigned int g = 0;
1462
1463         if (srate < afp->sratelo)
1464                 g += afp->sratelo - srate;
1465         if (srate > afp->sratehi)
1466                 g += srate - afp->sratehi;
1467         if (AFMT_ISSTEREO(afp->format) && !AFMT_ISSTEREO(fmt))
1468                 g += 0x100000;
1469         if (!AFMT_ISSTEREO(afp->format) && AFMT_ISSTEREO(fmt))
1470                 g += 0x400000;
1471         if (AFMT_IS16BIT(afp->format) && !AFMT_IS16BIT(fmt))
1472                 g += 0x100000;
1473         if (!AFMT_IS16BIT(afp->format) && AFMT_IS16BIT(fmt))
1474                 g += 0x400000;
1475         return g;
1476 }
1477
1478 static int find_format(struct audioformat *afp, unsigned int nr, unsigned int fmt, unsigned int srate)
1479 {
1480         unsigned int i, g, gb = ~0;
1481         int j = -1; /* default to failure */
1482
1483         /* find "best" format (according to format_goodness) */
1484         for (i = 0; i < nr; i++) {
1485                 g = format_goodness(&afp[i], fmt, srate);
1486                 if (g >= gb)
1487                         continue;
1488                 j = i;
1489                 gb = g;
1490         }
1491         return j;
1492 }
1493
1494 static int set_format_in(struct usb_audiodev *as)
1495 {
1496         struct usb_device *dev = as->state->usbdev;
1497         struct usb_host_interface *alts;
1498         struct usb_interface *iface;
1499         struct usbin *u = &as->usbin;
1500         struct dmabuf *d = &u->dma;
1501         struct audioformat *fmt;
1502         unsigned int ep;
1503         unsigned char data[3];
1504         int fmtnr, ret;
1505
1506         iface = usb_ifnum_to_if(dev, u->interface);
1507         if (!iface)
1508                 return 0;
1509
1510         fmtnr = find_format(as->fmtin, as->numfmtin, d->format, d->srate);
1511         if (fmtnr < 0) {
1512                 printk(KERN_ERR "usbaudio: set_format_in(): failed to find desired format/speed combination.\n");
1513                 return -1;
1514         }
1515
1516         fmt = as->fmtin + fmtnr;
1517         alts = usb_altnum_to_altsetting(iface, fmt->altsetting);
1518         u->format = fmt->format;
1519         u->datapipe = usb_rcvisocpipe(dev, alts->endpoint[0].desc.bEndpointAddress & 0xf);
1520         u->syncpipe = u->syncinterval = 0;
1521         if ((alts->endpoint[0].desc.bmAttributes & 0x0c) == 0x08) {
1522                 if (alts->desc.bNumEndpoints < 2 ||
1523                     alts->endpoint[1].desc.bmAttributes != 0x01 ||
1524                     alts->endpoint[1].desc.bSynchAddress != 0 ||
1525                     alts->endpoint[1].desc.bEndpointAddress != (alts->endpoint[0].desc.bSynchAddress & 0x7f)) {
1526                         printk(KERN_WARNING "usbaudio: device %d interface %d altsetting %d claims adaptive in "
1527                                "but has invalid synch pipe; treating as asynchronous in\n",
1528                                dev->devnum, u->interface, fmt->altsetting);
1529                 } else {
1530                         u->syncpipe = usb_sndisocpipe(dev, alts->endpoint[1].desc.bEndpointAddress & 0xf);
1531                         u->syncinterval = alts->endpoint[1].desc.bRefresh;
1532                 }
1533         }
1534         if (d->srate < fmt->sratelo)
1535                 d->srate = fmt->sratelo;
1536         if (d->srate > fmt->sratehi)
1537                 d->srate = fmt->sratehi;
1538         dprintk((KERN_DEBUG "usbaudio: set_format_in: usb_set_interface %u %u\n",
1539                         u->interface, fmt->altsetting));
1540         if (usb_set_interface(dev, alts->desc.bInterfaceNumber, fmt->altsetting) < 0) {
1541                 printk(KERN_WARNING "usbaudio: usb_set_interface failed, device %d interface %d altsetting %d\n",
1542                        dev->devnum, u->interface, fmt->altsetting);
1543                 return -1;
1544         }
1545         if (fmt->sratelo == fmt->sratehi)
1546                 return 0;
1547         ep = usb_pipeendpoint(u->datapipe) | (u->datapipe & USB_DIR_IN);
1548         /* if endpoint has pitch control, enable it */
1549         if (fmt->attributes & 0x02) {
1550                 data[0] = 1;
1551                 if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_OUT,
1552                                            PITCH_CONTROL << 8, ep, data, 1, 1000)) < 0) {
1553                         printk(KERN_ERR "usbaudio: failure (error %d) to set output pitch control device %d interface %u endpoint 0x%x to %u\n",
1554                                ret, dev->devnum, u->interface, ep, d->srate);
1555                         return -1;
1556                 }
1557         }
1558         /* if endpoint has sampling rate control, set it */
1559         if (fmt->attributes & 0x01) {
1560                 data[0] = d->srate;
1561                 data[1] = d->srate >> 8;
1562                 data[2] = d->srate >> 16;
1563                 if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_OUT,
1564                                            SAMPLING_FREQ_CONTROL << 8, ep, data, 3, 1000)) < 0) {
1565                         printk(KERN_ERR "usbaudio: failure (error %d) to set input sampling frequency device %d interface %u endpoint 0x%x to %u\n",
1566                                ret, dev->devnum, u->interface, ep, d->srate);
1567                         return -1;
1568                 }
1569                 if ((ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_IN,
1570                                            SAMPLING_FREQ_CONTROL << 8, ep, data, 3, 1000)) < 0) {
1571                         printk(KERN_ERR "usbaudio: failure (error %d) to get input sampling frequency device %d interface %u endpoint 0x%x\n",
1572                                ret, dev->devnum, u->interface, ep);
1573                         return -1;
1574                 }
1575                 dprintk((KERN_DEBUG "usbaudio: set_format_in: device %d interface %d altsetting %d srate req: %u real %u\n",
1576                         dev->devnum, u->interface, fmt->altsetting, d->srate, data[0] | (data[1] << 8) | (data[2] << 16)));
1577                 d->srate = data[0] | (data[1] << 8) | (data[2] << 16);
1578         }
1579         dprintk((KERN_DEBUG "usbaudio: set_format_in: USB format 0x%x, DMA format 0x%x srate %u\n", u->format, d->format, d->srate));
1580         return 0;
1581 }
1582
1583 static int set_format_out(struct usb_audiodev *as)
1584 {
1585         struct usb_device *dev = as->state->usbdev;
1586         struct usb_host_interface *alts;
1587         struct usb_interface *iface;
1588         struct usbout *u = &as->usbout;
1589         struct dmabuf *d = &u->dma;
1590         struct audioformat *fmt;
1591         unsigned int ep;
1592         unsigned char data[3];
1593         int fmtnr, ret;
1594
1595         iface = usb_ifnum_to_if(dev, u->interface);
1596         if (!iface)
1597                 return 0;
1598
1599         fmtnr = find_format(as->fmtout, as->numfmtout, d->format, d->srate);
1600         if (fmtnr < 0) {
1601                 printk(KERN_ERR "usbaudio: set_format_out(): failed to find desired format/speed combination.\n");
1602                 return -1;
1603         }
1604
1605         fmt = as->fmtout + fmtnr;
1606         u->format = fmt->format;
1607         alts = usb_altnum_to_altsetting(iface, fmt->altsetting);
1608         u->datapipe = usb_sndisocpipe(dev, alts->endpoint[0].desc.bEndpointAddress & 0xf);
1609         u->syncpipe = u->syncinterval = 0;
1610         if ((alts->endpoint[0].desc.bmAttributes & 0x0c) == 0x04) {
1611 #if 0
1612                 printk(KERN_DEBUG "bNumEndpoints 0x%02x endpoint[1].bmAttributes 0x%02x\n"
1613                        KERN_DEBUG "endpoint[1].bSynchAddress 0x%02x endpoint[1].bEndpointAddress 0x%02x\n"
1614                        KERN_DEBUG "endpoint[0].bSynchAddress 0x%02x\n", alts->bNumEndpoints,
1615                        alts->endpoint[1].bmAttributes, alts->endpoint[1].bSynchAddress,
1616                        alts->endpoint[1].bEndpointAddress, alts->endpoint[0].bSynchAddress);
1617 #endif
1618                 if (alts->desc.bNumEndpoints < 2 ||
1619                     alts->endpoint[1].desc.bmAttributes != 0x01 ||
1620                     alts->endpoint[1].desc.bSynchAddress != 0 ||
1621                     alts->endpoint[1].desc.bEndpointAddress != (alts->endpoint[0].desc.bSynchAddress | 0x80)) {
1622                         printk(KERN_WARNING "usbaudio: device %d interface %d altsetting %d claims asynch out "
1623                                "but has invalid synch pipe; treating as adaptive out\n",
1624                                dev->devnum, u->interface, fmt->altsetting);
1625                 } else {
1626                         u->syncpipe = usb_rcvisocpipe(dev, alts->endpoint[1].desc.bEndpointAddress & 0xf);
1627                         u->syncinterval = alts->endpoint[1].desc.bRefresh;
1628                 }
1629         }
1630         if (d->srate < fmt->sratelo)
1631                 d->srate = fmt->sratelo;
1632         if (d->srate > fmt->sratehi)
1633                 d->srate = fmt->sratehi;
1634         dprintk((KERN_DEBUG "usbaudio: set_format_out: usb_set_interface %u %u\n",
1635                         u->interface, fmt->altsetting));
1636         if (usb_set_interface(dev, u->interface, fmt->altsetting) < 0) {
1637                 printk(KERN_WARNING "usbaudio: usb_set_interface failed, device %d interface %d altsetting %d\n",
1638                        dev->devnum, u->interface, fmt->altsetting);
1639                 return -1;
1640         }
1641         if (fmt->sratelo == fmt->sratehi)
1642                 return 0;
1643         ep = usb_pipeendpoint(u->datapipe) | (u->datapipe & USB_DIR_IN);
1644         /* if endpoint has pitch control, enable it */
1645         if (fmt->attributes & 0x02) {
1646                 data[0] = 1;
1647                 if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_OUT,
1648                                            PITCH_CONTROL << 8, ep, data, 1, 1000)) < 0) {
1649                         printk(KERN_ERR "usbaudio: failure (error %d) to set output pitch control device %d interface %u endpoint 0x%x to %u\n",
1650                                ret, dev->devnum, u->interface, ep, d->srate);
1651                         return -1;
1652                 }
1653         }
1654         /* if endpoint has sampling rate control, set it */
1655         if (fmt->attributes & 0x01) {
1656                 data[0] = d->srate;
1657                 data[1] = d->srate >> 8;
1658                 data[2] = d->srate >> 16;
1659                 if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_OUT,
1660                                            SAMPLING_FREQ_CONTROL << 8, ep, data, 3, 1000)) < 0) {
1661                         printk(KERN_ERR "usbaudio: failure (error %d) to set output sampling frequency device %d interface %u endpoint 0x%x to %u\n",
1662                                ret, dev->devnum, u->interface, ep, d->srate);
1663                         return -1;
1664                 }
1665                 if ((ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_TYPE_CLASS|USB_RECIP_ENDPOINT|USB_DIR_IN,
1666                                            SAMPLING_FREQ_CONTROL << 8, ep, data, 3, 1000)) < 0) {
1667                         printk(KERN_ERR "usbaudio: failure (error %d) to get output sampling frequency device %d interface %u endpoint 0x%x\n",
1668                                ret, dev->devnum, u->interface, ep);
1669                         return -1;
1670                 }
1671                 dprintk((KERN_DEBUG "usbaudio: set_format_out: device %d interface %d altsetting %d srate req: %u real %u\n",
1672                         dev->devnum, u->interface, fmt->altsetting, d->srate, data[0] | (data[1] << 8) | (data[2] << 16)));
1673                 d->srate = data[0] | (data[1] << 8) | (data[2] << 16);
1674         }
1675         dprintk((KERN_DEBUG "usbaudio: set_format_out: USB format 0x%x, DMA format 0x%x srate %u\n", u->format, d->format, d->srate));
1676         return 0;
1677 }
1678
1679 static int set_format(struct usb_audiodev *s, unsigned int fmode, unsigned int fmt, unsigned int srate)
1680 {
1681         int ret1 = 0, ret2 = 0;
1682
1683         if (!(fmode & (FMODE_READ|FMODE_WRITE)))
1684                 return -EINVAL;
1685         if (fmode & FMODE_READ) {
1686                 usbin_stop(s);
1687                 s->usbin.dma.ready = 0;
1688                 if (fmt == AFMT_QUERY)
1689                         fmt = s->usbin.dma.format;
1690                 else
1691                         s->usbin.dma.format = fmt;
1692                 if (!srate)
1693                         srate = s->usbin.dma.srate;
1694                 else
1695                         s->usbin.dma.srate = srate;
1696         }
1697         if (fmode & FMODE_WRITE) {
1698                 usbout_stop(s);
1699                 s->usbout.dma.ready = 0;
1700                 if (fmt == AFMT_QUERY)
1701                         fmt = s->usbout.dma.format;
1702                 else
1703                         s->usbout.dma.format = fmt;
1704                 if (!srate)
1705                         srate = s->usbout.dma.srate;
1706                 else
1707                         s->usbout.dma.srate = srate;
1708         }
1709         if (fmode & FMODE_READ)
1710                 ret1 = set_format_in(s);
1711         if (fmode & FMODE_WRITE)
1712                 ret2 = set_format_out(s);
1713         return ret1 ? ret1 : ret2;
1714 }
1715
1716 /* --------------------------------------------------------------------- */
1717
1718 static int wrmixer(struct usb_mixerdev *ms, unsigned mixch, unsigned value)
1719 {
1720         struct usb_device *dev = ms->state->usbdev;
1721         unsigned char data[2];
1722         struct mixerchannel *ch;
1723         int v1, v2, v3;
1724
1725         if (mixch >= ms->numch)
1726                 return -1;
1727         ch = &ms->ch[mixch];
1728         v3 = ch->maxval - ch->minval;
1729         v1 = value & 0xff;
1730         v2 = (value >> 8) & 0xff;
1731         if (v1 > 100)
1732                 v1 = 100;
1733         if (v2 > 100)
1734                 v2 = 100;
1735         if (!(ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)))
1736                 v2 = v1;
1737         ch->value = v1 | (v2 << 8);
1738         v1 = (v1 * v3) / 100 + ch->minval;
1739         v2 = (v2 * v3) / 100 + ch->minval;
1740         switch (ch->selector) {
1741         case 0:  /* mixer unit request */
1742                 data[0] = v1;
1743                 data[1] = v1 >> 8;
1744                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1745                                     (ch->chnum << 8) | 1, ms->iface | (ch->unitid << 8), data, 2, 1000) < 0)
1746                         goto err;
1747                 if (!(ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)))
1748                         return 0;
1749                 data[0] = v2;
1750                 data[1] = v2 >> 8;
1751                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1752                                     ((ch->chnum + !!(ch->flags & MIXFLG_STEREOIN)) << 8) | (1 + !!(ch->flags & MIXFLG_STEREOOUT)),
1753                                     ms->iface | (ch->unitid << 8), data, 2, 1000) < 0)
1754                         goto err;
1755                 return 0;
1756
1757                 /* various feature unit controls */
1758         case VOLUME_CONTROL:
1759                 data[0] = v1;
1760                 data[1] = v1 >> 8;
1761                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1762                                     (ch->selector << 8) | ch->chnum, ms->iface | (ch->unitid << 8), data, 2, 1000) < 0)
1763                         goto err;
1764                 if (!(ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)))
1765                         return 0;
1766                 data[0] = v2;
1767                 data[1] = v2 >> 8;
1768                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1769                                     (ch->selector << 8) | (ch->chnum + 1), ms->iface | (ch->unitid << 8), data, 2, 1000) < 0)
1770                         goto err;
1771                 return 0;
1772
1773         case BASS_CONTROL:
1774         case MID_CONTROL:
1775         case TREBLE_CONTROL:
1776                 data[0] = v1 >> 8;
1777                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1778                                     (ch->selector << 8) | ch->chnum, ms->iface | (ch->unitid << 8), data, 1, 1000) < 0)
1779                         goto err;
1780                 if (!(ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)))
1781                         return 0;
1782                 data[0] = v2 >> 8;
1783                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1784                                     (ch->selector << 8) | (ch->chnum + 1), ms->iface | (ch->unitid << 8), data, 1, 1000) < 0)
1785                         goto err;
1786                 return 0;
1787
1788         default:
1789                 return -1;
1790         }
1791         return 0;
1792
1793  err:
1794         printk(KERN_ERR "usbaudio: mixer request device %u if %u unit %u ch %u selector %u failed\n",
1795                 dev->devnum, ms->iface, ch->unitid, ch->chnum, ch->selector);
1796         return -1;
1797 }
1798
1799 static int get_rec_src(struct usb_mixerdev *ms)
1800 {
1801         struct usb_device *dev = ms->state->usbdev;
1802         unsigned int mask = 0, retmask = 0;
1803         unsigned int i, j;
1804         unsigned char buf;
1805         int err = 0;
1806
1807         for (i = 0; i < ms->numch; i++) {
1808                 if (!ms->ch[i].slctunitid || (mask & (1 << i)))
1809                         continue;
1810                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
1811                                     0, ms->iface | (ms->ch[i].slctunitid << 8), &buf, 1, 1000) < 0) {
1812                         err = -EIO;
1813                         printk(KERN_ERR "usbaudio: selector read request device %u if %u unit %u failed\n",
1814                                dev->devnum, ms->iface, ms->ch[i].slctunitid & 0xff);
1815                         continue;
1816                 }
1817                 for (j = i; j < ms->numch; j++) {
1818                         if ((ms->ch[i].slctunitid ^ ms->ch[j].slctunitid) & 0xff)
1819                                 continue;
1820                         mask |= 1 << j;
1821                         if (buf == (ms->ch[j].slctunitid >> 8))
1822                                 retmask |= 1 << ms->ch[j].osschannel;
1823                 }
1824         }
1825         if (err)
1826                 return -EIO;
1827         return retmask;
1828 }
1829
1830 static int set_rec_src(struct usb_mixerdev *ms, int srcmask)
1831 {
1832         struct usb_device *dev = ms->state->usbdev;
1833         unsigned int mask = 0, smask, bmask;
1834         unsigned int i, j;
1835         unsigned char buf;
1836         int err = 0;
1837
1838         for (i = 0; i < ms->numch; i++) {
1839                 if (!ms->ch[i].slctunitid || (mask & (1 << i)))
1840                         continue;
1841                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
1842                                     0, ms->iface | (ms->ch[i].slctunitid << 8), &buf, 1, 1000) < 0) {
1843                         err = -EIO;
1844                         printk(KERN_ERR "usbaudio: selector read request device %u if %u unit %u failed\n",
1845                                dev->devnum, ms->iface, ms->ch[i].slctunitid & 0xff);
1846                         continue;
1847                 }
1848                 /* first generate smask */
1849                 smask = bmask = 0;
1850                 for (j = i; j < ms->numch; j++) {
1851                         if ((ms->ch[i].slctunitid ^ ms->ch[j].slctunitid) & 0xff)
1852                                 continue;
1853                         smask |= 1 << ms->ch[j].osschannel;
1854                         if (buf == (ms->ch[j].slctunitid >> 8))
1855                                 bmask |= 1 << ms->ch[j].osschannel;
1856                         mask |= 1 << j;
1857                 }
1858                 /* check for multiple set sources */
1859                 j = hweight32(srcmask & smask);
1860                 if (j == 0)
1861                         continue;
1862                 if (j > 1)
1863                         srcmask &= ~bmask;
1864                 for (j = i; j < ms->numch; j++) {
1865                         if ((ms->ch[i].slctunitid ^ ms->ch[j].slctunitid) & 0xff)
1866                                 continue;
1867                         if (!(srcmask & (1 << ms->ch[j].osschannel)))
1868                                 continue;
1869                         buf = ms->ch[j].slctunitid >> 8;
1870                         if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
1871                                     0, ms->iface | (ms->ch[j].slctunitid << 8), &buf, 1, 1000) < 0) {
1872                                 err = -EIO;
1873                                 printk(KERN_ERR "usbaudio: selector write request device %u if %u unit %u failed\n",
1874                                        dev->devnum, ms->iface, ms->ch[j].slctunitid & 0xff);
1875                                 continue;
1876                         }
1877                 }
1878         }
1879         return err ? -EIO : 0;
1880 }
1881
1882 /* --------------------------------------------------------------------- */
1883
1884 /*
1885  * should be called with open_sem hold, so that no new processes
1886  * look at the audio device to be destroyed
1887  */
1888
1889 static void release(struct usb_audio_state *s)
1890 {
1891         struct usb_audiodev *as;
1892         struct usb_mixerdev *ms;
1893
1894         s->count--;
1895         if (s->count) {
1896                 up(&open_sem);
1897                 return;
1898         }
1899         up(&open_sem);
1900         wake_up(&open_wait);
1901         while (!list_empty(&s->audiolist)) {
1902                 as = list_entry(s->audiolist.next, struct usb_audiodev, list);
1903                 list_del(&as->list);
1904                 usbin_release(as);
1905                 usbout_release(as);
1906                 dmabuf_release(&as->usbin.dma);
1907                 dmabuf_release(&as->usbout.dma);
1908                 usb_free_urb(as->usbin.durb[0].urb);
1909                 usb_free_urb(as->usbin.durb[1].urb);
1910                 usb_free_urb(as->usbin.surb[0].urb);
1911                 usb_free_urb(as->usbin.surb[1].urb);
1912                 usb_free_urb(as->usbout.durb[0].urb);
1913                 usb_free_urb(as->usbout.durb[1].urb);
1914                 usb_free_urb(as->usbout.surb[0].urb);
1915                 usb_free_urb(as->usbout.surb[1].urb);
1916                 kfree(as);
1917         }
1918         while (!list_empty(&s->mixerlist)) {
1919                 ms = list_entry(s->mixerlist.next, struct usb_mixerdev, list);
1920                 list_del(&ms->list);
1921                 kfree(ms);
1922         }
1923         kfree(s);
1924 }
1925
1926 static inline int prog_dmabuf_in(struct usb_audiodev *as)
1927 {
1928         usbin_stop(as);
1929         return dmabuf_init(&as->usbin.dma);
1930 }
1931
1932 static inline int prog_dmabuf_out(struct usb_audiodev *as)
1933 {
1934         usbout_stop(as);
1935         return dmabuf_init(&as->usbout.dma);
1936 }
1937
1938 /* --------------------------------------------------------------------- */
1939
1940 static int usb_audio_open_mixdev(struct inode *inode, struct file *file)
1941 {
1942         unsigned int minor = iminor(inode);
1943         struct usb_mixerdev *ms;
1944         struct usb_audio_state *s;
1945
1946         down(&open_sem);
1947         list_for_each_entry(s, &audiodevs, audiodev) {
1948                 list_for_each_entry(ms, &s->mixerlist, list) {
1949                         if (ms->dev_mixer == minor)
1950                                 goto mixer_found;
1951                 }
1952         }
1953         up(&open_sem);
1954         return -ENODEV;
1955
1956  mixer_found:
1957         if (!s->usbdev) {
1958                 up(&open_sem);
1959                 return -EIO;
1960         }
1961         file->private_data = ms;
1962         s->count++;
1963
1964         up(&open_sem);
1965         return nonseekable_open(inode, file);
1966 }
1967
1968 static int usb_audio_release_mixdev(struct inode *inode, struct file *file)
1969 {
1970         struct usb_mixerdev *ms = (struct usb_mixerdev *)file->private_data;
1971         struct usb_audio_state *s;
1972
1973         lock_kernel();
1974         s = ms->state;
1975         down(&open_sem);
1976         release(s);
1977         unlock_kernel();
1978         return 0;
1979 }
1980
1981 static int usb_audio_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
1982 {
1983         struct usb_mixerdev *ms = (struct usb_mixerdev *)file->private_data;
1984         int i, j, val;
1985         int __user *user_arg = (int __user *)arg;
1986
1987         if (!ms->state->usbdev)
1988                 return -ENODEV;
1989
1990         if (cmd == SOUND_MIXER_INFO) {
1991                 mixer_info info;
1992
1993                 memset(&info, 0, sizeof(info));
1994                 strncpy(info.id, "USB_AUDIO", sizeof(info.id));
1995                 strncpy(info.name, "USB Audio Class Driver", sizeof(info.name));
1996                 info.modify_counter = ms->modcnt;
1997                 if (copy_to_user((void __user *)arg, &info, sizeof(info)))
1998                         return -EFAULT;
1999                 return 0;
2000         }
2001         if (cmd == SOUND_OLD_MIXER_INFO) {
2002                 _old_mixer_info info;
2003
2004                 memset(&info, 0, sizeof(info));
2005                 strncpy(info.id, "USB_AUDIO", sizeof(info.id));
2006                 strncpy(info.name, "USB Audio Class Driver", sizeof(info.name));
2007                 if (copy_to_user((void __user *)arg, &info, sizeof(info)))
2008                         return -EFAULT;
2009                 return 0;
2010         }
2011         if (cmd == OSS_GETVERSION)
2012                 return put_user(SOUND_VERSION, user_arg);
2013         if (_IOC_TYPE(cmd) != 'M' || _IOC_SIZE(cmd) != sizeof(int))
2014                 return -EINVAL;
2015         if (_IOC_DIR(cmd) == _IOC_READ) {
2016                 switch (_IOC_NR(cmd)) {
2017                 case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */
2018                         val = get_rec_src(ms);
2019                         if (val < 0)
2020                                 return val;
2021                         return put_user(val, user_arg);
2022
2023                 case SOUND_MIXER_DEVMASK: /* Arg contains a bit for each supported device */
2024                         for (val = i = 0; i < ms->numch; i++)
2025                                 val |= 1 << ms->ch[i].osschannel;
2026                         return put_user(val, user_arg);
2027
2028                 case SOUND_MIXER_RECMASK: /* Arg contains a bit for each supported recording source */
2029                         for (val = i = 0; i < ms->numch; i++)
2030                                 if (ms->ch[i].slctunitid)
2031                                         val |= 1 << ms->ch[i].osschannel;
2032                         return put_user(val, user_arg);
2033
2034                 case SOUND_MIXER_STEREODEVS: /* Mixer channels supporting stereo */
2035                         for (val = i = 0; i < ms->numch; i++)
2036                                 if (ms->ch[i].flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT))
2037                                         val |= 1 << ms->ch[i].osschannel;
2038                         return put_user(val, user_arg);
2039
2040                 case SOUND_MIXER_CAPS:
2041                         return put_user(SOUND_CAP_EXCL_INPUT, user_arg);
2042
2043                 default:
2044                         i = _IOC_NR(cmd);
2045                         if (i >= SOUND_MIXER_NRDEVICES)
2046                                 return -EINVAL;
2047                         for (j = 0; j < ms->numch; j++) {
2048                                 if (ms->ch[j].osschannel == i) {
2049                                         return put_user(ms->ch[j].value, user_arg);
2050                                 }
2051                         }
2052                         return -EINVAL;
2053                 }
2054         }
2055         if (_IOC_DIR(cmd) != (_IOC_READ|_IOC_WRITE))
2056                 return -EINVAL;
2057         ms->modcnt++;
2058         switch (_IOC_NR(cmd)) {
2059         case SOUND_MIXER_RECSRC: /* Arg contains a bit for each recording source */
2060                 if (get_user(val, user_arg))
2061                         return -EFAULT;
2062                 return set_rec_src(ms, val);
2063
2064         default:
2065                 i = _IOC_NR(cmd);
2066                 if (i >= SOUND_MIXER_NRDEVICES)
2067                         return -EINVAL;
2068                 for (j = 0; j < ms->numch && ms->ch[j].osschannel != i; j++);
2069                 if (j >= ms->numch)
2070                         return -EINVAL;
2071                 if (get_user(val, user_arg))
2072                         return -EFAULT;
2073                 if (wrmixer(ms, j, val))
2074                         return -EIO;
2075                 return put_user(ms->ch[j].value, user_arg);
2076         }
2077 }
2078
2079 static /*const*/ struct file_operations usb_mixer_fops = {
2080         .owner =        THIS_MODULE,
2081         .llseek =       no_llseek,
2082         .ioctl =        usb_audio_ioctl_mixdev,
2083         .open =         usb_audio_open_mixdev,
2084         .release =      usb_audio_release_mixdev,
2085 };
2086
2087 /* --------------------------------------------------------------------- */
2088
2089 static int drain_out(struct usb_audiodev *as, int nonblock)
2090 {
2091         DECLARE_WAITQUEUE(wait, current);
2092         unsigned long flags;
2093         int count, tmo;
2094
2095         if (as->usbout.dma.mapped || !as->usbout.dma.ready)
2096                 return 0;
2097         usbout_start(as);
2098         add_wait_queue(&as->usbout.dma.wait, &wait);
2099         for (;;) {
2100                 __set_current_state(TASK_INTERRUPTIBLE);
2101                 spin_lock_irqsave(&as->lock, flags);
2102                 count = as->usbout.dma.count;
2103                 spin_unlock_irqrestore(&as->lock, flags);
2104                 if (count <= 0)
2105                         break;
2106                 if (signal_pending(current))
2107                         break;
2108                 if (nonblock) {
2109                         remove_wait_queue(&as->usbout.dma.wait, &wait);
2110                         set_current_state(TASK_RUNNING);
2111                         return -EBUSY;
2112                 }
2113                 tmo = 3 * HZ * count / as->usbout.dma.srate;
2114                 tmo >>= AFMT_BYTESSHIFT(as->usbout.dma.format);
2115                 if (!schedule_timeout(tmo + 1)) {
2116                         printk(KERN_DEBUG "usbaudio: dma timed out??\n");
2117                         break;
2118                 }
2119         }
2120         remove_wait_queue(&as->usbout.dma.wait, &wait);
2121         set_current_state(TASK_RUNNING);
2122         if (signal_pending(current))
2123                 return -ERESTARTSYS;
2124         return 0;
2125 }
2126
2127 /* --------------------------------------------------------------------- */
2128
2129 static ssize_t usb_audio_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
2130 {
2131         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2132         DECLARE_WAITQUEUE(wait, current);
2133         ssize_t ret = 0;
2134         unsigned long flags;
2135         unsigned int ptr;
2136         int cnt, err;
2137
2138         if (as->usbin.dma.mapped)
2139                 return -ENXIO;
2140         if (!as->usbin.dma.ready && (ret = prog_dmabuf_in(as)))
2141                 return ret;
2142         if (!access_ok(VERIFY_WRITE, buffer, count))
2143                 return -EFAULT;
2144         add_wait_queue(&as->usbin.dma.wait, &wait);
2145         while (count > 0) {
2146                 spin_lock_irqsave(&as->lock, flags);
2147                 ptr = as->usbin.dma.rdptr;
2148                 cnt = as->usbin.dma.count;
2149                 /* set task state early to avoid wakeup races */
2150                 if (cnt <= 0)
2151                         __set_current_state(TASK_INTERRUPTIBLE);
2152                 spin_unlock_irqrestore(&as->lock, flags);
2153                 if (cnt > count)
2154                         cnt = count;
2155                 if (cnt <= 0) {
2156                         if (usbin_start(as)) {
2157                                 if (!ret)
2158                                         ret = -ENODEV;
2159                                 break;
2160                         }
2161                         if (file->f_flags & O_NONBLOCK) {
2162                                 if (!ret)
2163                                         ret = -EAGAIN;
2164                                 break;
2165                         }
2166                         schedule();
2167                         if (signal_pending(current)) {
2168                                 if (!ret)
2169                                         ret = -ERESTARTSYS;
2170                                 break;
2171                         }
2172                         continue;
2173                 }
2174                 if ((err = dmabuf_copyout_user(&as->usbin.dma, ptr, buffer, cnt))) {
2175                         if (!ret)
2176                                 ret = err;
2177                         break;
2178                 }
2179                 ptr += cnt;
2180                 if (ptr >= as->usbin.dma.dmasize)
2181                         ptr -= as->usbin.dma.dmasize;
2182                 spin_lock_irqsave(&as->lock, flags);
2183                 as->usbin.dma.rdptr = ptr;
2184                 as->usbin.dma.count -= cnt;
2185                 spin_unlock_irqrestore(&as->lock, flags);
2186                 count -= cnt;
2187                 buffer += cnt;
2188                 ret += cnt;
2189         }
2190         __set_current_state(TASK_RUNNING);
2191         remove_wait_queue(&as->usbin.dma.wait, &wait);
2192         return ret;
2193 }
2194
2195 static ssize_t usb_audio_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
2196 {
2197         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2198         DECLARE_WAITQUEUE(wait, current);
2199         ssize_t ret = 0;
2200         unsigned long flags;
2201         unsigned int ptr;
2202         unsigned int start_thr;
2203         int cnt, err;
2204
2205         if (as->usbout.dma.mapped)
2206                 return -ENXIO;
2207         if (!as->usbout.dma.ready && (ret = prog_dmabuf_out(as)))
2208                 return ret;
2209         if (!access_ok(VERIFY_READ, buffer, count))
2210                 return -EFAULT;
2211         start_thr = (as->usbout.dma.srate << AFMT_BYTESSHIFT(as->usbout.dma.format)) / (1000 / (3 * DESCFRAMES));
2212         add_wait_queue(&as->usbout.dma.wait, &wait);
2213         while (count > 0) {
2214 #if 0
2215                 printk(KERN_DEBUG "usb_audio_write: count %u dma: count %u rdptr %u wrptr %u dmasize %u fragsize %u flags 0x%02x taskst 0x%lx\n",
2216                        count, as->usbout.dma.count, as->usbout.dma.rdptr, as->usbout.dma.wrptr, as->usbout.dma.dmasize, as->usbout.dma.fragsize,
2217                        as->usbout.flags, current->state);
2218 #endif
2219                 spin_lock_irqsave(&as->lock, flags);
2220                 if (as->usbout.dma.count < 0) {
2221                         as->usbout.dma.count = 0;
2222                         as->usbout.dma.rdptr = as->usbout.dma.wrptr;
2223                 }
2224                 ptr = as->usbout.dma.wrptr;
2225                 cnt = as->usbout.dma.dmasize - as->usbout.dma.count;
2226                 /* set task state early to avoid wakeup races */
2227                 if (cnt <= 0)
2228                         __set_current_state(TASK_INTERRUPTIBLE);
2229                 spin_unlock_irqrestore(&as->lock, flags);
2230                 if (cnt > count)
2231                         cnt = count;
2232                 if (cnt <= 0) {
2233                         if (usbout_start(as)) {
2234                                 if (!ret)
2235                                         ret = -ENODEV;
2236                                 break;
2237                         }
2238                         if (file->f_flags & O_NONBLOCK) {
2239                                 if (!ret)
2240                                         ret = -EAGAIN;
2241                                 break;
2242                         }
2243                         schedule();
2244                         if (signal_pending(current)) {
2245                                 if (!ret)
2246                                         ret = -ERESTARTSYS;
2247                                 break;
2248                         }
2249                         continue;
2250                 }
2251                 if ((err = dmabuf_copyin_user(&as->usbout.dma, ptr, buffer, cnt))) {
2252                         if (!ret)
2253                                 ret = err;
2254                         break;
2255                 }
2256                 ptr += cnt;
2257                 if (ptr >= as->usbout.dma.dmasize)
2258                         ptr -= as->usbout.dma.dmasize;
2259                 spin_lock_irqsave(&as->lock, flags);
2260                 as->usbout.dma.wrptr = ptr;
2261                 as->usbout.dma.count += cnt;
2262                 spin_unlock_irqrestore(&as->lock, flags);
2263                 count -= cnt;
2264                 buffer += cnt;
2265                 ret += cnt;
2266                 if (as->usbout.dma.count >= start_thr && usbout_start(as)) {
2267                         if (!ret)
2268                                 ret = -ENODEV;
2269                         break;
2270                 }
2271         }
2272         __set_current_state(TASK_RUNNING);
2273         remove_wait_queue(&as->usbout.dma.wait, &wait);
2274         return ret;
2275 }
2276
2277 /* Called without the kernel lock - fine */
2278 static unsigned int usb_audio_poll(struct file *file, struct poll_table_struct *wait)
2279 {
2280         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2281         unsigned long flags;
2282         unsigned int mask = 0;
2283
2284         if (file->f_mode & FMODE_WRITE) {
2285                 if (!as->usbout.dma.ready)
2286                         prog_dmabuf_out(as);
2287                 poll_wait(file, &as->usbout.dma.wait, wait);
2288         }
2289         if (file->f_mode & FMODE_READ) {
2290                 if (!as->usbin.dma.ready)
2291                         prog_dmabuf_in(as);
2292                 poll_wait(file, &as->usbin.dma.wait, wait);
2293         }
2294         spin_lock_irqsave(&as->lock, flags);
2295         if (file->f_mode & FMODE_READ) {
2296                 if (as->usbin.dma.count >= (signed)as->usbin.dma.fragsize)
2297                         mask |= POLLIN | POLLRDNORM;
2298         }
2299         if (file->f_mode & FMODE_WRITE) {
2300                 if (as->usbout.dma.mapped) {
2301                         if (as->usbout.dma.count >= (signed)as->usbout.dma.fragsize)
2302                                 mask |= POLLOUT | POLLWRNORM;
2303                 } else {
2304                         if ((signed)as->usbout.dma.dmasize >= as->usbout.dma.count + (signed)as->usbout.dma.fragsize)
2305                                 mask |= POLLOUT | POLLWRNORM;
2306                 }
2307         }
2308         spin_unlock_irqrestore(&as->lock, flags);
2309         return mask;
2310 }
2311
2312 static int usb_audio_mmap(struct file *file, struct vm_area_struct *vma)
2313 {
2314         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2315         struct dmabuf *db;
2316         int ret = -EINVAL;
2317
2318         lock_kernel();
2319         if (vma->vm_flags & VM_WRITE) {
2320                 if ((ret = prog_dmabuf_out(as)) != 0)
2321                         goto out;
2322                 db = &as->usbout.dma;
2323         } else if (vma->vm_flags & VM_READ) {
2324                 if ((ret = prog_dmabuf_in(as)) != 0)
2325                         goto out;
2326                 db = &as->usbin.dma;
2327         } else
2328                 goto out;
2329
2330         ret = -EINVAL;
2331         if (vma->vm_pgoff != 0)
2332                 goto out;
2333
2334         ret = dmabuf_mmap(vma, db,  vma->vm_start, vma->vm_end - vma->vm_start, vma->vm_page_prot);
2335 out:
2336         unlock_kernel();
2337         return ret;
2338 }
2339
2340 static int usb_audio_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
2341 {
2342         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2343         struct usb_audio_state *s = as->state;
2344         int __user *user_arg = (int __user *)arg;
2345         unsigned long flags;
2346         audio_buf_info abinfo;
2347         count_info cinfo;
2348         int val = 0;
2349         int val2, mapped, ret;
2350
2351         if (!s->usbdev)
2352                 return -EIO;
2353         mapped = ((file->f_mode & FMODE_WRITE) && as->usbout.dma.mapped) ||
2354                 ((file->f_mode & FMODE_READ) && as->usbin.dma.mapped);
2355 #if 0
2356         if (arg)
2357                 get_user(val, (int *)arg);
2358         printk(KERN_DEBUG "usbaudio: usb_audio_ioctl cmd=%x arg=%lx *arg=%d\n", cmd, arg, val)
2359 #endif
2360         switch (cmd) {
2361         case OSS_GETVERSION:
2362                 return put_user(SOUND_VERSION, user_arg);
2363
2364         case SNDCTL_DSP_SYNC:
2365                 if (file->f_mode & FMODE_WRITE)
2366                         return drain_out(as, 0/*file->f_flags & O_NONBLOCK*/);
2367                 return 0;
2368
2369         case SNDCTL_DSP_SETDUPLEX:
2370                 return 0;
2371
2372         case SNDCTL_DSP_GETCAPS:
2373                 return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER |
2374                                 DSP_CAP_MMAP | DSP_CAP_BATCH, user_arg);
2375
2376         case SNDCTL_DSP_RESET:
2377                 if (file->f_mode & FMODE_WRITE) {
2378                         usbout_stop(as);
2379                         as->usbout.dma.rdptr = as->usbout.dma.wrptr = as->usbout.dma.count = as->usbout.dma.total_bytes = 0;
2380                 }
2381                 if (file->f_mode & FMODE_READ) {
2382                         usbin_stop(as);
2383                         as->usbin.dma.rdptr = as->usbin.dma.wrptr = as->usbin.dma.count = as->usbin.dma.total_bytes = 0;
2384                 }
2385                 return 0;
2386
2387         case SNDCTL_DSP_SPEED:
2388                 if (get_user(val, user_arg))
2389                         return -EFAULT;
2390                 if (val >= 0) {
2391                         if (val < 4000)
2392                                 val = 4000;
2393                         if (val > 100000)
2394                                 val = 100000;
2395                         if (set_format(as, file->f_mode, AFMT_QUERY, val))
2396                                 return -EIO;
2397                 }
2398                 return put_user((file->f_mode & FMODE_READ) ?
2399                                 as->usbin.dma.srate : as->usbout.dma.srate,
2400                                 user_arg);
2401
2402         case SNDCTL_DSP_STEREO:
2403                 if (get_user(val, user_arg))
2404                         return -EFAULT;
2405                 val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2406                 if (val)
2407                         val2 |= AFMT_STEREO;
2408                 else
2409                         val2 &= ~AFMT_STEREO;
2410                 if (set_format(as, file->f_mode, val2, 0))
2411                         return -EIO;
2412                 return 0;
2413
2414         case SNDCTL_DSP_CHANNELS:
2415                 if (get_user(val, user_arg))
2416                         return -EFAULT;
2417                 if (val != 0) {
2418                         val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2419                         if (val == 1)
2420                                 val2 &= ~AFMT_STEREO;
2421                         else
2422                                 val2 |= AFMT_STEREO;
2423                         if (set_format(as, file->f_mode, val2, 0))
2424                                 return -EIO;
2425                 }
2426                 val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2427                 return put_user(AFMT_ISSTEREO(val2) ? 2 : 1, user_arg);
2428
2429         case SNDCTL_DSP_GETFMTS: /* Returns a mask */
2430                 return put_user(AFMT_U8 | AFMT_U16_LE | AFMT_U16_BE |
2431                                 AFMT_S8 | AFMT_S16_LE | AFMT_S16_BE, user_arg);
2432
2433         case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
2434                 if (get_user(val, user_arg))
2435                         return -EFAULT;
2436                 if (val != AFMT_QUERY) {
2437                         if (hweight32(val) != 1)
2438                                 return -EINVAL;
2439                         if (!(val & (AFMT_U8 | AFMT_U16_LE | AFMT_U16_BE |
2440                                      AFMT_S8 | AFMT_S16_LE | AFMT_S16_BE)))
2441                                 return -EINVAL;
2442                         val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2443                         val |= val2 & AFMT_STEREO;
2444                         if (set_format(as, file->f_mode, val, 0))
2445                                 return -EIO;
2446                 }
2447                 val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2448                 return put_user(val2 & ~AFMT_STEREO, user_arg);
2449
2450         case SNDCTL_DSP_POST:
2451                 return 0;
2452
2453         case SNDCTL_DSP_GETTRIGGER:
2454                 val = 0;
2455                 if (file->f_mode & FMODE_READ && as->usbin.flags & FLG_RUNNING)
2456                         val |= PCM_ENABLE_INPUT;
2457                 if (file->f_mode & FMODE_WRITE && as->usbout.flags & FLG_RUNNING)
2458                         val |= PCM_ENABLE_OUTPUT;
2459                 return put_user(val, user_arg);
2460
2461         case SNDCTL_DSP_SETTRIGGER:
2462                 if (get_user(val, user_arg))
2463                         return -EFAULT;
2464                 if (file->f_mode & FMODE_READ) {
2465                         if (val & PCM_ENABLE_INPUT) {
2466                                 if (!as->usbin.dma.ready && (ret = prog_dmabuf_in(as)))
2467                                         return ret;
2468                                 if (usbin_start(as))
2469                                         return -ENODEV;
2470                         } else
2471                                 usbin_stop(as);
2472                 }
2473                 if (file->f_mode & FMODE_WRITE) {
2474                         if (val & PCM_ENABLE_OUTPUT) {
2475                                 if (!as->usbout.dma.ready && (ret = prog_dmabuf_out(as)))
2476                                         return ret;
2477                                 if (usbout_start(as))
2478                                         return -ENODEV;
2479                         } else
2480                                 usbout_stop(as);
2481                 }
2482                 return 0;
2483
2484         case SNDCTL_DSP_GETOSPACE:
2485                 if (!(file->f_mode & FMODE_WRITE))
2486                         return -EINVAL;
2487                 if (!(as->usbout.flags & FLG_RUNNING) && (val = prog_dmabuf_out(as)) != 0)
2488                         return val;
2489                 spin_lock_irqsave(&as->lock, flags);
2490                 abinfo.fragsize = as->usbout.dma.fragsize;
2491                 abinfo.bytes = as->usbout.dma.dmasize - as->usbout.dma.count;
2492                 abinfo.fragstotal = as->usbout.dma.numfrag;
2493                 abinfo.fragments = abinfo.bytes >> as->usbout.dma.fragshift;
2494                 spin_unlock_irqrestore(&as->lock, flags);
2495                 return copy_to_user((void __user *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
2496
2497         case SNDCTL_DSP_GETISPACE:
2498                 if (!(file->f_mode & FMODE_READ))
2499                         return -EINVAL;
2500                 if (!(as->usbin.flags & FLG_RUNNING) && (val = prog_dmabuf_in(as)) != 0)
2501                         return val;
2502                 spin_lock_irqsave(&as->lock, flags);
2503                 abinfo.fragsize = as->usbin.dma.fragsize;
2504                 abinfo.bytes = as->usbin.dma.count;
2505                 abinfo.fragstotal = as->usbin.dma.numfrag;
2506                 abinfo.fragments = abinfo.bytes >> as->usbin.dma.fragshift;
2507                 spin_unlock_irqrestore(&as->lock, flags);
2508                 return copy_to_user((void __user *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
2509
2510         case SNDCTL_DSP_NONBLOCK:
2511                 file->f_flags |= O_NONBLOCK;
2512                 return 0;
2513
2514         case SNDCTL_DSP_GETODELAY:
2515                 if (!(file->f_mode & FMODE_WRITE))
2516                         return -EINVAL;
2517                 spin_lock_irqsave(&as->lock, flags);
2518                 val = as->usbout.dma.count;
2519                 spin_unlock_irqrestore(&as->lock, flags);
2520                 return put_user(val, user_arg);
2521
2522         case SNDCTL_DSP_GETIPTR:
2523                 if (!(file->f_mode & FMODE_READ))
2524                         return -EINVAL;
2525                 spin_lock_irqsave(&as->lock, flags);
2526                 cinfo.bytes = as->usbin.dma.total_bytes;
2527                 cinfo.blocks = as->usbin.dma.count >> as->usbin.dma.fragshift;
2528                 cinfo.ptr = as->usbin.dma.wrptr;
2529                 if (as->usbin.dma.mapped)
2530                         as->usbin.dma.count &= as->usbin.dma.fragsize-1;
2531                 spin_unlock_irqrestore(&as->lock, flags);
2532                 if (copy_to_user((void __user *)arg, &cinfo, sizeof(cinfo)))
2533                         return -EFAULT;
2534                 return 0;
2535
2536         case SNDCTL_DSP_GETOPTR:
2537                 if (!(file->f_mode & FMODE_WRITE))
2538                         return -EINVAL;
2539                 spin_lock_irqsave(&as->lock, flags);
2540                 cinfo.bytes = as->usbout.dma.total_bytes;
2541                 cinfo.blocks = as->usbout.dma.count >> as->usbout.dma.fragshift;
2542                 cinfo.ptr = as->usbout.dma.rdptr;
2543                 if (as->usbout.dma.mapped)
2544                         as->usbout.dma.count &= as->usbout.dma.fragsize-1;
2545                 spin_unlock_irqrestore(&as->lock, flags);
2546                 if (copy_to_user((void __user *)arg, &cinfo, sizeof(cinfo)))
2547                         return -EFAULT;
2548                 return 0;
2549
2550        case SNDCTL_DSP_GETBLKSIZE:
2551                 if (file->f_mode & FMODE_WRITE) {
2552                         if ((val = prog_dmabuf_out(as)))
2553                                 return val;
2554                         return put_user(as->usbout.dma.fragsize, user_arg);
2555                 }
2556                 if ((val = prog_dmabuf_in(as)))
2557                         return val;
2558                 return put_user(as->usbin.dma.fragsize, user_arg);
2559
2560         case SNDCTL_DSP_SETFRAGMENT:
2561                 if (get_user(val, user_arg))
2562                         return -EFAULT;
2563                 if (file->f_mode & FMODE_READ) {
2564                         as->usbin.dma.ossfragshift = val & 0xffff;
2565                         as->usbin.dma.ossmaxfrags = (val >> 16) & 0xffff;
2566                         if (as->usbin.dma.ossfragshift < 4)
2567                                 as->usbin.dma.ossfragshift = 4;
2568                         if (as->usbin.dma.ossfragshift > 15)
2569                                 as->usbin.dma.ossfragshift = 15;
2570                         if (as->usbin.dma.ossmaxfrags < 4)
2571                                 as->usbin.dma.ossmaxfrags = 4;
2572                 }
2573                 if (file->f_mode & FMODE_WRITE) {
2574                         as->usbout.dma.ossfragshift = val & 0xffff;
2575                         as->usbout.dma.ossmaxfrags = (val >> 16) & 0xffff;
2576                         if (as->usbout.dma.ossfragshift < 4)
2577                                 as->usbout.dma.ossfragshift = 4;
2578                         if (as->usbout.dma.ossfragshift > 15)
2579                                 as->usbout.dma.ossfragshift = 15;
2580                         if (as->usbout.dma.ossmaxfrags < 4)
2581                                 as->usbout.dma.ossmaxfrags = 4;
2582                 }
2583                 return 0;
2584
2585         case SNDCTL_DSP_SUBDIVIDE:
2586                 if ((file->f_mode & FMODE_READ && as->usbin.dma.subdivision) ||
2587                     (file->f_mode & FMODE_WRITE && as->usbout.dma.subdivision))
2588                         return -EINVAL;
2589                 if (get_user(val, user_arg))
2590                         return -EFAULT;
2591                 if (val != 1 && val != 2 && val != 4)
2592                         return -EINVAL;
2593                 if (file->f_mode & FMODE_READ)
2594                         as->usbin.dma.subdivision = val;
2595                 if (file->f_mode & FMODE_WRITE)
2596                         as->usbout.dma.subdivision = val;
2597                 return 0;
2598
2599         case SOUND_PCM_READ_RATE:
2600                 return put_user((file->f_mode & FMODE_READ) ?
2601                                 as->usbin.dma.srate : as->usbout.dma.srate,
2602                                 user_arg);
2603
2604         case SOUND_PCM_READ_CHANNELS:
2605                 val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2606                 return put_user(AFMT_ISSTEREO(val2) ? 2 : 1, user_arg);
2607
2608         case SOUND_PCM_READ_BITS:
2609                 val2 = (file->f_mode & FMODE_READ) ? as->usbin.dma.format : as->usbout.dma.format;
2610                 return put_user(AFMT_IS16BIT(val2) ? 16 : 8, user_arg);
2611
2612         case SOUND_PCM_WRITE_FILTER:
2613         case SNDCTL_DSP_SETSYNCRO:
2614         case SOUND_PCM_READ_FILTER:
2615                 return -EINVAL;
2616         }
2617         dprintk((KERN_DEBUG "usbaudio: usb_audio_ioctl - no command found\n"));
2618         return -ENOIOCTLCMD;
2619 }
2620
2621 static int usb_audio_open(struct inode *inode, struct file *file)
2622 {
2623         unsigned int minor = iminor(inode);
2624         DECLARE_WAITQUEUE(wait, current);
2625         struct usb_audiodev *as;
2626         struct usb_audio_state *s;
2627
2628         for (;;) {
2629                 down(&open_sem);
2630                 list_for_each_entry(s, &audiodevs, audiodev) {
2631                         list_for_each_entry(as, &s->audiolist, list) {
2632                                 if (!((as->dev_audio ^ minor) & ~0xf))
2633                                         goto device_found;
2634                         }
2635                 }
2636                 up(&open_sem);
2637                 return -ENODEV;
2638
2639         device_found:
2640                 if (!s->usbdev) {
2641                         up(&open_sem);
2642                         return -EIO;
2643                 }
2644                 /* wait for device to become free */
2645                 if (!(as->open_mode & file->f_mode))
2646                         break;
2647                 if (file->f_flags & O_NONBLOCK) {
2648                         up(&open_sem);
2649                         return -EBUSY;
2650                 }
2651                 __set_current_state(TASK_INTERRUPTIBLE);
2652                 add_wait_queue(&open_wait, &wait);
2653                 up(&open_sem);
2654                 schedule();
2655                 __set_current_state(TASK_RUNNING);
2656                 remove_wait_queue(&open_wait, &wait);
2657                 if (signal_pending(current))
2658                         return -ERESTARTSYS;
2659         }
2660         if (file->f_mode & FMODE_READ)
2661                 as->usbin.dma.ossfragshift = as->usbin.dma.ossmaxfrags = as->usbin.dma.subdivision = 0;
2662         if (file->f_mode & FMODE_WRITE)
2663                 as->usbout.dma.ossfragshift = as->usbout.dma.ossmaxfrags = as->usbout.dma.subdivision = 0;
2664         if (set_format(as, file->f_mode, ((minor & 0xf) == SND_DEV_DSP16) ? AFMT_S16_LE : AFMT_U8 /* AFMT_ULAW */, 8000)) {
2665                 up(&open_sem);
2666                 return -EIO;
2667         }
2668         file->private_data = as;
2669         as->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
2670         s->count++;
2671         up(&open_sem);
2672         return nonseekable_open(inode, file);
2673 }
2674
2675 static int usb_audio_release(struct inode *inode, struct file *file)
2676 {
2677         struct usb_audiodev *as = (struct usb_audiodev *)file->private_data;
2678         struct usb_audio_state *s;
2679         struct usb_device *dev;
2680
2681         lock_kernel();
2682         s = as->state;
2683         dev = s->usbdev;
2684         if (file->f_mode & FMODE_WRITE)
2685                 drain_out(as, file->f_flags & O_NONBLOCK);
2686         down(&open_sem);
2687         if (file->f_mode & FMODE_WRITE) {
2688                 usbout_stop(as);
2689                 if (dev && as->usbout.interface >= 0)
2690                         usb_set_interface(dev, as->usbout.interface, 0);
2691                 dmabuf_release(&as->usbout.dma);
2692                 usbout_release(as);
2693         }
2694         if (file->f_mode & FMODE_READ) {
2695                 usbin_stop(as);
2696                 if (dev && as->usbin.interface >= 0)
2697                         usb_set_interface(dev, as->usbin.interface, 0);
2698                 dmabuf_release(&as->usbin.dma);
2699                 usbin_release(as);
2700         }
2701         as->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
2702         release(s);
2703         wake_up(&open_wait);
2704         unlock_kernel();
2705         return 0;
2706 }
2707
2708 static /*const*/ struct file_operations usb_audio_fops = {
2709         .owner =        THIS_MODULE,
2710         .llseek =       no_llseek,
2711         .read =         usb_audio_read,
2712         .write =        usb_audio_write,
2713         .poll =         usb_audio_poll,
2714         .ioctl =        usb_audio_ioctl,
2715         .mmap =         usb_audio_mmap,
2716         .open =         usb_audio_open,
2717         .release =      usb_audio_release,
2718 };
2719
2720 /* --------------------------------------------------------------------- */
2721
2722 static int usb_audio_probe(struct usb_interface *iface,
2723                            const struct usb_device_id *id);
2724 static void usb_audio_disconnect(struct usb_interface *iface);
2725
2726 static struct usb_device_id usb_audio_ids [] = {
2727     { .match_flags = (USB_DEVICE_ID_MATCH_INT_CLASS | USB_DEVICE_ID_MATCH_INT_SUBCLASS),
2728       .bInterfaceClass = USB_CLASS_AUDIO, .bInterfaceSubClass = 1},
2729     { }                                         /* Terminating entry */
2730 };
2731
2732 MODULE_DEVICE_TABLE (usb, usb_audio_ids);
2733
2734 static struct usb_driver usb_audio_driver = {
2735         .owner =        THIS_MODULE,
2736         .name =         "audio",
2737         .probe =        usb_audio_probe,
2738         .disconnect =   usb_audio_disconnect,
2739         .id_table =     usb_audio_ids,
2740 };
2741
2742 static void *find_descriptor(void *descstart, unsigned int desclen, void *after,
2743                              u8 dtype, int iface, int altsetting)
2744 {
2745         u8 *p, *end, *next;
2746         int ifc = -1, as = -1;
2747
2748         p = descstart;
2749         end = p + desclen;
2750         for (; p < end;) {
2751                 if (p[0] < 2)
2752                         return NULL;
2753                 next = p + p[0];
2754                 if (next > end)
2755                         return NULL;
2756                 if (p[1] == USB_DT_INTERFACE) {
2757                         /* minimum length of interface descriptor */
2758                         if (p[0] < 9)
2759                                 return NULL;
2760                         ifc = p[2];
2761                         as = p[3];
2762                 }
2763                 if (p[1] == dtype && (!after || (void *)p > after) &&
2764                     (iface == -1 || iface == ifc) && (altsetting == -1 || altsetting == as)) {
2765                         return p;
2766                 }
2767                 p = next;
2768         }
2769         return NULL;
2770 }
2771
2772 static void *find_csinterface_descriptor(void *descstart, unsigned int desclen, void *after, u8 dsubtype, int iface, int altsetting)
2773 {
2774         unsigned char *p;
2775
2776         p = find_descriptor(descstart, desclen, after, USB_DT_CS_INTERFACE, iface, altsetting);
2777         while (p) {
2778                 if (p[0] >= 3 && p[2] == dsubtype)
2779                         return p;
2780                 p = find_descriptor(descstart, desclen, p, USB_DT_CS_INTERFACE, iface, altsetting);
2781         }
2782         return NULL;
2783 }
2784
2785 static void *find_audiocontrol_unit(void *descstart, unsigned int desclen, void *after, u8 unit, int iface)
2786 {
2787         unsigned char *p;
2788
2789         p = find_descriptor(descstart, desclen, after, USB_DT_CS_INTERFACE, iface, -1);
2790         while (p) {
2791                 if (p[0] >= 4 && p[2] >= INPUT_TERMINAL && p[2] <= EXTENSION_UNIT && p[3] == unit)
2792                         return p;
2793                 p = find_descriptor(descstart, desclen, p, USB_DT_CS_INTERFACE, iface, -1);
2794         }
2795         return NULL;
2796 }
2797
2798 static void usb_audio_parsestreaming(struct usb_audio_state *s, unsigned char *buffer, unsigned int buflen, int asifin, int asifout)
2799 {
2800         struct usb_device *dev = s->usbdev;
2801         struct usb_audiodev *as;
2802         struct usb_host_interface *alts;
2803         struct usb_interface *iface;
2804         struct audioformat *fp;
2805         unsigned char *fmt, *csep;
2806         unsigned int i, j, k, format, idx;
2807
2808         if (!(as = kmalloc(sizeof(struct usb_audiodev), GFP_KERNEL)))
2809                 return;
2810         memset(as, 0, sizeof(struct usb_audiodev));
2811         init_waitqueue_head(&as->usbin.dma.wait);
2812         init_waitqueue_head(&as->usbout.dma.wait);
2813         spin_lock_init(&as->lock);
2814         as->usbin.durb[0].urb = usb_alloc_urb (DESCFRAMES, GFP_KERNEL);
2815         as->usbin.durb[1].urb = usb_alloc_urb (DESCFRAMES, GFP_KERNEL);
2816         as->usbin.surb[0].urb = usb_alloc_urb (SYNCFRAMES, GFP_KERNEL);
2817         as->usbin.surb[1].urb = usb_alloc_urb (SYNCFRAMES, GFP_KERNEL);
2818         as->usbout.durb[0].urb = usb_alloc_urb (DESCFRAMES, GFP_KERNEL);
2819         as->usbout.durb[1].urb = usb_alloc_urb (DESCFRAMES, GFP_KERNEL);
2820         as->usbout.surb[0].urb = usb_alloc_urb (SYNCFRAMES, GFP_KERNEL);
2821         as->usbout.surb[1].urb = usb_alloc_urb (SYNCFRAMES, GFP_KERNEL);
2822         if ((!as->usbin.durb[0].urb) ||
2823             (!as->usbin.durb[1].urb) ||
2824             (!as->usbin.surb[0].urb) ||
2825             (!as->usbin.surb[1].urb) ||
2826             (!as->usbout.durb[0].urb) ||
2827             (!as->usbout.durb[1].urb) ||
2828             (!as->usbout.surb[0].urb) ||
2829             (!as->usbout.surb[1].urb)) {
2830                 usb_free_urb(as->usbin.durb[0].urb);
2831                 usb_free_urb(as->usbin.durb[1].urb);
2832                 usb_free_urb(as->usbin.surb[0].urb);
2833                 usb_free_urb(as->usbin.surb[1].urb);
2834                 usb_free_urb(as->usbout.durb[0].urb);
2835                 usb_free_urb(as->usbout.durb[1].urb);
2836                 usb_free_urb(as->usbout.surb[0].urb);
2837                 usb_free_urb(as->usbout.surb[1].urb);
2838                 kfree(as);
2839                 return;
2840         }
2841         as->state = s;
2842         as->usbin.interface = asifin;
2843         as->usbout.interface = asifout;
2844         /* search for input formats */
2845         if (asifin >= 0) {
2846                 as->usbin.flags = FLG_CONNECTED;
2847                 iface = usb_ifnum_to_if(dev, asifin);
2848                 for (idx = 0; idx < iface->num_altsetting; idx++) {
2849                         alts = &iface->altsetting[idx];
2850                         i = alts->desc.bAlternateSetting;
2851                         if (alts->desc.bInterfaceClass != USB_CLASS_AUDIO || alts->desc.bInterfaceSubClass != 2)
2852                                 continue;
2853                         if (alts->desc.bNumEndpoints < 1) {
2854                                 if (i != 0) {  /* altsetting 0 has no endpoints (Section B.3.4.1) */
2855                                         printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u does not have an endpoint\n",
2856                                                dev->devnum, asifin, i);
2857                                 }
2858                                 continue;
2859                         }
2860                         if ((alts->endpoint[0].desc.bmAttributes & 0x03) != 0x01 ||
2861                             !(alts->endpoint[0].desc.bEndpointAddress & 0x80)) {
2862                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u first endpoint not isochronous in\n",
2863                                        dev->devnum, asifin, i);
2864                                 continue;
2865                         }
2866                         fmt = find_csinterface_descriptor(buffer, buflen, NULL, AS_GENERAL, asifin, i);
2867                         if (!fmt) {
2868                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not found\n",
2869                                        dev->devnum, asifin, i);
2870                                 continue;
2871                         }
2872                         if (fmt[0] < 7 || fmt[6] != 0 || (fmt[5] != 1 && fmt[5] != 2)) {
2873                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u format not supported\n",
2874                                        dev->devnum, asifin, i);
2875                                 continue;
2876                         }
2877                         format = (fmt[5] == 2) ? (AFMT_U16_LE | AFMT_U8) : (AFMT_S16_LE | AFMT_S8);
2878                         fmt = find_csinterface_descriptor(buffer, buflen, NULL, FORMAT_TYPE, asifin, i);
2879                         if (!fmt) {
2880                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not found\n",
2881                                        dev->devnum, asifin, i);
2882                                 continue;
2883                         }
2884                         if (fmt[0] < 8+3*(fmt[7] ? fmt[7] : 2) || fmt[3] != 1) {
2885                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not supported\n",
2886                                        dev->devnum, asifin, i);
2887                                 continue;
2888                         }
2889                         if (fmt[4] < 1 || fmt[4] > 2 || fmt[5] < 1 || fmt[5] > 2) {
2890                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u unsupported channels %u framesize %u\n",
2891                                        dev->devnum, asifin, i, fmt[4], fmt[5]);
2892                                 continue;
2893                         }
2894                         csep = find_descriptor(buffer, buflen, NULL, USB_DT_CS_ENDPOINT, asifin, i);
2895                         if (!csep || csep[0] < 7 || csep[2] != EP_GENERAL) {
2896                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u no or invalid class specific endpoint descriptor\n",
2897                                        dev->devnum, asifin, i);
2898                                 continue;
2899                         }
2900                         if (as->numfmtin >= MAXFORMATS)
2901                                 continue;
2902                         fp = &as->fmtin[as->numfmtin++];
2903                         if (fmt[5] == 2)
2904                                 format &= (AFMT_U16_LE | AFMT_S16_LE);
2905                         else
2906                                 format &= (AFMT_U8 | AFMT_S8);
2907                         if (fmt[4] == 2)
2908                                 format |= AFMT_STEREO;
2909                         fp->format = format;
2910                         fp->altsetting = i;
2911                         fp->sratelo = fp->sratehi = fmt[8] | (fmt[9] << 8) | (fmt[10] << 16);
2912                         printk(KERN_INFO "usbaudio: valid input sample rate %u\n", fp->sratelo);
2913                         for (j = fmt[7] ? (fmt[7]-1) : 1; j > 0; j--) {
2914                                 k = fmt[8+3*j] | (fmt[9+3*j] << 8) | (fmt[10+3*j] << 16);
2915                                 printk(KERN_INFO "usbaudio: valid input sample rate %u\n", k);
2916                                 if (k > fp->sratehi)
2917                                         fp->sratehi = k;
2918                                 if (k < fp->sratelo)
2919                                         fp->sratelo = k;
2920                         }
2921                         fp->attributes = csep[3];
2922                         printk(KERN_INFO "usbaudio: device %u interface %u altsetting %u: format 0x%08x sratelo %u sratehi %u attributes 0x%02x\n",
2923                                dev->devnum, asifin, i, fp->format, fp->sratelo, fp->sratehi, fp->attributes);
2924                 }
2925         }
2926         /* search for output formats */
2927         if (asifout >= 0) {
2928                 as->usbout.flags = FLG_CONNECTED;
2929                 iface = usb_ifnum_to_if(dev, asifout);
2930                 for (idx = 0; idx < iface->num_altsetting; idx++) {
2931                         alts = &iface->altsetting[idx];
2932                         i = alts->desc.bAlternateSetting;
2933                         if (alts->desc.bInterfaceClass != USB_CLASS_AUDIO || alts->desc.bInterfaceSubClass != 2)
2934                                 continue;
2935                         if (alts->desc.bNumEndpoints < 1) {
2936                                 /* altsetting 0 should never have iso EPs */
2937                                 if (i != 0)
2938                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u does not have an endpoint\n",
2939                                        dev->devnum, asifout, i);
2940                                 continue;
2941                         }
2942                         if ((alts->endpoint[0].desc.bmAttributes & 0x03) != 0x01 ||
2943                             (alts->endpoint[0].desc.bEndpointAddress & 0x80)) {
2944                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u first endpoint not isochronous out\n",
2945                                        dev->devnum, asifout, i);
2946                                 continue;
2947                         }
2948                         /* See USB audio formats manual, section 2 */
2949                         fmt = find_csinterface_descriptor(buffer, buflen, NULL, AS_GENERAL, asifout, i);
2950                         if (!fmt) {
2951                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not found\n",
2952                                        dev->devnum, asifout, i);
2953                                 continue;
2954                         }
2955                         if (fmt[0] < 7 || fmt[6] != 0 || (fmt[5] != 1 && fmt[5] != 2)) {
2956                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u format not supported\n",
2957                                        dev->devnum, asifout, i);
2958                                 continue;
2959                         }
2960                         format = (fmt[5] == 2) ? (AFMT_U16_LE | AFMT_U8) : (AFMT_S16_LE | AFMT_S8);
2961                         /* Dallas DS4201 workaround */
2962                         if (le16_to_cpu(dev->descriptor.idVendor) == 0x04fa &&
2963                             le16_to_cpu(dev->descriptor.idProduct) == 0x4201)
2964                                 format = (AFMT_S16_LE | AFMT_S8);
2965                         fmt = find_csinterface_descriptor(buffer, buflen, NULL, FORMAT_TYPE, asifout, i);
2966                         if (!fmt) {
2967                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not found\n",
2968                                        dev->devnum, asifout, i);
2969                                 continue;
2970                         }
2971                         if (fmt[0] < 8+3*(fmt[7] ? fmt[7] : 2) || fmt[3] != 1) {
2972                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u FORMAT_TYPE descriptor not supported\n",
2973                                        dev->devnum, asifout, i);
2974                                 continue;
2975                         }
2976                         if (fmt[4] < 1 || fmt[4] > 2 || fmt[5] < 1 || fmt[5] > 2) {
2977                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u unsupported channels %u framesize %u\n",
2978                                        dev->devnum, asifout, i, fmt[4], fmt[5]);
2979                                 continue;
2980                         }
2981                         csep = find_descriptor(buffer, buflen, NULL, USB_DT_CS_ENDPOINT, asifout, i);
2982                         if (!csep || csep[0] < 7 || csep[2] != EP_GENERAL) {
2983                                 printk(KERN_ERR "usbaudio: device %u interface %u altsetting %u no or invalid class specific endpoint descriptor\n",
2984                                        dev->devnum, asifout, i);
2985                                 continue;
2986                         }
2987                         if (as->numfmtout >= MAXFORMATS)
2988                                 continue;
2989                         fp = &as->fmtout[as->numfmtout++];
2990                         if (fmt[5] == 2)
2991                                 format &= (AFMT_U16_LE | AFMT_S16_LE);
2992                         else
2993                                 format &= (AFMT_U8 | AFMT_S8);
2994                         if (fmt[4] == 2)
2995                                 format |= AFMT_STEREO;
2996                         fp->format = format;
2997                         fp->altsetting = i;
2998                         fp->sratelo = fp->sratehi = fmt[8] | (fmt[9] << 8) | (fmt[10] << 16);
2999                         printk(KERN_INFO "usbaudio: valid output sample rate %u\n", fp->sratelo);
3000                         for (j = fmt[7] ? (fmt[7]-1) : 1; j > 0; j--) {
3001                                 k = fmt[8+3*j] | (fmt[9+3*j] << 8) | (fmt[10+3*j] << 16);
3002                                 printk(KERN_INFO "usbaudio: valid output sample rate %u\n", k);
3003                                 if (k > fp->sratehi)
3004                                         fp->sratehi = k;
3005                                 if (k < fp->sratelo)
3006                                         fp->sratelo = k;
3007                         }
3008                         fp->attributes = csep[3];
3009                         printk(KERN_INFO "usbaudio: device %u interface %u altsetting %u: format 0x%08x sratelo %u sratehi %u attributes 0x%02x\n",
3010                                dev->devnum, asifout, i, fp->format, fp->sratelo, fp->sratehi, fp->attributes);
3011                 }
3012         }
3013         if (as->numfmtin == 0 && as->numfmtout == 0) {
3014                 usb_free_urb(as->usbin.durb[0].urb);
3015                 usb_free_urb(as->usbin.durb[1].urb);
3016                 usb_free_urb(as->usbin.surb[0].urb);
3017                 usb_free_urb(as->usbin.surb[1].urb);
3018                 usb_free_urb(as->usbout.durb[0].urb);
3019                 usb_free_urb(as->usbout.durb[1].urb);
3020                 usb_free_urb(as->usbout.surb[0].urb);
3021                 usb_free_urb(as->usbout.surb[1].urb);
3022                 kfree(as);
3023                 return;
3024         }
3025         if ((as->dev_audio = register_sound_dsp(&usb_audio_fops, -1)) < 0) {
3026                 printk(KERN_ERR "usbaudio: cannot register dsp\n");
3027                 usb_free_urb(as->usbin.durb[0].urb);
3028                 usb_free_urb(as->usbin.durb[1].urb);
3029                 usb_free_urb(as->usbin.surb[0].urb);
3030                 usb_free_urb(as->usbin.surb[1].urb);
3031                 usb_free_urb(as->usbout.durb[0].urb);
3032                 usb_free_urb(as->usbout.durb[1].urb);
3033                 usb_free_urb(as->usbout.surb[0].urb);
3034                 usb_free_urb(as->usbout.surb[1].urb);
3035                 kfree(as);
3036                 return;
3037         }
3038         printk(KERN_INFO "usbaudio: registered dsp 14,%d\n", as->dev_audio);
3039         /* everything successful */
3040         list_add_tail(&as->list, &s->audiolist);
3041 }
3042
3043 struct consmixstate {
3044         struct usb_audio_state *s;
3045         unsigned char *buffer;
3046         unsigned int buflen;
3047         unsigned int ctrlif;
3048         struct mixerchannel mixch[SOUND_MIXER_NRDEVICES];
3049         unsigned int nrmixch;
3050         unsigned int mixchmask;
3051         unsigned long unitbitmap[32/sizeof(unsigned long)];
3052         /* return values */
3053         unsigned int nrchannels;
3054         unsigned int termtype;
3055         unsigned int chconfig;
3056 };
3057
3058 static struct mixerchannel *getmixchannel(struct consmixstate *state, unsigned int nr)
3059 {
3060         struct mixerchannel *c;
3061
3062         if (nr >= SOUND_MIXER_NRDEVICES) {
3063                 printk(KERN_ERR "usbaudio: invalid OSS mixer channel %u\n", nr);
3064                 return NULL;
3065         }
3066         if (!(state->mixchmask & (1 << nr))) {
3067                 printk(KERN_WARNING "usbaudio: OSS mixer channel %u already in use\n", nr);
3068                 return NULL;
3069         }
3070         c = &state->mixch[state->nrmixch++];
3071         c->osschannel = nr;
3072         state->mixchmask &= ~(1 << nr);
3073         return c;
3074 }
3075
3076 static unsigned int getvolchannel(struct consmixstate *state)
3077 {
3078         unsigned int u;
3079
3080         if ((state->termtype & 0xff00) == 0x0000 && (state->mixchmask & SOUND_MASK_VOLUME))
3081                 return SOUND_MIXER_VOLUME;
3082         if ((state->termtype & 0xff00) == 0x0100) {
3083                 if (state->mixchmask & SOUND_MASK_PCM)
3084                         return SOUND_MIXER_PCM;
3085                 if (state->mixchmask & SOUND_MASK_ALTPCM)
3086                         return SOUND_MIXER_ALTPCM;
3087         }
3088         if ((state->termtype & 0xff00) == 0x0200 && (state->mixchmask & SOUND_MASK_MIC))
3089                 return SOUND_MIXER_MIC;
3090         if ((state->termtype & 0xff00) == 0x0300 && (state->mixchmask & SOUND_MASK_SPEAKER))
3091                 return SOUND_MIXER_SPEAKER;
3092         if ((state->termtype & 0xff00) == 0x0500) {
3093                 if (state->mixchmask & SOUND_MASK_PHONEIN)
3094                         return SOUND_MIXER_PHONEIN;
3095                 if (state->mixchmask & SOUND_MASK_PHONEOUT)
3096                         return SOUND_MIXER_PHONEOUT;
3097         }
3098         if (state->termtype >= 0x710 && state->termtype <= 0x711 && (state->mixchmask & SOUND_MASK_RADIO))
3099                 return SOUND_MIXER_RADIO;
3100         if (state->termtype >= 0x709 && state->termtype <= 0x70f && (state->mixchmask & SOUND_MASK_VIDEO))
3101                 return SOUND_MIXER_VIDEO;
3102         u = ffs(state->mixchmask & (SOUND_MASK_LINE | SOUND_MASK_CD | SOUND_MASK_LINE1 | SOUND_MASK_LINE2 | SOUND_MASK_LINE3 |
3103                                     SOUND_MASK_DIGITAL1 | SOUND_MASK_DIGITAL2 | SOUND_MASK_DIGITAL3));
3104         return u-1;
3105 }
3106
3107 static void prepmixch(struct consmixstate *state)
3108 {
3109         struct usb_device *dev = state->s->usbdev;
3110         struct mixerchannel *ch;
3111         unsigned char *buf;
3112         __s16 v1;
3113         unsigned int v2, v3;
3114
3115         if (!state->nrmixch || state->nrmixch > SOUND_MIXER_NRDEVICES)
3116                 return;
3117         buf = kmalloc(sizeof(*buf) * 2, GFP_KERNEL);
3118         if (!buf) {
3119                 printk(KERN_ERR "prepmixch: out of memory\n") ;
3120                 return;
3121         }
3122
3123         ch = &state->mixch[state->nrmixch-1];
3124         switch (ch->selector) {
3125         case 0:  /* mixer unit request */
3126                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MIN, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3127                                     (ch->chnum << 8) | 1, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3128                         goto err;
3129                 ch->minval = buf[0] | (buf[1] << 8);
3130                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MAX, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3131                                     (ch->chnum << 8) | 1, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3132                         goto err;
3133                 ch->maxval = buf[0] | (buf[1] << 8);
3134                 v2 = ch->maxval - ch->minval;
3135                 if (!v2)
3136                         v2 = 1;
3137                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3138                                     (ch->chnum << 8) | 1, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3139                         goto err;
3140                 v1 = buf[0] | (buf[1] << 8);
3141                 v3 = v1 - ch->minval;
3142                 v3 = 100 * v3 / v2;
3143                 if (v3 > 100)
3144                         v3 = 100;
3145                 ch->value = v3;
3146                 if (ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)) {
3147                         if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3148                                             ((ch->chnum + !!(ch->flags & MIXFLG_STEREOIN)) << 8) | (1 + !!(ch->flags & MIXFLG_STEREOOUT)),
3149                                             state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3150                         goto err;
3151                         v1 = buf[0] | (buf[1] << 8);
3152                         v3 = v1 - ch->minval;
3153                         v3 = 100 * v3 / v2;
3154                         if (v3 > 100)
3155                                 v3 = 100;
3156                 }
3157                 ch->value |= v3 << 8;
3158                 break;
3159
3160                 /* various feature unit controls */
3161         case VOLUME_CONTROL:
3162                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MIN, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3163                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3164                         goto err;
3165                 ch->minval = buf[0] | (buf[1] << 8);
3166                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MAX, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3167                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3168                         goto err;
3169                 ch->maxval = buf[0] | (buf[1] << 8);
3170                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3171                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3172                         goto err;
3173                 v1 = buf[0] | (buf[1] << 8);
3174                 v2 = ch->maxval - ch->minval;
3175                 v3 = v1 - ch->minval;
3176                 if (!v2)
3177                         v2 = 1;
3178                 v3 = 100 * v3 / v2;
3179                 if (v3 > 100)
3180                         v3 = 100;
3181                 ch->value = v3;
3182                 if (ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)) {
3183                         if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3184                                             (ch->selector << 8) | (ch->chnum + 1), state->ctrlif | (ch->unitid << 8), buf, 2, 1000) < 0)
3185                                 goto err;
3186                         v1 = buf[0] | (buf[1] << 8);
3187                         v3 = v1 - ch->minval;
3188                         v3 = 100 * v3 / v2;
3189                         if (v3 > 100)
3190                                 v3 = 100;
3191                 }
3192                 ch->value |= v3 << 8;
3193                 break;
3194
3195         case BASS_CONTROL:
3196         case MID_CONTROL:
3197         case TREBLE_CONTROL:
3198                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MIN, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3199                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 1, 1000) < 0)
3200                         goto err;
3201                 ch->minval = buf[0] << 8;
3202                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_MAX, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3203                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 1, 1000) < 0)
3204                         goto err;
3205                 ch->maxval = buf[0] << 8;
3206                 if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3207                                     (ch->selector << 8) | ch->chnum, state->ctrlif | (ch->unitid << 8), buf, 1, 1000) < 0)
3208                         goto err;
3209                 v1 = buf[0] << 8;
3210                 v2 = ch->maxval - ch->minval;
3211                 v3 = v1 - ch->minval;
3212                 if (!v2)
3213                         v2 = 1;
3214                 v3 = 100 * v3 / v2;
3215                 if (v3 > 100)
3216                         v3 = 100;
3217                 ch->value = v3;
3218                 if (ch->flags & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)) {
3219                         if (usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), GET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
3220                                             (ch->selector << 8) | (ch->chnum + 1), state->ctrlif | (ch->unitid << 8), buf, 1, 1000) < 0)
3221                                 goto err;
3222                         v1 = buf[0] << 8;
3223                         v3 = v1 - ch->minval;
3224                         v3 = 100 * v3 / v2;
3225                         if (v3 > 100)
3226                                 v3 = 100;
3227                 }
3228                 ch->value |= v3 << 8;
3229                 break;
3230
3231         default:
3232                 goto err;
3233         }
3234
3235  freebuf:
3236         kfree(buf);
3237         return;
3238  err:
3239         printk(KERN_ERR "usbaudio: mixer request device %u if %u unit %u ch %u selector %u failed\n",
3240                dev->devnum, state->ctrlif, ch->unitid, ch->chnum, ch->selector);
3241         if (state->nrmixch)
3242                 state->nrmixch--;
3243         goto freebuf;
3244 }
3245
3246
3247 static void usb_audio_recurseunit(struct consmixstate *state, unsigned char unitid);
3248
3249 static inline int checkmixbmap(unsigned char *bmap, unsigned char flg, unsigned int inidx, unsigned int numoch)
3250 {
3251         unsigned int idx;
3252
3253         idx = inidx*numoch;
3254         if (!(bmap[-(idx >> 3)] & (0x80 >> (idx & 7))))
3255                 return 0;
3256         if (!(flg & (MIXFLG_STEREOIN | MIXFLG_STEREOOUT)))
3257                 return 1;
3258         idx = (inidx+!!(flg & MIXFLG_STEREOIN))*numoch+!!(flg & MIXFLG_STEREOOUT);
3259         if (!(bmap[-(idx >> 3)] & (0x80 >> (idx & 7))))
3260                 return 0;
3261         return 1;
3262 }
3263
3264 static void usb_audio_mixerunit(struct consmixstate *state, unsigned char *mixer)
3265 {
3266         unsigned int nroutch = mixer[5+mixer[4]];
3267         unsigned int chidx[SOUND_MIXER_NRDEVICES+1];
3268         unsigned int termt[SOUND_MIXER_NRDEVICES];
3269         unsigned char flg = (nroutch >= 2) ? MIXFLG_STEREOOUT : 0;
3270         unsigned char *bmap = &mixer[9+mixer[4]];
3271         unsigned int bmapsize;
3272         struct mixerchannel *ch;
3273         unsigned int i;
3274
3275         if (!mixer[4]) {
3276                 printk(KERN_ERR "usbaudio: unit %u invalid MIXER_UNIT descriptor\n", mixer[3]);
3277                 return;
3278         }
3279         if (mixer[4] > SOUND_MIXER_NRDEVICES) {
3280                 printk(KERN_ERR "usbaudio: mixer unit %u: too many input pins\n", mixer[3]);
3281                 return;
3282         }
3283         chidx[0] = 0;
3284         for (i = 0; i < mixer[4]; i++) {
3285                 usb_audio_recurseunit(state, mixer[5+i]);
3286                 chidx[i+1] = chidx[i] + state->nrchannels;
3287                 termt[i] = state->termtype;
3288         }
3289         state->termtype = 0;
3290         state->chconfig = mixer[6+mixer[4]] | (mixer[7+mixer[4]] << 8);
3291         bmapsize = (nroutch * chidx[mixer[4]] + 7) >> 3;
3292         bmap += bmapsize - 1;
3293         if (mixer[0] < 10+mixer[4]+bmapsize) {
3294                 printk(KERN_ERR "usbaudio: unit %u invalid MIXER_UNIT descriptor (bitmap too small)\n", mixer[3]);
3295                 return;
3296         }
3297         for (i = 0; i < mixer[4]; i++) {
3298                 state->termtype = termt[i];
3299                 if (chidx[i+1]-chidx[i] >= 2) {
3300                         flg |= MIXFLG_STEREOIN;
3301                         if (checkmixbmap(bmap, flg, chidx[i], nroutch)) {
3302                                 ch = getmixchannel(state, getvolchannel(state));
3303                                 if (ch) {
3304                                         ch->unitid = mixer[3];
3305                                         ch->selector = 0;
3306                                         ch->chnum = chidx[i]+1;
3307                                         ch->flags = flg;
3308                                         prepmixch(state);
3309                                 }
3310                                 continue;
3311                         }
3312                 }
3313                 flg &= ~MIXFLG_STEREOIN;
3314                 if (checkmixbmap(bmap, flg, chidx[i], nroutch)) {
3315                         ch = getmixchannel(state, getvolchannel(state));
3316                         if (ch) {
3317                                 ch->unitid = mixer[3];
3318                                 ch->selector = 0;
3319                                 ch->chnum = chidx[i]+1;
3320                                 ch->flags = flg;
3321                                 prepmixch(state);
3322                         }
3323                 }
3324         }
3325         state->termtype = 0;
3326 }
3327
3328 static struct mixerchannel *slctsrc_findunit(struct consmixstate *state, __u8 unitid)
3329 {
3330         unsigned int i;
3331
3332         for (i = 0; i < state->nrmixch; i++)
3333                 if (state->mixch[i].unitid == unitid)
3334                         return &state->mixch[i];
3335         return NULL;
3336 }
3337
3338 static void usb_audio_selectorunit(struct consmixstate *state, unsigned char *selector)
3339 {
3340         unsigned int chnum, i, mixch;
3341         struct mixerchannel *mch;
3342
3343         if (!selector[4]) {
3344                 printk(KERN_ERR "usbaudio: unit %u invalid SELECTOR_UNIT descriptor\n", selector[3]);
3345                 return;
3346         }
3347         mixch = state->nrmixch;
3348         usb_audio_recurseunit(state, selector[5]);
3349         if (state->nrmixch != mixch) {
3350                 mch = &state->mixch[state->nrmixch-1];
3351                 mch->slctunitid = selector[3] | (1 << 8);
3352         } else if ((mch = slctsrc_findunit(state, selector[5]))) {
3353                 mch->slctunitid = selector[3] | (1 << 8);
3354         } else {
3355                 printk(KERN_INFO "usbaudio: selector unit %u: ignoring channel 1\n", selector[3]);
3356         }
3357         chnum = state->nrchannels;
3358         for (i = 1; i < selector[4]; i++) {
3359                 mixch = state->nrmixch;
3360                 usb_audio_recurseunit(state, selector[5+i]);
3361                 if (chnum != state->nrchannels) {
3362                         printk(KERN_ERR "usbaudio: selector unit %u: input pins with varying channel numbers\n", selector[3]);
3363                         state->termtype = 0;
3364                         state->chconfig = 0;
3365                         state->nrchannels = 0;
3366                         return;
3367                 }
3368                 if (state->nrmixch != mixch) {
3369                         mch = &state->mixch[state->nrmixch-1];
3370                         mch->slctunitid = selector[3] | ((i + 1) << 8);
3371                 } else if ((mch = slctsrc_findunit(state, selector[5+i]))) {
3372                         mch->slctunitid = selector[3] | ((i + 1) << 8);
3373                 } else {
3374                         printk(KERN_INFO "usbaudio: selector unit %u: ignoring channel %u\n", selector[3], i+1);
3375                 }
3376         }
3377         state->termtype = 0;
3378         state->chconfig = 0;
3379 }
3380
3381 /* in the future we might try to handle 3D etc. effect units */
3382
3383 static void usb_audio_processingunit(struct consmixstate *state, unsigned char *proc)
3384 {
3385         unsigned int i;
3386
3387         for (i = 0; i < proc[6]; i++)
3388                 usb_audio_recurseunit(state, proc[7+i]);
3389         state->nrchannels = proc[7+proc[6]];
3390         state->termtype = 0;
3391         state->chconfig = proc[8+proc[6]] | (proc[9+proc[6]] << 8);
3392 }
3393
3394
3395 /* See Audio Class Spec, section 4.3.2.5 */
3396 static void usb_audio_featureunit(struct consmixstate *state, unsigned char *ftr)
3397 {
3398         struct mixerchannel *ch;
3399         unsigned short chftr, mchftr;
3400 #if 0
3401         struct usb_device *dev = state->s->usbdev;
3402         unsigned char data[1];
3403 #endif
3404         unsigned char nr_logical_channels, i;
3405
3406         usb_audio_recurseunit(state, ftr[4]);
3407
3408         if (ftr[5] == 0 ) {
3409                 printk(KERN_ERR "usbaudio: wrong controls size in feature unit %u\n",ftr[3]);
3410                 return;
3411         }
3412
3413         if (state->nrchannels == 0) {
3414                 printk(KERN_ERR "usbaudio: feature unit %u source has no channels\n", ftr[3]);
3415                 return;
3416         }
3417         if (state->nrchannels > 2)
3418                 printk(KERN_WARNING "usbaudio: feature unit %u: OSS mixer interface does not support more than 2 channels\n", ftr[3]);
3419
3420         nr_logical_channels=(ftr[0]-7)/ftr[5]-1;
3421
3422         if (nr_logical_channels != state->nrchannels) {
3423                 printk(KERN_WARNING "usbaudio: warning: found %d of %d logical channels.\n", state->nrchannels,nr_logical_channels);
3424
3425                 if (state->nrchannels == 1 && nr_logical_channels==0) {
3426                         printk(KERN_INFO "usbaudio: assuming the channel found is the master channel (got a Philips camera?). Should be fine.\n");
3427                 } else if (state->nrchannels == 1 && nr_logical_channels==2) {
3428                         printk(KERN_INFO "usbaudio: assuming that a stereo channel connected directly to a mixer is missing in search (got Labtec headset?). Should be fine.\n");
3429                         state->nrchannels=nr_logical_channels;
3430                 } else {
3431                         printk(KERN_WARNING "usbaudio: no idea what's going on..., contact linux-usb-devel@lists.sourceforge.net\n");
3432                 }
3433         }
3434
3435         /* There is always a master channel */
3436         mchftr = ftr[6];
3437         /* Binary AND over logical channels if they exist */
3438         if (nr_logical_channels) {
3439                 chftr = ftr[6+ftr[5]];
3440                 for (i = 2; i <= nr_logical_channels; i++)
3441                         chftr &= ftr[6+i*ftr[5]];
3442         } else {
3443                 chftr = 0;
3444         }
3445
3446         /* volume control */
3447         if (chftr & 2) {
3448                 ch = getmixchannel(state, getvolchannel(state));
3449                 if (ch) {
3450                         ch->unitid = ftr[3];
3451                         ch->selector = VOLUME_CONTROL;
3452                         ch->chnum = 1;
3453                         ch->flags = (state->nrchannels > 1) ? (MIXFLG_STEREOIN | MIXFLG_STEREOOUT) : 0;
3454                         prepmixch(state);
3455                 }
3456         } else if (mchftr & 2) {
3457                 ch = getmixchannel(state, getvolchannel(state));
3458                 if (ch) {
3459                         ch->unitid = ftr[3];
3460                         ch->selector = VOLUME_CONTROL;
3461                         ch->chnum = 0;
3462                         ch->flags = 0;
3463                         prepmixch(state);
3464                 }
3465         }
3466         /* bass control */
3467         if (chftr & 4) {
3468                 ch = getmixchannel(state, SOUND_MIXER_BASS);
3469                 if (ch) {
3470                         ch->unitid = ftr[3];
3471                         ch->selector = BASS_CONTROL;
3472                         ch->chnum = 1;
3473                         ch->flags = (state->nrchannels > 1) ? (MIXFLG_STEREOIN | MIXFLG_STEREOOUT) : 0;
3474                         prepmixch(state);
3475                 }
3476         } else if (mchftr & 4) {
3477                 ch = getmixchannel(state, SOUND_MIXER_BASS);
3478                 if (ch) {
3479                         ch->unitid = ftr[3];
3480                         ch->selector = BASS_CONTROL;
3481                         ch->chnum = 0;
3482                         ch->flags = 0;
3483                         prepmixch(state);
3484                 }
3485         }
3486         /* treble control */
3487         if (chftr & 16) {
3488                 ch = getmixchannel(state, SOUND_MIXER_TREBLE);
3489                 if (ch) {
3490                         ch->unitid = ftr[3];
3491                         ch->selector = TREBLE_CONTROL;
3492                         ch->chnum = 1;
3493                         ch->flags = (state->nrchannels > 1) ? (MIXFLG_STEREOIN | MIXFLG_STEREOOUT) : 0;
3494                         prepmixch(state);
3495                 }
3496         } else if (mchftr & 16) {
3497                 ch = getmixchannel(state, SOUND_MIXER_TREBLE);
3498                 if (ch) {
3499                         ch->unitid = ftr[3];
3500                         ch->selector = TREBLE_CONTROL;
3501                         ch->chnum = 0;
3502                         ch->flags = 0;
3503                         prepmixch(state);
3504                 }
3505         }
3506 #if 0
3507         /* if there are mute controls, unmute them */
3508         /* does not seem to be necessary, and the Dallas chip does not seem to support the "all" channel (255) */
3509         if ((chftr & 1) || (mchftr & 1)) {
3510                 printk(KERN_DEBUG "usbaudio: unmuting feature unit %u interface %u\n", ftr[3], state->ctrlif);
3511                 data[0] = 0;
3512                 if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), SET_CUR, USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
3513                                     (MUTE_CONTROL << 8) | 0xff, state->ctrlif | (ftr[3] << 8), data, 1, 1000) < 0)
3514                         printk(KERN_WARNING "usbaudio: failure to unmute feature unit %u interface %u\n", ftr[3], state->ctrlif);
3515         }
3516 #endif
3517 }
3518
3519 static void usb_audio_recurseunit(struct consmixstate *state, unsigned char unitid)
3520 {
3521         unsigned char *p1;
3522         unsigned int i, j;
3523
3524         if (test_and_set_bit(unitid, state->unitbitmap)) {
3525                 printk(KERN_INFO "usbaudio: mixer path revisits unit %d\n", unitid);
3526                 return;
3527         }
3528         p1 = find_audiocontrol_unit(state->buffer, state->buflen, NULL, unitid, state->ctrlif);
3529         if (!p1) {
3530                 printk(KERN_ERR "usbaudio: unit %d not found!\n", unitid);
3531                 return;
3532         }
3533         state->nrchannels = 0;
3534         state->termtype = 0;
3535         state->chconfig = 0;
3536         switch (p1[2]) {
3537         case INPUT_TERMINAL:
3538                 if (p1[0] < 12) {
3539                         printk(KERN_ERR "usbaudio: unit %u: invalid INPUT_TERMINAL descriptor\n", unitid);
3540                         return;
3541                 }
3542                 state->nrchannels = p1[7];
3543                 state->termtype = p1[4] | (p1[5] << 8);
3544                 state->chconfig = p1[8] | (p1[9] << 8);
3545                 return;
3546
3547         case MIXER_UNIT:
3548                 if (p1[0] < 10 || p1[0] < 10+p1[4]) {
3549                         printk(KERN_ERR "usbaudio: unit %u: invalid MIXER_UNIT descriptor\n", unitid);
3550                         return;
3551                 }
3552                 usb_audio_mixerunit(state, p1);
3553                 return;
3554
3555         case SELECTOR_UNIT:
3556                 if (p1[0] < 6 || p1[0] < 6+p1[4]) {
3557                         printk(KERN_ERR "usbaudio: unit %u: invalid SELECTOR_UNIT descriptor\n", unitid);
3558                         return;
3559                 }
3560                 usb_audio_selectorunit(state, p1);
3561                 return;
3562
3563         case FEATURE_UNIT: /* See USB Audio Class Spec 4.3.2.5 */
3564                 if (p1[0] < 7 || p1[0] < 7+p1[5]) {
3565                         printk(KERN_ERR "usbaudio: unit %u: invalid FEATURE_UNIT descriptor\n", unitid);
3566                         return;
3567                 }
3568                 usb_audio_featureunit(state, p1);
3569                 return;
3570
3571         case PROCESSING_UNIT:
3572                 if (p1[0] < 13 || p1[0] < 13+p1[6] || p1[0] < 13+p1[6]+p1[11+p1[6]]) {
3573                         printk(KERN_ERR "usbaudio: unit %u: invalid PROCESSING_UNIT descriptor\n", unitid);
3574                         return;
3575                 }
3576                 usb_audio_processingunit(state, p1);
3577                 return;
3578
3579         case EXTENSION_UNIT:
3580                 if (p1[0] < 13 || p1[0] < 13+p1[6] || p1[0] < 13+p1[6]+p1[11+p1[6]]) {
3581                         printk(KERN_ERR "usbaudio: unit %u: invalid EXTENSION_UNIT descriptor\n", unitid);
3582                         return;
3583                 }
3584                 for (j = i = 0; i < p1[6]; i++) {
3585                         usb_audio_recurseunit(state, p1[7+i]);
3586                         if (!i)
3587                                 j = state->termtype;
3588                         else if (j != state->termtype)
3589                                 j = 0;
3590                 }
3591                 state->nrchannels = p1[7+p1[6]];
3592                 state->chconfig = p1[8+p1[6]] | (p1[9+p1[6]] << 8);
3593                 state->termtype = j;
3594                 return;
3595
3596         default:
3597                 printk(KERN_ERR "usbaudio: unit %u: unexpected type 0x%02x\n", unitid, p1[2]);
3598                 return;
3599         }
3600 }
3601
3602 static void usb_audio_constructmixer(struct usb_audio_state *s, unsigned char *buffer, unsigned int buflen, unsigned int ctrlif, unsigned char *oterm)
3603 {
3604         struct usb_mixerdev *ms;
3605         struct consmixstate state;
3606
3607         memset(&state, 0, sizeof(state));
3608         state.s = s;
3609         state.nrmixch = 0;
3610         state.mixchmask = ~0;
3611         state.buffer = buffer;
3612         state.buflen = buflen;
3613         state.ctrlif = ctrlif;
3614         set_bit(oterm[3], state.unitbitmap);  /* mark terminal ID as visited */
3615         printk(KERN_DEBUG "usbaudio: constructing mixer for Terminal %u type 0x%04x\n",
3616                oterm[3], oterm[4] | (oterm[5] << 8));
3617         usb_audio_recurseunit(&state, oterm[7]);
3618         if (!state.nrmixch) {
3619                 printk(KERN_INFO "usbaudio: no mixer controls found for Terminal %u\n", oterm[3]);
3620                 return;
3621         }
3622         if (!(ms = kmalloc(sizeof(struct usb_mixerdev)+state.nrmixch*sizeof(struct mixerchannel), GFP_KERNEL)))
3623                 return;
3624         memset(ms, 0, sizeof(struct usb_mixerdev));
3625         memcpy(&ms->ch, &state.mixch, state.nrmixch*sizeof(struct mixerchannel));
3626         ms->state = s;
3627         ms->iface = ctrlif;
3628         ms->numch = state.nrmixch;
3629         if ((ms->dev_mixer = register_sound_mixer(&usb_mixer_fops, -1)) < 0) {
3630                 printk(KERN_ERR "usbaudio: cannot register mixer\n");
3631                 kfree(ms);
3632                 return;
3633         }
3634         printk(KERN_INFO "usbaudio: registered mixer 14,%d\n", ms->dev_mixer);
3635         list_add_tail(&ms->list, &s->mixerlist);
3636 }
3637
3638 /* arbitrary limit, we won't check more interfaces than this */
3639 #define USB_MAXINTERFACES       32
3640
3641 static struct usb_audio_state *usb_audio_parsecontrol(struct usb_device *dev, unsigned char *buffer, unsigned int buflen, unsigned int ctrlif)
3642 {
3643         struct usb_audio_state *s;
3644         struct usb_interface *iface;
3645         struct usb_host_interface *alt;
3646         unsigned char ifin[USB_MAXINTERFACES], ifout[USB_MAXINTERFACES];
3647         unsigned char *p1;
3648         unsigned int i, j, k, numifin = 0, numifout = 0;
3649
3650         if (!(s = kmalloc(sizeof(struct usb_audio_state), GFP_KERNEL)))
3651                 return NULL;
3652         memset(s, 0, sizeof(struct usb_audio_state));
3653         INIT_LIST_HEAD(&s->audiolist);
3654         INIT_LIST_HEAD(&s->mixerlist);
3655         s->usbdev = dev;
3656         s->count = 1;
3657
3658         /* find audiocontrol interface */
3659         if (!(p1 = find_csinterface_descriptor(buffer, buflen, NULL, HEADER, ctrlif, -1))) {
3660                 printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u no HEADER found\n",
3661                        dev->devnum, ctrlif);
3662                 goto ret;
3663         }
3664         if (p1[0] < 8 + p1[7]) {
3665                 printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u HEADER error\n",
3666                        dev->devnum, ctrlif);
3667                 goto ret;
3668         }
3669         if (!p1[7])
3670                 printk(KERN_INFO "usbaudio: device %d audiocontrol interface %u has no AudioStreaming and MidiStreaming interfaces\n",
3671                        dev->devnum, ctrlif);
3672         for (i = 0; i < p1[7]; i++) {
3673                 j = p1[8+i];
3674                 iface = usb_ifnum_to_if(dev, j);
3675                 if (!iface) {
3676                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u does not exist\n",
3677                                dev->devnum, ctrlif, j);
3678                         continue;
3679                 }
3680                 if (iface->num_altsetting == 1) {
3681                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u has only 1 altsetting.\n", dev->devnum, ctrlif);
3682                         continue;
3683                 }
3684                 alt = usb_altnum_to_altsetting(iface, 0);
3685                 if (!alt) {
3686                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u has no altsetting 0\n",
3687                                dev->devnum, ctrlif, j);
3688                         continue;
3689                 }
3690                 if (alt->desc.bInterfaceClass != USB_CLASS_AUDIO) {
3691                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u is not an AudioClass interface\n",
3692                                dev->devnum, ctrlif, j);
3693                         continue;
3694                 }
3695                 if (alt->desc.bInterfaceSubClass == 3) {
3696                         printk(KERN_INFO "usbaudio: device %d audiocontrol interface %u interface %u MIDIStreaming not supported\n",
3697                                dev->devnum, ctrlif, j);
3698                         continue;
3699                 }
3700                 if (alt->desc.bInterfaceSubClass != 2) {
3701                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u invalid AudioClass subtype\n",
3702                                dev->devnum, ctrlif, j);
3703                         continue;
3704                 }
3705                 if (alt->desc.bNumEndpoints > 0) {
3706                         /* Check all endpoints; should they all have a bandwidth of 0 ? */
3707                         for (k = 0; k < alt->desc.bNumEndpoints; k++) {
3708                                 if (le16_to_cpu(alt->endpoint[k].desc.wMaxPacketSize) > 0) {
3709                                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u endpoint %d does not have 0 bandwidth at alt[0]\n", dev->devnum, ctrlif, k);
3710                                         break;
3711                                 }
3712                         }
3713                         if (k < alt->desc.bNumEndpoints)
3714                                 continue;
3715                 }
3716
3717                 alt = usb_altnum_to_altsetting(iface, 1);
3718                 if (!alt) {
3719                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u has no altsetting 1\n",
3720                                dev->devnum, ctrlif, j);
3721                         continue;
3722                 }
3723                 if (alt->desc.bNumEndpoints < 1) {
3724                         printk(KERN_ERR "usbaudio: device %d audiocontrol interface %u interface %u has no endpoint\n",
3725                                dev->devnum, ctrlif, j);
3726                         continue;
3727                 }
3728                 /* note: this requires the data endpoint to be ep0 and the optional sync
3729                    ep to be ep1, which seems to be the case */
3730                 if (alt->endpoint[0].desc.bEndpointAddress & USB_DIR_IN) {
3731                         if (numifin < USB_MAXINTERFACES) {
3732                                 ifin[numifin++] = j;
3733                                 usb_driver_claim_interface(&usb_audio_driver, iface, (void *)-1);
3734                         }
3735                 } else {
3736                         if (numifout < USB_MAXINTERFACES) {
3737                                 ifout[numifout++] = j;
3738                                 usb_driver_claim_interface(&usb_audio_driver, iface, (void *)-1);
3739                         }
3740                 }
3741         }
3742         printk(KERN_INFO "usbaudio: device %d audiocontrol interface %u has %u input and %u output AudioStreaming interfaces\n",
3743                dev->devnum, ctrlif, numifin, numifout);
3744         for (i = 0; i < numifin && i < numifout; i++)
3745                 usb_audio_parsestreaming(s, buffer, buflen, ifin[i], ifout[i]);
3746         for (j = i; j < numifin; j++)
3747                 usb_audio_parsestreaming(s, buffer, buflen, ifin[i], -1);
3748         for (j = i; j < numifout; j++)
3749                 usb_audio_parsestreaming(s, buffer, buflen, -1, ifout[i]);
3750         /* now walk through all OUTPUT_TERMINAL descriptors to search for mixers */
3751         p1 = find_csinterface_descriptor(buffer, buflen, NULL, OUTPUT_TERMINAL, ctrlif, -1);
3752         while (p1) {
3753                 if (p1[0] >= 9)
3754                         usb_audio_constructmixer(s, buffer, buflen, ctrlif, p1);
3755                 p1 = find_csinterface_descriptor(buffer, buflen, p1, OUTPUT_TERMINAL, ctrlif, -1);
3756         }
3757
3758 ret:
3759         if (list_empty(&s->audiolist) && list_empty(&s->mixerlist)) {
3760                 kfree(s);
3761                 return NULL;
3762         }
3763         /* everything successful */
3764         down(&open_sem);
3765         list_add_tail(&s->audiodev, &audiodevs);
3766         up(&open_sem);
3767         printk(KERN_DEBUG "usb_audio_parsecontrol: usb_audio_state at %p\n", s);
3768         return s;
3769 }
3770
3771 /* we only care for the currently active configuration */
3772
3773 static int usb_audio_probe(struct usb_interface *intf,
3774                            const struct usb_device_id *id)
3775 {
3776         struct usb_device *dev = interface_to_usbdev (intf);
3777         struct usb_audio_state *s;
3778         unsigned char *buffer;
3779         unsigned int buflen;
3780
3781 #if 0
3782         printk(KERN_DEBUG "usbaudio: Probing if %i: IC %x, ISC %x\n", ifnum,
3783                config->interface[ifnum].altsetting[0].desc.bInterfaceClass,
3784                config->interface[ifnum].altsetting[0].desc.bInterfaceSubClass);
3785 #endif
3786
3787         /*
3788          * audiocontrol interface found
3789          * find which configuration number is active
3790          */
3791         buffer = dev->rawdescriptors[dev->actconfig - dev->config];
3792         buflen = le16_to_cpu(dev->actconfig->desc.wTotalLength);
3793         s = usb_audio_parsecontrol(dev, buffer, buflen, intf->altsetting->desc.bInterfaceNumber);
3794         if (s) {
3795                 usb_set_intfdata (intf, s);
3796                 return 0;
3797         }
3798         return -ENODEV;
3799 }
3800
3801
3802 /* a revoke facility would make things simpler */
3803
3804 static void usb_audio_disconnect(struct usb_interface *intf)
3805 {
3806         struct usb_audio_state *s = usb_get_intfdata (intf);
3807         struct usb_audiodev *as;
3808         struct usb_mixerdev *ms;
3809
3810         if (!s)
3811                 return;
3812
3813         /* we get called with -1 for every audiostreaming interface registered */
3814         if (s == (struct usb_audio_state *)-1) {
3815                 dprintk((KERN_DEBUG "usbaudio: note, usb_audio_disconnect called with -1\n"));
3816                 return;
3817         }
3818         if (!s->usbdev) {
3819                 dprintk((KERN_DEBUG "usbaudio: error,  usb_audio_disconnect already called for %p!\n", s));
3820                 return;
3821         }
3822         down(&open_sem);
3823         list_del_init(&s->audiodev);
3824         s->usbdev = NULL;
3825         usb_set_intfdata (intf, NULL);
3826
3827         /* deregister all audio and mixer devices, so no new processes can open this device */
3828         list_for_each_entry(as, &s->audiolist, list) {
3829                 usbin_disc(as);
3830                 usbout_disc(as);
3831                 wake_up(&as->usbin.dma.wait);
3832                 wake_up(&as->usbout.dma.wait);
3833                 if (as->dev_audio >= 0) {
3834                         unregister_sound_dsp(as->dev_audio);
3835                         printk(KERN_INFO "usbaudio: unregister dsp 14,%d\n", as->dev_audio);
3836                 }
3837                 as->dev_audio = -1;
3838         }
3839         list_for_each_entry(ms, &s->mixerlist, list) {
3840                 if (ms->dev_mixer >= 0) {
3841                         unregister_sound_mixer(ms->dev_mixer);
3842                         printk(KERN_INFO "usbaudio: unregister mixer 14,%d\n", ms->dev_mixer);
3843                 }
3844                 ms->dev_mixer = -1;
3845         }
3846         release(s);
3847         wake_up(&open_wait);
3848 }
3849
3850 static int __init usb_audio_init(void)
3851 {
3852         int result = usb_register(&usb_audio_driver);
3853         if (result == 0)
3854                 info(DRIVER_VERSION ":" DRIVER_DESC);
3855         return result;
3856 }
3857
3858
3859 static void __exit usb_audio_cleanup(void)
3860 {
3861         usb_deregister(&usb_audio_driver);
3862 }
3863
3864 module_init(usb_audio_init);
3865 module_exit(usb_audio_cleanup);
3866
3867 MODULE_AUTHOR( DRIVER_AUTHOR );
3868 MODULE_DESCRIPTION( DRIVER_DESC );
3869 MODULE_LICENSE("GPL");
3870