message.c 56.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * message.c - synchronous message handling
 */

#include <linux/pci.h>	/* for scatterlist macros */
#include <linux/usb.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/timer.h>
#include <linux/ctype.h>
#include <linux/device.h>
14
#include <linux/scatterlist.h>
15
#include <linux/usb/quirks.h>
L
Linus Torvalds 已提交
16 17 18 19 20
#include <asm/byteorder.h>

#include "hcd.h"	/* for usbcore internals */
#include "usb.h"

21 22
static void cancel_async_set_config(struct usb_device *udev);

23 24 25 26 27
struct api_context {
	struct completion	done;
	int			status;
};

28
static void usb_api_blocking_completion(struct urb *urb)
L
Linus Torvalds 已提交
29
{
30 31 32 33
	struct api_context *ctx = urb->context;

	ctx->status = urb->status;
	complete(&ctx->done);
L
Linus Torvalds 已提交
34 35 36
}


37 38 39 40 41 42 43
/*
 * Starts urb and waits for completion or timeout. Note that this call
 * is NOT interruptible. Many device driver i/o requests should be
 * interruptible and therefore these drivers should implement their
 * own interruptible routines.
 */
static int usb_start_wait_urb(struct urb *urb, int timeout, int *actual_length)
44
{
45
	struct api_context ctx;
46
	unsigned long expire;
47
	int retval;
L
Linus Torvalds 已提交
48

49 50
	init_completion(&ctx.done);
	urb->context = &ctx;
L
Linus Torvalds 已提交
51
	urb->actual_length = 0;
52 53
	retval = usb_submit_urb(urb, GFP_NOIO);
	if (unlikely(retval))
54
		goto out;
L
Linus Torvalds 已提交
55

56
	expire = timeout ? msecs_to_jiffies(timeout) : MAX_SCHEDULE_TIMEOUT;
57 58 59
	if (!wait_for_completion_timeout(&ctx.done, expire)) {
		usb_kill_urb(urb);
		retval = (ctx.status == -ENOENT ? -ETIMEDOUT : ctx.status);
60 61

		dev_dbg(&urb->dev->dev,
62
			"%s timed out on ep%d%s len=%u/%u\n",
63
			current->comm,
A
Alan Stern 已提交
64 65
			usb_endpoint_num(&urb->ep->desc),
			usb_urb_dir_in(urb) ? "in" : "out",
66 67 68
			urb->actual_length,
			urb->transfer_buffer_length);
	} else
69
		retval = ctx.status;
70
out:
L
Linus Torvalds 已提交
71 72
	if (actual_length)
		*actual_length = urb->actual_length;
73

L
Linus Torvalds 已提交
74
	usb_free_urb(urb);
75
	return retval;
L
Linus Torvalds 已提交
76 77 78
}

/*-------------------------------------------------------------------*/
79
/* returns status (negative) or length (positive) */
L
Linus Torvalds 已提交
80
static int usb_internal_control_msg(struct usb_device *usb_dev,
81
				    unsigned int pipe,
L
Linus Torvalds 已提交
82 83 84 85 86 87 88 89 90 91
				    struct usb_ctrlrequest *cmd,
				    void *data, int len, int timeout)
{
	struct urb *urb;
	int retv;
	int length;

	urb = usb_alloc_urb(0, GFP_NOIO);
	if (!urb)
		return -ENOMEM;
92

L
Linus Torvalds 已提交
93 94 95 96 97 98 99 100 101 102 103
	usb_fill_control_urb(urb, usb_dev, pipe, (unsigned char *)cmd, data,
			     len, usb_api_blocking_completion, NULL);

	retv = usb_start_wait_urb(urb, timeout, &length);
	if (retv < 0)
		return retv;
	else
		return length;
}

/**
104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129
 * usb_control_msg - Builds a control urb, sends it off and waits for completion
 * @dev: pointer to the usb device to send the message to
 * @pipe: endpoint "pipe" to send the message to
 * @request: USB message request value
 * @requesttype: USB message request type value
 * @value: USB message value
 * @index: USB message index value
 * @data: pointer to the data to send
 * @size: length in bytes of the data to send
 * @timeout: time in msecs to wait for the message to complete before timing
 *	out (if 0 the wait is forever)
 *
 * Context: !in_interrupt ()
 *
 * This function sends a simple control message to a specified endpoint and
 * waits for the message to complete, or timeout.
 *
 * If successful, it returns the number of bytes transferred, otherwise a
 * negative error number.
 *
 * Don't use this function from within an interrupt context, like a bottom half
 * handler.  If you need an asynchronous message, or need to send a message
 * from within interrupt context, use usb_submit_urb().
 * If a thread in your driver uses this call, make sure your disconnect()
 * method can wait for it to complete.  Since you don't have a handle on the
 * URB used, you can't cancel the request.
L
Linus Torvalds 已提交
130
 */
131 132 133
int usb_control_msg(struct usb_device *dev, unsigned int pipe, __u8 request,
		    __u8 requesttype, __u16 value, __u16 index, void *data,
		    __u16 size, int timeout)
L
Linus Torvalds 已提交
134
{
135
	struct usb_ctrlrequest *dr;
L
Linus Torvalds 已提交
136
	int ret;
137 138

	dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_NOIO);
L
Linus Torvalds 已提交
139 140 141
	if (!dr)
		return -ENOMEM;

142
	dr->bRequestType = requesttype;
L
Linus Torvalds 已提交
143
	dr->bRequest = request;
144 145 146
	dr->wValue = cpu_to_le16(value);
	dr->wIndex = cpu_to_le16(index);
	dr->wLength = cpu_to_le16(size);
L
Linus Torvalds 已提交
147

148
	/* dbg("usb_control_msg"); */
L
Linus Torvalds 已提交
149 150 151 152 153 154 155

	ret = usb_internal_control_msg(dev, pipe, dr, data, size, timeout);

	kfree(dr);

	return ret;
}
156
EXPORT_SYMBOL_GPL(usb_control_msg);
L
Linus Torvalds 已提交
157

158 159 160 161 162 163
/**
 * usb_interrupt_msg - Builds an interrupt urb, sends it off and waits for completion
 * @usb_dev: pointer to the usb device to send the message to
 * @pipe: endpoint "pipe" to send the message to
 * @data: pointer to the data to send
 * @len: length in bytes of the data to send
164 165
 * @actual_length: pointer to a location to put the actual length transferred
 *	in bytes
166 167
 * @timeout: time in msecs to wait for the message to complete before
 *	timing out (if 0 the wait is forever)
168
 *
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190
 * Context: !in_interrupt ()
 *
 * This function sends a simple interrupt message to a specified endpoint and
 * waits for the message to complete, or timeout.
 *
 * If successful, it returns 0, otherwise a negative error number.  The number
 * of actual bytes transferred will be stored in the actual_length paramater.
 *
 * Don't use this function from within an interrupt context, like a bottom half
 * handler.  If you need an asynchronous message, or need to send a message
 * from within interrupt context, use usb_submit_urb() If a thread in your
 * driver uses this call, make sure your disconnect() method can wait for it to
 * complete.  Since you don't have a handle on the URB used, you can't cancel
 * the request.
 */
int usb_interrupt_msg(struct usb_device *usb_dev, unsigned int pipe,
		      void *data, int len, int *actual_length, int timeout)
{
	return usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout);
}
EXPORT_SYMBOL_GPL(usb_interrupt_msg);

L
Linus Torvalds 已提交
191
/**
192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220
 * usb_bulk_msg - Builds a bulk urb, sends it off and waits for completion
 * @usb_dev: pointer to the usb device to send the message to
 * @pipe: endpoint "pipe" to send the message to
 * @data: pointer to the data to send
 * @len: length in bytes of the data to send
 * @actual_length: pointer to a location to put the actual length transferred
 *	in bytes
 * @timeout: time in msecs to wait for the message to complete before
 *	timing out (if 0 the wait is forever)
 *
 * Context: !in_interrupt ()
 *
 * This function sends a simple bulk message to a specified endpoint
 * and waits for the message to complete, or timeout.
 *
 * If successful, it returns 0, otherwise a negative error number.  The number
 * of actual bytes transferred will be stored in the actual_length paramater.
 *
 * Don't use this function from within an interrupt context, like a bottom half
 * handler.  If you need an asynchronous message, or need to send a message
 * from within interrupt context, use usb_submit_urb() If a thread in your
 * driver uses this call, make sure your disconnect() method can wait for it to
 * complete.  Since you don't have a handle on the URB used, you can't cancel
 * the request.
 *
 * Because there is no usb_interrupt_msg() and no USBDEVFS_INTERRUPT ioctl,
 * users are forced to abuse this routine by using it to submit URBs for
 * interrupt endpoints.  We will take the liberty of creating an interrupt URB
 * (with the default interval) if the target is an interrupt endpoint.
L
Linus Torvalds 已提交
221
 */
222 223
int usb_bulk_msg(struct usb_device *usb_dev, unsigned int pipe,
		 void *data, int len, int *actual_length, int timeout)
L
Linus Torvalds 已提交
224 225
{
	struct urb *urb;
226
	struct usb_host_endpoint *ep;
L
Linus Torvalds 已提交
227

228 229 230
	ep = (usb_pipein(pipe) ? usb_dev->ep_in : usb_dev->ep_out)
			[usb_pipeendpoint(pipe)];
	if (!ep || len < 0)
L
Linus Torvalds 已提交
231 232
		return -EINVAL;

233
	urb = usb_alloc_urb(0, GFP_KERNEL);
L
Linus Torvalds 已提交
234 235 236
	if (!urb)
		return -ENOMEM;

237 238 239 240
	if ((ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
			USB_ENDPOINT_XFER_INT) {
		pipe = (pipe & ~(3 << 30)) | (PIPE_INTERRUPT << 30);
		usb_fill_int_urb(urb, usb_dev, pipe, data, len,
241 242
				usb_api_blocking_completion, NULL,
				ep->desc.bInterval);
243 244 245
	} else
		usb_fill_bulk_urb(urb, usb_dev, pipe, data, len,
				usb_api_blocking_completion, NULL);
L
Linus Torvalds 已提交
246 247 248

	return usb_start_wait_urb(urb, timeout, actual_length);
}
249
EXPORT_SYMBOL_GPL(usb_bulk_msg);
L
Linus Torvalds 已提交
250 251 252

/*-------------------------------------------------------------------*/

253
static void sg_clean(struct usb_sg_request *io)
L
Linus Torvalds 已提交
254 255 256
{
	if (io->urbs) {
		while (io->entries--)
257 258
			usb_free_urb(io->urbs [io->entries]);
		kfree(io->urbs);
L
Linus Torvalds 已提交
259 260 261
		io->urbs = NULL;
	}
	if (io->dev->dev.dma_mask != NULL)
262 263
		usb_buffer_unmap_sg(io->dev, usb_pipein(io->pipe),
				    io->sg, io->nents);
L
Linus Torvalds 已提交
264 265 266
	io->dev = NULL;
}

267
static void sg_complete(struct urb *urb)
L
Linus Torvalds 已提交
268
{
269
	struct usb_sg_request *io = urb->context;
270
	int status = urb->status;
L
Linus Torvalds 已提交
271

272
	spin_lock(&io->lock);
L
Linus Torvalds 已提交
273 274 275 276 277 278 279 280 281 282 283 284 285

	/* In 2.5 we require hcds' endpoint queues not to progress after fault
	 * reports, until the completion callback (this!) returns.  That lets
	 * device driver code (like this routine) unlink queued urbs first,
	 * if it needs to, since the HC won't work on them at all.  So it's
	 * not possible for page N+1 to overwrite page N, and so on.
	 *
	 * That's only for "hard" faults; "soft" faults (unlinks) sometimes
	 * complete before the HCD can get requests away from hardware,
	 * though never during cleanup after a hard fault.
	 */
	if (io->status
			&& (io->status != -ECONNRESET
286
				|| status != -ECONNRESET)
L
Linus Torvalds 已提交
287
			&& urb->actual_length) {
288
		dev_err(io->dev->bus->controller,
L
Linus Torvalds 已提交
289 290
			"dev %s ep%d%s scatterlist error %d/%d\n",
			io->dev->devpath,
A
Alan Stern 已提交
291 292
			usb_endpoint_num(&urb->ep->desc),
			usb_urb_dir_in(urb) ? "in" : "out",
293
			status, io->status);
294
		/* BUG (); */
L
Linus Torvalds 已提交
295 296
	}

297 298
	if (io->status == 0 && status && status != -ECONNRESET) {
		int i, found, retval;
L
Linus Torvalds 已提交
299

300
		io->status = status;
L
Linus Torvalds 已提交
301 302 303 304 305

		/* the previous urbs, and this one, completed already.
		 * unlink pending urbs so they won't rx/tx bad data.
		 * careful: unlink can sometimes be synchronous...
		 */
306
		spin_unlock(&io->lock);
L
Linus Torvalds 已提交
307 308 309 310
		for (i = 0, found = 0; i < io->entries; i++) {
			if (!io->urbs [i] || !io->urbs [i]->dev)
				continue;
			if (found) {
311
				retval = usb_unlink_urb(io->urbs [i]);
312 313 314
				if (retval != -EINPROGRESS &&
				    retval != -ENODEV &&
				    retval != -EBUSY)
315
					dev_err(&io->dev->dev,
L
Linus Torvalds 已提交
316
						"%s, unlink --> %d\n",
317
						__func__, retval);
L
Linus Torvalds 已提交
318 319 320
			} else if (urb == io->urbs [i])
				found = 1;
		}
321
		spin_lock(&io->lock);
L
Linus Torvalds 已提交
322 323 324 325 326 327 328
	}
	urb->dev = NULL;

	/* on the last completion, signal usb_sg_wait() */
	io->bytes += urb->actual_length;
	io->count--;
	if (!io->count)
329
		complete(&io->complete);
L
Linus Torvalds 已提交
330

331
	spin_unlock(&io->lock);
L
Linus Torvalds 已提交
332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359
}


/**
 * usb_sg_init - initializes scatterlist-based bulk/interrupt I/O request
 * @io: request block being initialized.  until usb_sg_wait() returns,
 *	treat this as a pointer to an opaque block of memory,
 * @dev: the usb device that will send or receive the data
 * @pipe: endpoint "pipe" used to transfer the data
 * @period: polling rate for interrupt endpoints, in frames or
 * 	(for high speed endpoints) microframes; ignored for bulk
 * @sg: scatterlist entries
 * @nents: how many entries in the scatterlist
 * @length: how many bytes to send from the scatterlist, or zero to
 * 	send every byte identified in the list.
 * @mem_flags: SLAB_* flags affecting memory allocations in this call
 *
 * Returns zero for success, else a negative errno value.  This initializes a
 * scatter/gather request, allocating resources such as I/O mappings and urb
 * memory (except maybe memory used by USB controller drivers).
 *
 * The request must be issued using usb_sg_wait(), which waits for the I/O to
 * complete (or to be canceled) and then cleans up all resources allocated by
 * usb_sg_init().
 *
 * The request may be canceled with usb_sg_cancel(), either before or after
 * usb_sg_wait() is called.
 */
360 361 362
int usb_sg_init(struct usb_sg_request *io, struct usb_device *dev,
		unsigned pipe, unsigned	period, struct scatterlist *sg,
		int nents, size_t length, gfp_t mem_flags)
L
Linus Torvalds 已提交
363
{
364 365 366
	int i;
	int urb_flags;
	int dma;
L
Linus Torvalds 已提交
367 368

	if (!io || !dev || !sg
369 370
			|| usb_pipecontrol(pipe)
			|| usb_pipeisoc(pipe)
L
Linus Torvalds 已提交
371 372 373
			|| nents <= 0)
		return -EINVAL;

374
	spin_lock_init(&io->lock);
L
Linus Torvalds 已提交
375 376 377 378 379 380 381 382 383 384
	io->dev = dev;
	io->pipe = pipe;
	io->sg = sg;
	io->nents = nents;

	/* not all host controllers use DMA (like the mainstream pci ones);
	 * they can use PIO (sl811) or be software over another transport.
	 */
	dma = (dev->dev.dma_mask != NULL);
	if (dma)
A
Alan Stern 已提交
385
		io->entries = usb_buffer_map_sg(dev, usb_pipein(pipe),
386
						sg, nents);
L
Linus Torvalds 已提交
387 388 389 390 391 392 393
	else
		io->entries = nents;

	/* initialize all the urbs we'll use */
	if (io->entries <= 0)
		return io->entries;

394
	io->urbs = kmalloc(io->entries * sizeof *io->urbs, mem_flags);
L
Linus Torvalds 已提交
395 396 397
	if (!io->urbs)
		goto nomem;

398 399 400
	urb_flags = URB_NO_INTERRUPT;
	if (dma)
		urb_flags |= URB_NO_TRANSFER_DMA_MAP;
401
	if (usb_pipein(pipe))
L
Linus Torvalds 已提交
402 403
		urb_flags |= URB_SHORT_NOT_OK;

404
	for_each_sg(sg, sg, io->entries, i) {
405
		unsigned len;
L
Linus Torvalds 已提交
406

407 408
		io->urbs[i] = usb_alloc_urb(0, mem_flags);
		if (!io->urbs[i]) {
L
Linus Torvalds 已提交
409 410 411 412
			io->entries = i;
			goto nomem;
		}

413 414 415 416
		io->urbs[i]->dev = NULL;
		io->urbs[i]->pipe = pipe;
		io->urbs[i]->interval = period;
		io->urbs[i]->transfer_flags = urb_flags;
L
Linus Torvalds 已提交
417

418 419
		io->urbs[i]->complete = sg_complete;
		io->urbs[i]->context = io;
L
Linus Torvalds 已提交
420

421 422 423 424
		/*
		 * Some systems need to revert to PIO when DMA is temporarily
		 * unavailable.  For their sakes, both transfer_buffer and
		 * transfer_dma are set when possible.  However this can only
425 426 427 428 429 430 431 432 433 434
		 * work on systems without:
		 *
		 *  - HIGHMEM, since DMA buffers located in high memory are
		 *    not directly addressable by the CPU for PIO;
		 *
		 *  - IOMMU, since dma_map_sg() is allowed to use an IOMMU to
		 *    make virtually discontiguous buffers be "dma-contiguous"
		 *    so that PIO and DMA need diferent numbers of URBs.
		 *
		 * So when HIGHMEM or IOMMU are in use, transfer_buffer is NULL
435 436
		 * to prevent stale pointers and to help spot bugs.
		 */
L
Linus Torvalds 已提交
437
		if (dma) {
438 439
			io->urbs[i]->transfer_dma = sg_dma_address(sg);
			len = sg_dma_len(sg);
440
#if defined(CONFIG_HIGHMEM) || defined(CONFIG_GART_IOMMU)
441 442
			io->urbs[i]->transfer_buffer = NULL;
#else
443
			io->urbs[i]->transfer_buffer = sg_virt(sg);
444
#endif
L
Linus Torvalds 已提交
445 446
		} else {
			/* hc may use _only_ transfer_buffer */
447 448
			io->urbs[i]->transfer_buffer = sg_virt(sg);
			len = sg->length;
L
Linus Torvalds 已提交
449 450 451
		}

		if (length) {
452
			len = min_t(unsigned, len, length);
L
Linus Torvalds 已提交
453 454 455 456
			length -= len;
			if (length == 0)
				io->entries = i + 1;
		}
457
		io->urbs[i]->transfer_buffer_length = len;
L
Linus Torvalds 已提交
458
	}
459
	io->urbs[--i]->transfer_flags &= ~URB_NO_INTERRUPT;
L
Linus Torvalds 已提交
460 461

	/* transaction state */
462
	io->count = io->entries;
L
Linus Torvalds 已提交
463 464
	io->status = 0;
	io->bytes = 0;
465
	init_completion(&io->complete);
L
Linus Torvalds 已提交
466 467 468
	return 0;

nomem:
469
	sg_clean(io);
L
Linus Torvalds 已提交
470 471
	return -ENOMEM;
}
472
EXPORT_SYMBOL_GPL(usb_sg_init);
L
Linus Torvalds 已提交
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490

/**
 * usb_sg_wait - synchronously execute scatter/gather request
 * @io: request block handle, as initialized with usb_sg_init().
 * 	some fields become accessible when this call returns.
 * Context: !in_interrupt ()
 *
 * This function blocks until the specified I/O operation completes.  It
 * leverages the grouping of the related I/O requests to get good transfer
 * rates, by queueing the requests.  At higher speeds, such queuing can
 * significantly improve USB throughput.
 *
 * There are three kinds of completion for this function.
 * (1) success, where io->status is zero.  The number of io->bytes
 *     transferred is as requested.
 * (2) error, where io->status is a negative errno value.  The number
 *     of io->bytes transferred before the error is usually less
 *     than requested, and can be nonzero.
491
 * (3) cancellation, a type of error with status -ECONNRESET that
L
Linus Torvalds 已提交
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512
 *     is initiated by usb_sg_cancel().
 *
 * When this function returns, all memory allocated through usb_sg_init() or
 * this call will have been freed.  The request block parameter may still be
 * passed to usb_sg_cancel(), or it may be freed.  It could also be
 * reinitialized and then reused.
 *
 * Data Transfer Rates:
 *
 * Bulk transfers are valid for full or high speed endpoints.
 * The best full speed data rate is 19 packets of 64 bytes each
 * per frame, or 1216 bytes per millisecond.
 * The best high speed data rate is 13 packets of 512 bytes each
 * per microframe, or 52 KBytes per millisecond.
 *
 * The reason to use interrupt transfers through this API would most likely
 * be to reserve high speed bandwidth, where up to 24 KBytes per millisecond
 * could be transferred.  That capability is less useful for low or full
 * speed interrupt endpoints, which allow at most one packet per millisecond,
 * of at most 8 or 64 bytes (respectively).
 */
513
void usb_sg_wait(struct usb_sg_request *io)
L
Linus Torvalds 已提交
514
{
515 516
	int i;
	int entries = io->entries;
L
Linus Torvalds 已提交
517 518

	/* queue the urbs.  */
519
	spin_lock_irq(&io->lock);
520 521
	i = 0;
	while (i < entries && !io->status) {
522
		int retval;
L
Linus Torvalds 已提交
523

524 525
		io->urbs[i]->dev = io->dev;
		retval = usb_submit_urb(io->urbs [i], GFP_ATOMIC);
L
Linus Torvalds 已提交
526 527 528 529

		/* after we submit, let completions or cancelations fire;
		 * we handshake using io->status.
		 */
530
		spin_unlock_irq(&io->lock);
L
Linus Torvalds 已提交
531 532
		switch (retval) {
			/* maybe we retrying will recover */
533
		case -ENXIO:	/* hc didn't queue this one */
L
Linus Torvalds 已提交
534 535 536 537
		case -EAGAIN:
		case -ENOMEM:
			io->urbs[i]->dev = NULL;
			retval = 0;
538
			yield();
L
Linus Torvalds 已提交
539 540 541 542 543 544 545 546 547
			break;

			/* no error? continue immediately.
			 *
			 * NOTE: to work better with UHCI (4K I/O buffer may
			 * need 3K of TDs) it may be good to limit how many
			 * URBs are queued at once; N milliseconds?
			 */
		case 0:
548
			++i;
549
			cpu_relax();
L
Linus Torvalds 已提交
550 551 552 553
			break;

			/* fail any uncompleted urbs */
		default:
554 555 556
			io->urbs[i]->dev = NULL;
			io->urbs[i]->status = retval;
			dev_dbg(&io->dev->dev, "%s, submit --> %d\n",
557
				__func__, retval);
558
			usb_sg_cancel(io);
L
Linus Torvalds 已提交
559
		}
560
		spin_lock_irq(&io->lock);
L
Linus Torvalds 已提交
561 562 563 564 565
		if (retval && (io->status == 0 || io->status == -ECONNRESET))
			io->status = retval;
	}
	io->count -= entries - i;
	if (io->count == 0)
566 567
		complete(&io->complete);
	spin_unlock_irq(&io->lock);
L
Linus Torvalds 已提交
568 569 570 571 572

	/* OK, yes, this could be packaged as non-blocking.
	 * So could the submit loop above ... but it's easier to
	 * solve neither problem than to solve both!
	 */
573
	wait_for_completion(&io->complete);
L
Linus Torvalds 已提交
574

575
	sg_clean(io);
L
Linus Torvalds 已提交
576
}
577
EXPORT_SYMBOL_GPL(usb_sg_wait);
L
Linus Torvalds 已提交
578 579 580 581 582 583 584 585 586

/**
 * usb_sg_cancel - stop scatter/gather i/o issued by usb_sg_wait()
 * @io: request block, initialized with usb_sg_init()
 *
 * This stops a request after it has been started by usb_sg_wait().
 * It can also prevents one initialized by usb_sg_init() from starting,
 * so that call just frees resources allocated to the request.
 */
587
void usb_sg_cancel(struct usb_sg_request *io)
L
Linus Torvalds 已提交
588
{
589
	unsigned long flags;
L
Linus Torvalds 已提交
590

591
	spin_lock_irqsave(&io->lock, flags);
L
Linus Torvalds 已提交
592 593 594

	/* shut everything down, if it didn't already */
	if (!io->status) {
595
		int i;
L
Linus Torvalds 已提交
596 597

		io->status = -ECONNRESET;
598
		spin_unlock(&io->lock);
L
Linus Torvalds 已提交
599
		for (i = 0; i < io->entries; i++) {
600
			int retval;
L
Linus Torvalds 已提交
601 602 603

			if (!io->urbs [i]->dev)
				continue;
604
			retval = usb_unlink_urb(io->urbs [i]);
L
Linus Torvalds 已提交
605
			if (retval != -EINPROGRESS && retval != -EBUSY)
606
				dev_warn(&io->dev->dev, "%s, unlink --> %d\n",
607
					__func__, retval);
L
Linus Torvalds 已提交
608
		}
609
		spin_lock(&io->lock);
L
Linus Torvalds 已提交
610
	}
611
	spin_unlock_irqrestore(&io->lock, flags);
L
Linus Torvalds 已提交
612
}
613
EXPORT_SYMBOL_GPL(usb_sg_cancel);
L
Linus Torvalds 已提交
614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638

/*-------------------------------------------------------------------*/

/**
 * usb_get_descriptor - issues a generic GET_DESCRIPTOR request
 * @dev: the device whose descriptor is being retrieved
 * @type: the descriptor type (USB_DT_*)
 * @index: the number of the descriptor
 * @buf: where to put the descriptor
 * @size: how big is "buf"?
 * Context: !in_interrupt ()
 *
 * Gets a USB descriptor.  Convenience functions exist to simplify
 * getting some types of descriptors.  Use
 * usb_get_string() or usb_string() for USB_DT_STRING.
 * Device (USB_DT_DEVICE) and configuration descriptors (USB_DT_CONFIG)
 * are part of the device structure.
 * In addition to a number of USB-standard descriptors, some
 * devices also use class-specific or vendor-specific descriptors.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns the number of bytes received on success, or else the status code
 * returned by the underlying usb_control_msg() call.
 */
639 640
int usb_get_descriptor(struct usb_device *dev, unsigned char type,
		       unsigned char index, void *buf, int size)
L
Linus Torvalds 已提交
641 642 643
{
	int i;
	int result;
644 645

	memset(buf, 0, size);	/* Make sure we parse really received data */
L
Linus Torvalds 已提交
646 647

	for (i = 0; i < 3; ++i) {
648
		/* retry on length 0 or error; some devices are flakey */
L
Linus Torvalds 已提交
649 650 651 652
		result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
				USB_REQ_GET_DESCRIPTOR, USB_DIR_IN,
				(type << 8) + index, 0, buf, size,
				USB_CTRL_GET_TIMEOUT);
653
		if (result <= 0 && result != -ETIMEDOUT)
L
Linus Torvalds 已提交
654 655
			continue;
		if (result > 1 && ((u8 *)buf)[1] != type) {
656
			result = -ENODATA;
L
Linus Torvalds 已提交
657 658 659 660 661 662
			continue;
		}
		break;
	}
	return result;
}
663
EXPORT_SYMBOL_GPL(usb_get_descriptor);
L
Linus Torvalds 已提交
664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686

/**
 * usb_get_string - gets a string descriptor
 * @dev: the device whose string descriptor is being retrieved
 * @langid: code for language chosen (from string descriptor zero)
 * @index: the number of the descriptor
 * @buf: where to put the string
 * @size: how big is "buf"?
 * Context: !in_interrupt ()
 *
 * Retrieves a string, encoded using UTF-16LE (Unicode, 16 bits per character,
 * in little-endian byte order).
 * The usb_string() function will often be a convenient way to turn
 * these strings into kernel-printable form.
 *
 * Strings may be referenced in device, configuration, interface, or other
 * descriptors, and could also be used in vendor-specific ways.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns the number of bytes received on success, or else the status code
 * returned by the underlying usb_control_msg() call.
 */
687 688
static int usb_get_string(struct usb_device *dev, unsigned short langid,
			  unsigned char index, void *buf, int size)
L
Linus Torvalds 已提交
689 690 691 692 693 694 695 696 697 698
{
	int i;
	int result;

	for (i = 0; i < 3; ++i) {
		/* retry on length 0 or stall; some devices are flakey */
		result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
			USB_REQ_GET_DESCRIPTOR, USB_DIR_IN,
			(USB_DT_STRING << 8) + index, langid, buf, size,
			USB_CTRL_GET_TIMEOUT);
699 700 701 702 703 704 705
		if (result == 0 || result == -EPIPE)
			continue;
		if (result > 1 && ((u8 *) buf)[1] != USB_DT_STRING) {
			result = -ENODATA;
			continue;
		}
		break;
L
Linus Torvalds 已提交
706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724
	}
	return result;
}

static void usb_try_string_workarounds(unsigned char *buf, int *length)
{
	int newlength, oldlength = *length;

	for (newlength = 2; newlength + 1 < oldlength; newlength += 2)
		if (!isprint(buf[newlength]) || buf[newlength + 1])
			break;

	if (newlength > 2) {
		buf[0] = newlength;
		*length = newlength;
	}
}

static int usb_string_sub(struct usb_device *dev, unsigned int langid,
725
			  unsigned int index, unsigned char *buf)
L
Linus Torvalds 已提交
726 727 728 729 730
{
	int rc;

	/* Try to read the string descriptor by asking for the maximum
	 * possible number of bytes */
731 732 733 734
	if (dev->quirks & USB_QUIRK_STRING_FETCH_255)
		rc = -EIO;
	else
		rc = usb_get_string(dev, langid, index, buf, 255);
L
Linus Torvalds 已提交
735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767

	/* If that failed try to read the descriptor length, then
	 * ask for just that many bytes */
	if (rc < 2) {
		rc = usb_get_string(dev, langid, index, buf, 2);
		if (rc == 2)
			rc = usb_get_string(dev, langid, index, buf, buf[0]);
	}

	if (rc >= 2) {
		if (!buf[0] && !buf[1])
			usb_try_string_workarounds(buf, &rc);

		/* There might be extra junk at the end of the descriptor */
		if (buf[0] < rc)
			rc = buf[0];

		rc = rc - (rc & 1); /* force a multiple of two */
	}

	if (rc < 2)
		rc = (rc < 0 ? rc : -EINVAL);

	return rc;
}

/**
 * usb_string - returns ISO 8859-1 version of a string descriptor
 * @dev: the device whose string descriptor is being retrieved
 * @index: the number of the descriptor
 * @buf: where to put the string
 * @size: how big is "buf"?
 * Context: !in_interrupt ()
768
 *
L
Linus Torvalds 已提交
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
 * This converts the UTF-16LE encoded strings returned by devices, from
 * usb_get_string_descriptor(), to null-terminated ISO-8859-1 encoded ones
 * that are more usable in most kernel contexts.  Note that all characters
 * in the chosen descriptor that can't be encoded using ISO-8859-1
 * are converted to the question mark ("?") character, and this function
 * chooses strings in the first language supported by the device.
 *
 * The ASCII (or, redundantly, "US-ASCII") character set is the seven-bit
 * subset of ISO 8859-1. ISO-8859-1 is the eight-bit subset of Unicode,
 * and is appropriate for use many uses of English and several other
 * Western European languages.  (But it doesn't include the "Euro" symbol.)
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns length of the string (>= 0) or usb_control_msg status (< 0).
 */
int usb_string(struct usb_device *dev, int index, char *buf, size_t size)
{
	unsigned char *tbuf;
	int err;
	unsigned int u, idx;

	if (dev->state == USB_STATE_SUSPENDED)
		return -EHOSTUNREACH;
	if (size <= 0 || !buf || !index)
		return -EINVAL;
	buf[0] = 0;
796
	tbuf = kmalloc(256, GFP_NOIO);
L
Linus Torvalds 已提交
797 798 799 800 801 802 803
	if (!tbuf)
		return -ENOMEM;

	/* get langid for strings if it's not yet known */
	if (!dev->have_langid) {
		err = usb_string_sub(dev, 0, 0, tbuf);
		if (err < 0) {
804
			dev_err(&dev->dev,
L
Linus Torvalds 已提交
805 806 807
				"string descriptor 0 read error: %d\n",
				err);
		} else if (err < 4) {
808
			dev_err(&dev->dev, "string descriptor 0 too short\n");
L
Linus Torvalds 已提交
809
		} else {
810 811 812
			dev->string_langid = tbuf[2] | (tbuf[3] << 8);
			/* always use the first langid listed */
			dev_dbg(&dev->dev, "default language 0x%04x\n",
L
Linus Torvalds 已提交
813 814
				dev->string_langid);
		}
815 816

		dev->have_langid = 1;
L
Linus Torvalds 已提交
817
	}
818

L
Linus Torvalds 已提交
819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835
	err = usb_string_sub(dev, dev->string_langid, index, tbuf);
	if (err < 0)
		goto errout;

	size--;		/* leave room for trailing NULL char in output buffer */
	for (idx = 0, u = 2; u < err; u += 2) {
		if (idx >= size)
			break;
		if (tbuf[u+1])			/* high byte */
			buf[idx++] = '?';  /* non ISO-8859-1 character */
		else
			buf[idx++] = tbuf[u];
	}
	buf[idx] = 0;
	err = idx;

	if (tbuf[1] != USB_DT_STRING)
836 837 838
		dev_dbg(&dev->dev,
			"wrong descriptor type %02x for string %d (\"%s\")\n",
			tbuf[1], index, buf);
L
Linus Torvalds 已提交
839 840 841 842 843

 errout:
	kfree(tbuf);
	return err;
}
844
EXPORT_SYMBOL_GPL(usb_string);
L
Linus Torvalds 已提交
845

846 847 848 849 850 851 852 853 854 855 856 857 858 859
/**
 * usb_cache_string - read a string descriptor and cache it for later use
 * @udev: the device whose string descriptor is being read
 * @index: the descriptor index
 *
 * Returns a pointer to a kmalloc'ed buffer containing the descriptor string,
 * or NULL if the index is 0 or the string could not be read.
 */
char *usb_cache_string(struct usb_device *udev, int index)
{
	char *buf;
	char *smallbuf = NULL;
	int len;

860 861 862 863 864 865 866 867 868
	if (index <= 0)
		return NULL;

	buf = kmalloc(256, GFP_KERNEL);
	if (buf) {
		len = usb_string(udev, index, buf, 256);
		if (len > 0) {
			smallbuf = kmalloc(++len, GFP_KERNEL);
			if (!smallbuf)
869 870 871 872 873 874 875 876
				return buf;
			memcpy(smallbuf, buf, len);
		}
		kfree(buf);
	}
	return smallbuf;
}

L
Linus Torvalds 已提交
877 878 879 880 881 882 883
/*
 * usb_get_device_descriptor - (re)reads the device descriptor (usbcore)
 * @dev: the device whose device descriptor is being updated
 * @size: how much of the descriptor to read
 * Context: !in_interrupt ()
 *
 * Updates the copy of the device descriptor stored in the device structure,
884
 * which dedicates space for this purpose.
L
Linus Torvalds 已提交
885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906
 *
 * Not exported, only for use by the core.  If drivers really want to read
 * the device descriptor directly, they can call usb_get_descriptor() with
 * type = USB_DT_DEVICE and index = 0.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns the number of bytes received on success, or else the status code
 * returned by the underlying usb_control_msg() call.
 */
int usb_get_device_descriptor(struct usb_device *dev, unsigned int size)
{
	struct usb_device_descriptor *desc;
	int ret;

	if (size > sizeof(*desc))
		return -EINVAL;
	desc = kmalloc(sizeof(*desc), GFP_NOIO);
	if (!desc)
		return -ENOMEM;

	ret = usb_get_descriptor(dev, USB_DT_DEVICE, 0, desc, size);
907
	if (ret >= 0)
L
Linus Torvalds 已提交
908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950
		memcpy(&dev->descriptor, desc, size);
	kfree(desc);
	return ret;
}

/**
 * usb_get_status - issues a GET_STATUS call
 * @dev: the device whose status is being checked
 * @type: USB_RECIP_*; for device, interface, or endpoint
 * @target: zero (for device), else interface or endpoint number
 * @data: pointer to two bytes of bitmap data
 * Context: !in_interrupt ()
 *
 * Returns device, interface, or endpoint status.  Normally only of
 * interest to see if the device is self powered, or has enabled the
 * remote wakeup facility; or whether a bulk or interrupt endpoint
 * is halted ("stalled").
 *
 * Bits in these status bitmaps are set using the SET_FEATURE request,
 * and cleared using the CLEAR_FEATURE request.  The usb_clear_halt()
 * function should be used to clear halt ("stall") status.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns the number of bytes received on success, or else the status code
 * returned by the underlying usb_control_msg() call.
 */
int usb_get_status(struct usb_device *dev, int type, int target, void *data)
{
	int ret;
	u16 *status = kmalloc(sizeof(*status), GFP_KERNEL);

	if (!status)
		return -ENOMEM;

	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
		USB_REQ_GET_STATUS, USB_DIR_IN | type, 0, target, status,
		sizeof(*status), USB_CTRL_GET_TIMEOUT);

	*(u16 *)data = *status;
	kfree(status);
	return ret;
}
951
EXPORT_SYMBOL_GPL(usb_get_status);
L
Linus Torvalds 已提交
952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979

/**
 * usb_clear_halt - tells device to clear endpoint halt/stall condition
 * @dev: device whose endpoint is halted
 * @pipe: endpoint "pipe" being cleared
 * Context: !in_interrupt ()
 *
 * This is used to clear halt conditions for bulk and interrupt endpoints,
 * as reported by URB completion status.  Endpoints that are halted are
 * sometimes referred to as being "stalled".  Such endpoints are unable
 * to transmit or receive data until the halt status is cleared.  Any URBs
 * queued for such an endpoint should normally be unlinked by the driver
 * before clearing the halt condition, as described in sections 5.7.5
 * and 5.8.5 of the USB 2.0 spec.
 *
 * Note that control and isochronous endpoints don't halt, although control
 * endpoints report "protocol stall" (for unsupported requests) using the
 * same status code used to report a true stall.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 *
 * Returns zero on success, or else the status code returned by the
 * underlying usb_control_msg() call.
 */
int usb_clear_halt(struct usb_device *dev, int pipe)
{
	int result;
	int endp = usb_pipeendpoint(pipe);
980 981

	if (usb_pipein(pipe))
L
Linus Torvalds 已提交
982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
		endp |= USB_DIR_IN;

	/* we don't care if it wasn't halted first. in fact some devices
	 * (like some ibmcam model 1 units) seem to expect hosts to make
	 * this request for iso endpoints, which can't halt!
	 */
	result = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
		USB_REQ_CLEAR_FEATURE, USB_RECIP_ENDPOINT,
		USB_ENDPOINT_HALT, endp, NULL, 0,
		USB_CTRL_SET_TIMEOUT);

	/* don't un-halt or force to DATA0 except on success */
	if (result < 0)
		return result;

	/* NOTE:  seems like Microsoft and Apple don't bother verifying
	 * the clear "took", so some devices could lock up if you check...
	 * such as the Hagiwara FlashGate DUAL.  So we won't bother.
	 *
	 * NOTE:  make sure the logic here doesn't diverge much from
	 * the copy in usb-storage, for as long as we need two copies.
	 */

1005
	usb_reset_endpoint(dev, endp);
L
Linus Torvalds 已提交
1006 1007 1008

	return 0;
}
1009
EXPORT_SYMBOL_GPL(usb_clear_halt);
L
Linus Torvalds 已提交
1010

A
Alan Stern 已提交
1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038
static int create_intf_ep_devs(struct usb_interface *intf)
{
	struct usb_device *udev = interface_to_usbdev(intf);
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	if (intf->ep_devs_created || intf->unregistering)
		return 0;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i)
		(void) usb_create_ep_devs(&intf->dev, &alt->endpoint[i], udev);
	intf->ep_devs_created = 1;
	return 0;
}

static void remove_intf_ep_devs(struct usb_interface *intf)
{
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	if (!intf->ep_devs_created)
		return;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i)
		usb_remove_ep_devs(&alt->endpoint[i]);
	intf->ep_devs_created = 0;
}

L
Linus Torvalds 已提交
1039 1040 1041 1042 1043
/**
 * usb_disable_endpoint -- Disable an endpoint by address
 * @dev: the device whose endpoint is being disabled
 * @epaddr: the endpoint's address.  Endpoint number for output,
 *	endpoint number + USB_DIR_IN for input
1044 1045
 * @reset_hardware: flag to erase any endpoint state stored in the
 *	controller hardware
L
Linus Torvalds 已提交
1046
 *
1047 1048 1049
 * Disables the endpoint for URB submission and nukes all pending URBs.
 * If @reset_hardware is set then also deallocates hcd/hardware state
 * for the endpoint.
L
Linus Torvalds 已提交
1050
 */
1051 1052
void usb_disable_endpoint(struct usb_device *dev, unsigned int epaddr,
		bool reset_hardware)
L
Linus Torvalds 已提交
1053 1054 1055 1056 1057 1058 1059 1060 1061
{
	unsigned int epnum = epaddr & USB_ENDPOINT_NUMBER_MASK;
	struct usb_host_endpoint *ep;

	if (!dev)
		return;

	if (usb_endpoint_out(epaddr)) {
		ep = dev->ep_out[epnum];
1062 1063
		if (reset_hardware)
			dev->ep_out[epnum] = NULL;
L
Linus Torvalds 已提交
1064 1065
	} else {
		ep = dev->ep_in[epnum];
1066 1067
		if (reset_hardware)
			dev->ep_in[epnum] = NULL;
L
Linus Torvalds 已提交
1068
	}
A
Alan Stern 已提交
1069 1070
	if (ep) {
		ep->enabled = 0;
1071
		usb_hcd_flush_endpoint(dev, ep);
1072 1073
		if (reset_hardware)
			usb_hcd_disable_endpoint(dev, ep);
A
Alan Stern 已提交
1074
	}
L
Linus Torvalds 已提交
1075 1076
}

1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100
/**
 * usb_reset_endpoint - Reset an endpoint's state.
 * @dev: the device whose endpoint is to be reset
 * @epaddr: the endpoint's address.  Endpoint number for output,
 *	endpoint number + USB_DIR_IN for input
 *
 * Resets any host-side endpoint state such as the toggle bit,
 * sequence number or current window.
 */
void usb_reset_endpoint(struct usb_device *dev, unsigned int epaddr)
{
	unsigned int epnum = epaddr & USB_ENDPOINT_NUMBER_MASK;
	struct usb_host_endpoint *ep;

	if (usb_endpoint_out(epaddr))
		ep = dev->ep_out[epnum];
	else
		ep = dev->ep_in[epnum];
	if (ep)
		usb_hcd_reset_endpoint(dev, ep);
}
EXPORT_SYMBOL_GPL(usb_reset_endpoint);


L
Linus Torvalds 已提交
1101 1102 1103 1104
/**
 * usb_disable_interface -- Disable all endpoints for an interface
 * @dev: the device whose interface is being disabled
 * @intf: pointer to the interface descriptor
1105 1106
 * @reset_hardware: flag to erase any endpoint state stored in the
 *	controller hardware
L
Linus Torvalds 已提交
1107 1108 1109
 *
 * Disables all the endpoints for the interface's current altsetting.
 */
1110 1111
void usb_disable_interface(struct usb_device *dev, struct usb_interface *intf,
		bool reset_hardware)
L
Linus Torvalds 已提交
1112 1113 1114 1115 1116 1117
{
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i) {
		usb_disable_endpoint(dev,
1118 1119
				alt->endpoint[i].desc.bEndpointAddress,
				reset_hardware);
L
Linus Torvalds 已提交
1120 1121 1122
	}
}

1123
/**
L
Linus Torvalds 已提交
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
 * usb_disable_device - Disable all the endpoints for a USB device
 * @dev: the device whose endpoints are being disabled
 * @skip_ep0: 0 to disable endpoint 0, 1 to skip it.
 *
 * Disables all the device's endpoints, potentially including endpoint 0.
 * Deallocates hcd/hardware state for the endpoints (nuking all or most
 * pending urbs) and usbcore state for the interfaces, so that usbcore
 * must usb_set_configuration() before any interfaces could be used.
 */
void usb_disable_device(struct usb_device *dev, int skip_ep0)
{
	int i;

1137
	dev_dbg(&dev->dev, "%s nuking %s URBs\n", __func__,
1138
		skip_ep0 ? "non-ep0" : "all");
L
Linus Torvalds 已提交
1139
	for (i = skip_ep0; i < 16; ++i) {
1140 1141
		usb_disable_endpoint(dev, i, true);
		usb_disable_endpoint(dev, i + USB_DIR_IN, true);
L
Linus Torvalds 已提交
1142 1143 1144 1145 1146 1147 1148 1149 1150
	}

	/* getting rid of interfaces will disconnect
	 * any drivers bound to them (a key side effect)
	 */
	if (dev->actconfig) {
		for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
			struct usb_interface	*interface;

1151
			/* remove this interface if it has been registered */
L
Linus Torvalds 已提交
1152
			interface = dev->actconfig->interface[i];
1153
			if (!device_is_registered(&interface->dev))
1154
				continue;
1155
			dev_dbg(&dev->dev, "unregistering interface %s\n",
1156
				dev_name(&interface->dev));
1157
			interface->unregistering = 1;
A
Alan Stern 已提交
1158
			remove_intf_ep_devs(interface);
1159
			device_del(&interface->dev);
L
Linus Torvalds 已提交
1160 1161 1162 1163 1164 1165
		}

		/* Now that the interfaces are unbound, nobody should
		 * try to access them.
		 */
		for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
1166
			put_device(&dev->actconfig->interface[i]->dev);
L
Linus Torvalds 已提交
1167 1168 1169 1170 1171 1172 1173 1174
			dev->actconfig->interface[i] = NULL;
		}
		dev->actconfig = NULL;
		if (dev->state == USB_STATE_CONFIGURED)
			usb_set_device_state(dev, USB_STATE_ADDRESS);
	}
}

1175
/**
L
Linus Torvalds 已提交
1176 1177 1178
 * usb_enable_endpoint - Enable an endpoint for USB communications
 * @dev: the device whose interface is being enabled
 * @ep: the endpoint
1179
 * @reset_ep: flag to reset the endpoint state
L
Linus Torvalds 已提交
1180
 *
1181
 * Resets the endpoint state if asked, and sets dev->ep_{in,out} pointers.
L
Linus Torvalds 已提交
1182 1183
 * For control endpoints, both the input and output sides are handled.
 */
1184
void usb_enable_endpoint(struct usb_device *dev, struct usb_host_endpoint *ep,
1185
		bool reset_ep)
L
Linus Torvalds 已提交
1186
{
A
Alan Stern 已提交
1187 1188 1189
	int epnum = usb_endpoint_num(&ep->desc);
	int is_out = usb_endpoint_dir_out(&ep->desc);
	int is_control = usb_endpoint_xfer_control(&ep->desc);
L
Linus Torvalds 已提交
1190

1191 1192 1193
	if (reset_ep)
		usb_hcd_reset_endpoint(dev, ep);
	if (is_out || is_control)
L
Linus Torvalds 已提交
1194
		dev->ep_out[epnum] = ep;
1195
	if (!is_out || is_control)
L
Linus Torvalds 已提交
1196
		dev->ep_in[epnum] = ep;
A
Alan Stern 已提交
1197
	ep->enabled = 1;
L
Linus Torvalds 已提交
1198 1199
}

1200
/**
L
Linus Torvalds 已提交
1201 1202 1203
 * usb_enable_interface - Enable all the endpoints for an interface
 * @dev: the device whose interface is being enabled
 * @intf: pointer to the interface descriptor
1204
 * @reset_eps: flag to reset the endpoints' state
L
Linus Torvalds 已提交
1205 1206 1207
 *
 * Enables all the endpoints for the interface's current altsetting.
 */
1208
void usb_enable_interface(struct usb_device *dev,
1209
		struct usb_interface *intf, bool reset_eps)
L
Linus Torvalds 已提交
1210 1211 1212 1213 1214
{
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i)
1215
		usb_enable_endpoint(dev, &alt->endpoint[i], reset_eps);
L
Linus Torvalds 已提交
1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256
}

/**
 * usb_set_interface - Makes a particular alternate setting be current
 * @dev: the device whose interface is being updated
 * @interface: the interface being updated
 * @alternate: the setting being chosen.
 * Context: !in_interrupt ()
 *
 * This is used to enable data transfers on interfaces that may not
 * be enabled by default.  Not all devices support such configurability.
 * Only the driver bound to an interface may change its setting.
 *
 * Within any given configuration, each interface may have several
 * alternative settings.  These are often used to control levels of
 * bandwidth consumption.  For example, the default setting for a high
 * speed interrupt endpoint may not send more than 64 bytes per microframe,
 * while interrupt transfers of up to 3KBytes per microframe are legal.
 * Also, isochronous endpoints may never be part of an
 * interface's default setting.  To access such bandwidth, alternate
 * interface settings must be made current.
 *
 * Note that in the Linux USB subsystem, bandwidth associated with
 * an endpoint in a given alternate setting is not reserved until an URB
 * is submitted that needs that bandwidth.  Some other operating systems
 * allocate bandwidth early, when a configuration is chosen.
 *
 * This call is synchronous, and may not be used in an interrupt context.
 * Also, drivers must not change altsettings while urbs are scheduled for
 * endpoints in that interface; all such urbs must first be completed
 * (perhaps forced by unlinking).
 *
 * Returns zero on success, or else the status code returned by the
 * underlying usb_control_msg() call.
 */
int usb_set_interface(struct usb_device *dev, int interface, int alternate)
{
	struct usb_interface *iface;
	struct usb_host_interface *alt;
	int ret;
	int manual = 0;
1257 1258
	unsigned int epaddr;
	unsigned int pipe;
L
Linus Torvalds 已提交
1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271

	if (dev->state == USB_STATE_SUSPENDED)
		return -EHOSTUNREACH;

	iface = usb_ifnum_to_if(dev, interface);
	if (!iface) {
		dev_dbg(&dev->dev, "selecting invalid interface %d\n",
			interface);
		return -EINVAL;
	}

	alt = usb_altnum_to_altsetting(iface, alternate);
	if (!alt) {
1272 1273
		dev_warn(&dev->dev, "selecting invalid altsetting %d",
			 alternate);
L
Linus Torvalds 已提交
1274 1275 1276
		return -EINVAL;
	}

1277 1278 1279 1280
	if (dev->quirks & USB_QUIRK_NO_SET_INTF)
		ret = -EPIPE;
	else
		ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
L
Linus Torvalds 已提交
1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301
				   USB_REQ_SET_INTERFACE, USB_RECIP_INTERFACE,
				   alternate, interface, NULL, 0, 5000);

	/* 9.4.10 says devices don't need this and are free to STALL the
	 * request if the interface only has one alternate setting.
	 */
	if (ret == -EPIPE && iface->num_altsetting == 1) {
		dev_dbg(&dev->dev,
			"manual set_interface for iface %d, alt %d\n",
			interface, alternate);
		manual = 1;
	} else if (ret < 0)
		return ret;

	/* FIXME drivers shouldn't need to replicate/bugfix the logic here
	 * when they implement async or easily-killable versions of this or
	 * other "should-be-internal" functions (like clear_halt).
	 * should hcd+usbcore postprocess control requests?
	 */

	/* prevent submissions using previous endpoint settings */
A
Alan Stern 已提交
1302 1303
	if (iface->cur_altsetting != alt) {
		remove_intf_ep_devs(iface);
1304
		usb_remove_sysfs_intf_files(iface);
A
Alan Stern 已提交
1305
	}
1306
	usb_disable_interface(dev, iface, true);
L
Linus Torvalds 已提交
1307 1308 1309 1310

	iface->cur_altsetting = alt;

	/* If the interface only has one altsetting and the device didn't
1311
	 * accept the request, we attempt to carry out the equivalent action
L
Linus Torvalds 已提交
1312 1313 1314 1315 1316 1317 1318
	 * by manually clearing the HALT feature for each endpoint in the
	 * new altsetting.
	 */
	if (manual) {
		int i;

		for (i = 0; i < alt->desc.bNumEndpoints; i++) {
1319 1320 1321 1322 1323
			epaddr = alt->endpoint[i].desc.bEndpointAddress;
			pipe = __create_pipe(dev,
					USB_ENDPOINT_NUMBER_MASK & epaddr) |
					(usb_endpoint_out(epaddr) ?
					USB_DIR_OUT : USB_DIR_IN);
L
Linus Torvalds 已提交
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339

			usb_clear_halt(dev, pipe);
		}
	}

	/* 9.1.1.5: reset toggles for all endpoints in the new altsetting
	 *
	 * Note:
	 * Despite EP0 is always present in all interfaces/AS, the list of
	 * endpoints from the descriptor does not contain EP0. Due to its
	 * omnipresence one might expect EP0 being considered "affected" by
	 * any SetInterface request and hence assume toggles need to be reset.
	 * However, EP0 toggles are re-synced for every individual transfer
	 * during the SETUP stage - hence EP0 toggles are "don't care" here.
	 * (Likewise, EP0 never "halts" on well designed devices.)
	 */
1340
	usb_enable_interface(dev, iface, true);
A
Alan Stern 已提交
1341
	if (device_is_registered(&iface->dev)) {
1342
		usb_create_sysfs_intf_files(iface);
A
Alan Stern 已提交
1343 1344
		create_intf_ep_devs(iface);
	}
L
Linus Torvalds 已提交
1345 1346
	return 0;
}
1347
EXPORT_SYMBOL_GPL(usb_set_interface);
L
Linus Torvalds 已提交
1348 1349 1350 1351 1352 1353 1354 1355

/**
 * usb_reset_configuration - lightweight device reset
 * @dev: the device whose configuration is being reset
 *
 * This issues a standard SET_CONFIGURATION request to the device using
 * the current configuration.  The effect is to reset most USB-related
 * state in the device, including interface altsettings (reset to zero),
1356
 * endpoint halts (cleared), and endpoint state (only for bulk and interrupt
L
Linus Torvalds 已提交
1357 1358 1359 1360 1361
 * endpoints).  Other usbcore state is unchanged, including bindings of
 * usb device drivers to interfaces.
 *
 * Because this affects multiple interfaces, avoid using this with composite
 * (multi-interface) devices.  Instead, the driver for each interface may
1362 1363
 * use usb_set_interface() on the interfaces it claims.  Be careful though;
 * some devices don't support the SET_INTERFACE request, and others won't
1364
 * reset all the interface state (notably endpoint state).  Resetting the whole
L
Linus Torvalds 已提交
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384
 * configuration would affect other drivers' interfaces.
 *
 * The caller must own the device lock.
 *
 * Returns zero on success, else a negative error code.
 */
int usb_reset_configuration(struct usb_device *dev)
{
	int			i, retval;
	struct usb_host_config	*config;

	if (dev->state == USB_STATE_SUSPENDED)
		return -EHOSTUNREACH;

	/* caller must have locked the device and must own
	 * the usb bus readlock (so driver bindings are stable);
	 * calls during probe() are fine
	 */

	for (i = 1; i < 16; ++i) {
1385 1386
		usb_disable_endpoint(dev, i, true);
		usb_disable_endpoint(dev, i + USB_DIR_IN, true);
L
Linus Torvalds 已提交
1387 1388 1389 1390 1391 1392 1393
	}

	config = dev->actconfig;
	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
			USB_REQ_SET_CONFIGURATION, 0,
			config->desc.bConfigurationValue, 0,
			NULL, 0, USB_CTRL_SET_TIMEOUT);
1394
	if (retval < 0)
L
Linus Torvalds 已提交
1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411
		return retval;

	/* re-init hc/hcd interface/endpoint state */
	for (i = 0; i < config->desc.bNumInterfaces; i++) {
		struct usb_interface *intf = config->interface[i];
		struct usb_host_interface *alt;

		alt = usb_altnum_to_altsetting(intf, 0);

		/* No altsetting 0?  We'll assume the first altsetting.
		 * We could use a GetInterface call, but if a device is
		 * so non-compliant that it doesn't have altsetting 0
		 * then I wouldn't trust its reply anyway.
		 */
		if (!alt)
			alt = &intf->altsetting[0];

A
Alan Stern 已提交
1412 1413 1414 1415
		if (alt != intf->cur_altsetting) {
			remove_intf_ep_devs(intf);
			usb_remove_sysfs_intf_files(intf);
		}
L
Linus Torvalds 已提交
1416
		intf->cur_altsetting = alt;
1417
		usb_enable_interface(dev, intf, true);
A
Alan Stern 已提交
1418
		if (device_is_registered(&intf->dev)) {
1419
			usb_create_sysfs_intf_files(intf);
A
Alan Stern 已提交
1420 1421
			create_intf_ep_devs(intf);
		}
L
Linus Torvalds 已提交
1422 1423 1424
	}
	return 0;
}
1425
EXPORT_SYMBOL_GPL(usb_reset_configuration);
L
Linus Torvalds 已提交
1426

1427
static void usb_release_interface(struct device *dev)
L
Linus Torvalds 已提交
1428 1429 1430 1431 1432 1433 1434 1435 1436
{
	struct usb_interface *intf = to_usb_interface(dev);
	struct usb_interface_cache *intfc =
			altsetting_to_usb_interface_cache(intf->altsetting);

	kref_put(&intfc->ref, usb_release_interface_cache);
	kfree(intf);
}

1437
#ifdef	CONFIG_HOTPLUG
1438
static int usb_if_uevent(struct device *dev, struct kobj_uevent_env *env)
1439 1440 1441 1442 1443 1444 1445 1446 1447
{
	struct usb_device *usb_dev;
	struct usb_interface *intf;
	struct usb_host_interface *alt;

	intf = to_usb_interface(dev);
	usb_dev = interface_to_usbdev(intf);
	alt = intf->cur_altsetting;

1448
	if (add_uevent_var(env, "INTERFACE=%d/%d/%d",
1449 1450 1451 1452 1453
		   alt->desc.bInterfaceClass,
		   alt->desc.bInterfaceSubClass,
		   alt->desc.bInterfaceProtocol))
		return -ENOMEM;

1454
	if (add_uevent_var(env,
1455 1456
		   "MODALIAS=usb:"
		   "v%04Xp%04Xd%04Xdc%02Xdsc%02Xdp%02Xic%02Xisc%02Xip%02X",
1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472
		   le16_to_cpu(usb_dev->descriptor.idVendor),
		   le16_to_cpu(usb_dev->descriptor.idProduct),
		   le16_to_cpu(usb_dev->descriptor.bcdDevice),
		   usb_dev->descriptor.bDeviceClass,
		   usb_dev->descriptor.bDeviceSubClass,
		   usb_dev->descriptor.bDeviceProtocol,
		   alt->desc.bInterfaceClass,
		   alt->desc.bInterfaceSubClass,
		   alt->desc.bInterfaceProtocol))
		return -ENOMEM;

	return 0;
}

#else

1473
static int usb_if_uevent(struct device *dev, struct kobj_uevent_env *env)
1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484
{
	return -ENODEV;
}
#endif	/* CONFIG_HOTPLUG */

struct device_type usb_if_device_type = {
	.name =		"usb_interface",
	.release =	usb_release_interface,
	.uevent =	usb_if_uevent,
};

1485
static struct usb_interface_assoc_descriptor *find_iad(struct usb_device *dev,
1486 1487
						struct usb_host_config *config,
						u8 inum)
1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513
{
	struct usb_interface_assoc_descriptor *retval = NULL;
	struct usb_interface_assoc_descriptor *intf_assoc;
	int first_intf;
	int last_intf;
	int i;

	for (i = 0; (i < USB_MAXIADS && config->intf_assoc[i]); i++) {
		intf_assoc = config->intf_assoc[i];
		if (intf_assoc->bInterfaceCount == 0)
			continue;

		first_intf = intf_assoc->bFirstInterface;
		last_intf = first_intf + (intf_assoc->bInterfaceCount - 1);
		if (inum >= first_intf && inum <= last_intf) {
			if (!retval)
				retval = intf_assoc;
			else
				dev_err(&dev->dev, "Interface #%d referenced"
					" by multiple IADs\n", inum);
		}
	}

	return retval;
}

1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553

/*
 * Internal function to queue a device reset
 *
 * This is initialized into the workstruct in 'struct
 * usb_device->reset_ws' that is launched by
 * message.c:usb_set_configuration() when initializing each 'struct
 * usb_interface'.
 *
 * It is safe to get the USB device without reference counts because
 * the life cycle of @iface is bound to the life cycle of @udev. Then,
 * this function will be ran only if @iface is alive (and before
 * freeing it any scheduled instances of it will have been cancelled).
 *
 * We need to set a flag (usb_dev->reset_running) because when we call
 * the reset, the interfaces might be unbound. The current interface
 * cannot try to remove the queued work as it would cause a deadlock
 * (you cannot remove your work from within your executing
 * workqueue). This flag lets it know, so that
 * usb_cancel_queued_reset() doesn't try to do it.
 *
 * See usb_queue_reset_device() for more details
 */
void __usb_queue_reset_device(struct work_struct *ws)
{
	int rc;
	struct usb_interface *iface =
		container_of(ws, struct usb_interface, reset_ws);
	struct usb_device *udev = interface_to_usbdev(iface);

	rc = usb_lock_device_for_reset(udev, iface);
	if (rc >= 0) {
		iface->reset_running = 1;
		usb_reset_device(udev);
		iface->reset_running = 0;
		usb_unlock_device(udev);
	}
}


L
Linus Torvalds 已提交
1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
/*
 * usb_set_configuration - Makes a particular device setting be current
 * @dev: the device whose configuration is being updated
 * @configuration: the configuration being chosen.
 * Context: !in_interrupt(), caller owns the device lock
 *
 * This is used to enable non-default device modes.  Not all devices
 * use this kind of configurability; many devices only have one
 * configuration.
 *
1564 1565 1566 1567 1568 1569 1570 1571
 * @configuration is the value of the configuration to be installed.
 * According to the USB spec (e.g. section 9.1.1.5), configuration values
 * must be non-zero; a value of zero indicates that the device in
 * unconfigured.  However some devices erroneously use 0 as one of their
 * configuration values.  To help manage such devices, this routine will
 * accept @configuration = -1 as indicating the device should be put in
 * an unconfigured state.
 *
L
Linus Torvalds 已提交
1572 1573 1574 1575 1576 1577 1578 1579 1580 1581
 * USB device configurations may affect Linux interoperability,
 * power consumption and the functionality available.  For example,
 * the default configuration is limited to using 100mA of bus power,
 * so that when certain device functionality requires more power,
 * and the device is bus powered, that functionality should be in some
 * non-default device configuration.  Other device modes may also be
 * reflected as configuration options, such as whether two ISDN
 * channels are available independently; and choosing between open
 * standard device protocols (like CDC) or proprietary ones.
 *
1582 1583 1584
 * Note that a non-authorized device (dev->authorized == 0) will only
 * be put in unconfigured mode.
 *
L
Linus Torvalds 已提交
1585 1586 1587 1588 1589 1590
 * Note that USB has an additional level of device configurability,
 * associated with interfaces.  That configurability is accessed using
 * usb_set_interface().
 *
 * This call is synchronous. The calling context must be able to sleep,
 * must own the device lock, and must not hold the driver model's USB
1591
 * bus mutex; usb interface driver probe() methods cannot use this routine.
L
Linus Torvalds 已提交
1592 1593
 *
 * Returns zero on success, or else the status code returned by the
1594
 * underlying call that failed.  On successful completion, each interface
L
Linus Torvalds 已提交
1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605
 * in the original device configuration has been destroyed, and each one
 * in the new configuration has been probed by all relevant usb device
 * drivers currently known to the kernel.
 */
int usb_set_configuration(struct usb_device *dev, int configuration)
{
	int i, ret;
	struct usb_host_config *cp = NULL;
	struct usb_interface **new_interfaces = NULL;
	int n, nintf;

1606
	if (dev->authorized == 0 || configuration == -1)
1607 1608 1609 1610 1611 1612 1613 1614
		configuration = 0;
	else {
		for (i = 0; i < dev->descriptor.bNumConfigurations; i++) {
			if (dev->config[i].desc.bConfigurationValue ==
					configuration) {
				cp = &dev->config[i];
				break;
			}
L
Linus Torvalds 已提交
1615 1616 1617 1618 1619 1620 1621 1622
		}
	}
	if ((!cp && configuration != 0))
		return -EINVAL;

	/* The USB spec says configuration 0 means unconfigured.
	 * But if a device includes a configuration numbered 0,
	 * we will accept it as a correctly configured state.
1623
	 * Use -1 if you really want to unconfigure the device.
L
Linus Torvalds 已提交
1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635
	 */
	if (cp && configuration == 0)
		dev_warn(&dev->dev, "config 0 descriptor??\n");

	/* Allocate memory for new interfaces before doing anything else,
	 * so that if we run out then nothing will have changed. */
	n = nintf = 0;
	if (cp) {
		nintf = cp->desc.bNumInterfaces;
		new_interfaces = kmalloc(nintf * sizeof(*new_interfaces),
				GFP_KERNEL);
		if (!new_interfaces) {
1636
			dev_err(&dev->dev, "Out of memory\n");
L
Linus Torvalds 已提交
1637 1638 1639 1640
			return -ENOMEM;
		}

		for (; n < nintf; ++n) {
1641
			new_interfaces[n] = kzalloc(
L
Linus Torvalds 已提交
1642 1643 1644
					sizeof(struct usb_interface),
					GFP_KERNEL);
			if (!new_interfaces[n]) {
1645
				dev_err(&dev->dev, "Out of memory\n");
L
Linus Torvalds 已提交
1646 1647 1648 1649 1650 1651 1652 1653 1654
				ret = -ENOMEM;
free_interfaces:
				while (--n >= 0)
					kfree(new_interfaces[n]);
				kfree(new_interfaces);
				return ret;
			}
		}

1655 1656 1657 1658 1659 1660
		i = dev->bus_mA - cp->desc.bMaxPower * 2;
		if (i < 0)
			dev_warn(&dev->dev, "new config #%d exceeds power "
					"limit by %dmA\n",
					configuration, -i);
	}
1661

1662
	/* Wake up the device so we can send it the Set-Config request */
1663
	ret = usb_autoresume_device(dev);
1664 1665 1666
	if (ret)
		goto free_interfaces;

1667 1668 1669 1670
	/* if it's already configured, clear out old state first.
	 * getting rid of old interfaces means unbinding their drivers.
	 */
	if (dev->state != USB_STATE_ADDRESS)
1671
		usb_disable_device(dev, 1);	/* Skip ep0 */
1672

1673 1674 1675
	/* Get rid of pending async Set-Config requests for this device */
	cancel_async_set_config(dev);

1676 1677 1678 1679
	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
			      USB_REQ_SET_CONFIGURATION, 0, configuration, 0,
			      NULL, 0, USB_CTRL_SET_TIMEOUT);
	if (ret < 0) {
1680 1681 1682 1683 1684
		/* All the old state is gone, so what else can we do?
		 * The device is probably useless now anyway.
		 */
		cp = NULL;
	}
L
Linus Torvalds 已提交
1685 1686

	dev->actconfig = cp;
1687
	if (!cp) {
L
Linus Torvalds 已提交
1688
		usb_set_device_state(dev, USB_STATE_ADDRESS);
1689
		usb_autosuspend_device(dev);
1690 1691 1692
		goto free_interfaces;
	}
	usb_set_device_state(dev, USB_STATE_CONFIGURED);
L
Linus Torvalds 已提交
1693

1694 1695 1696 1697 1698 1699 1700
	/* Initialize the new interface structures and the
	 * hc/hcd/usbcore interface/endpoint state.
	 */
	for (i = 0; i < nintf; ++i) {
		struct usb_interface_cache *intfc;
		struct usb_interface *intf;
		struct usb_host_interface *alt;
L
Linus Torvalds 已提交
1701

1702 1703 1704 1705
		cp->interface[i] = intf = new_interfaces[i];
		intfc = cp->intf_cache[i];
		intf->altsetting = intfc->altsetting;
		intf->num_altsetting = intfc->num_altsetting;
1706
		intf->intf_assoc = find_iad(dev, cp, i);
1707
		kref_get(&intfc->ref);
L
Linus Torvalds 已提交
1708

1709 1710 1711 1712 1713 1714
		alt = usb_altnum_to_altsetting(intf, 0);

		/* No altsetting 0?  We'll assume the first altsetting.
		 * We could use a GetInterface call, but if a device is
		 * so non-compliant that it doesn't have altsetting 0
		 * then I wouldn't trust its reply anyway.
L
Linus Torvalds 已提交
1715
		 */
1716 1717 1718 1719
		if (!alt)
			alt = &intf->altsetting[0];

		intf->cur_altsetting = alt;
1720
		usb_enable_interface(dev, intf, true);
1721 1722 1723
		intf->dev.parent = &dev->dev;
		intf->dev.driver = NULL;
		intf->dev.bus = &usb_bus_type;
1724
		intf->dev.type = &usb_if_device_type;
1725
		intf->dev.groups = usb_interface_groups;
1726
		intf->dev.dma_mask = dev->dev.dma_mask;
1727
		INIT_WORK(&intf->reset_ws, __usb_queue_reset_device);
1728
		device_initialize(&intf->dev);
1729
		mark_quiesced(intf);
1730
		dev_set_name(&intf->dev, "%d-%s:%d.%d",
1731 1732
			dev->bus->busnum, dev->devpath,
			configuration, alt->desc.bInterfaceNumber);
1733 1734 1735
	}
	kfree(new_interfaces);

1736 1737
	if (cp->string == NULL &&
			!(dev->quirks & USB_QUIRK_CONFIG_INTF_STRINGS))
1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748
		cp->string = usb_cache_string(dev, cp->desc.iConfiguration);

	/* Now that all the interfaces are set up, register them
	 * to trigger binding of drivers to interfaces.  probe()
	 * routines may install different altsettings and may
	 * claim() any interfaces not yet bound.  Many class drivers
	 * need that: CDC, audio, video, etc.
	 */
	for (i = 0; i < nintf; ++i) {
		struct usb_interface *intf = cp->interface[i];

1749
		dev_dbg(&dev->dev,
1750
			"adding %s (config #%d, interface %d)\n",
1751
			dev_name(&intf->dev), configuration,
1752
			intf->cur_altsetting->desc.bInterfaceNumber);
1753
		ret = device_add(&intf->dev);
1754 1755
		if (ret != 0) {
			dev_err(&dev->dev, "device_add(%s) --> %d\n",
1756
				dev_name(&intf->dev), ret);
1757
			continue;
L
Linus Torvalds 已提交
1758
		}
A
Alan Stern 已提交
1759
		create_intf_ep_devs(intf);
L
Linus Torvalds 已提交
1760 1761
	}

1762
	usb_autosuspend_device(dev);
1763
	return 0;
L
Linus Torvalds 已提交
1764 1765
}

1766 1767 1768
static LIST_HEAD(set_config_list);
static DEFINE_SPINLOCK(set_config_lock);

1769 1770 1771 1772
struct set_config_request {
	struct usb_device	*udev;
	int			config;
	struct work_struct	work;
1773
	struct list_head	node;
1774 1775 1776
};

/* Worker routine for usb_driver_set_configuration() */
D
David Howells 已提交
1777
static void driver_set_config_work(struct work_struct *work)
1778
{
D
David Howells 已提交
1779 1780
	struct set_config_request *req =
		container_of(work, struct set_config_request, work);
1781
	struct usb_device *udev = req->udev;
1782

1783 1784 1785 1786 1787 1788 1789 1790 1791
	usb_lock_device(udev);
	spin_lock(&set_config_lock);
	list_del(&req->node);
	spin_unlock(&set_config_lock);

	if (req->config >= -1)		/* Is req still valid? */
		usb_set_configuration(udev, req->config);
	usb_unlock_device(udev);
	usb_put_dev(udev);
1792 1793 1794
	kfree(req);
}

1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809
/* Cancel pending Set-Config requests for a device whose configuration
 * was just changed
 */
static void cancel_async_set_config(struct usb_device *udev)
{
	struct set_config_request *req;

	spin_lock(&set_config_lock);
	list_for_each_entry(req, &set_config_list, node) {
		if (req->udev == udev)
			req->config = -999;	/* Mark as cancelled */
	}
	spin_unlock(&set_config_lock);
}

1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838
/**
 * usb_driver_set_configuration - Provide a way for drivers to change device configurations
 * @udev: the device whose configuration is being updated
 * @config: the configuration being chosen.
 * Context: In process context, must be able to sleep
 *
 * Device interface drivers are not allowed to change device configurations.
 * This is because changing configurations will destroy the interface the
 * driver is bound to and create new ones; it would be like a floppy-disk
 * driver telling the computer to replace the floppy-disk drive with a
 * tape drive!
 *
 * Still, in certain specialized circumstances the need may arise.  This
 * routine gets around the normal restrictions by using a work thread to
 * submit the change-config request.
 *
 * Returns 0 if the request was succesfully queued, error code otherwise.
 * The caller has no way to know whether the queued request will eventually
 * succeed.
 */
int usb_driver_set_configuration(struct usb_device *udev, int config)
{
	struct set_config_request *req;

	req = kmalloc(sizeof(*req), GFP_KERNEL);
	if (!req)
		return -ENOMEM;
	req->udev = udev;
	req->config = config;
D
David Howells 已提交
1839
	INIT_WORK(&req->work, driver_set_config_work);
1840

1841 1842 1843 1844
	spin_lock(&set_config_lock);
	list_add(&req->node, &set_config_list);
	spin_unlock(&set_config_lock);

1845
	usb_get_dev(udev);
1846
	schedule_work(&req->work);
1847 1848 1849
	return 0;
}
EXPORT_SYMBOL_GPL(usb_driver_set_configuration);