message.c 58.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12
/*
 * 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>
13
#include <linux/nls.h>
L
Linus Torvalds 已提交
14
#include <linux/device.h>
15
#include <linux/scatterlist.h>
16
#include <linux/usb/quirks.h>
L
Linus Torvalds 已提交
17 18 19 20 21
#include <asm/byteorder.h>

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

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

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

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

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


38 39 40 41 42 43 44
/*
 * 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)
45
{
46
	struct api_context ctx;
47
	unsigned long expire;
48
	int retval;
L
Linus Torvalds 已提交
49

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

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

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

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

/*-------------------------------------------------------------------*/
80
/* returns status (negative) or length (positive) */
L
Linus Torvalds 已提交
81
static int usb_internal_control_msg(struct usb_device *usb_dev,
82
				    unsigned int pipe,
L
Linus Torvalds 已提交
83 84 85 86 87 88 89 90 91 92
				    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;
93

L
Linus Torvalds 已提交
94 95 96 97 98 99 100 101 102 103 104
	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;
}

/**
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 130
 * 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 已提交
131
 */
132 133 134
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 已提交
135
{
136
	struct usb_ctrlrequest *dr;
L
Linus Torvalds 已提交
137
	int ret;
138 139

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

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

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

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

	kfree(dr);

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

159 160 161 162 163 164
/**
 * 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
165 166
 * @actual_length: pointer to a location to put the actual length transferred
 *	in bytes
167 168
 * @timeout: time in msecs to wait for the message to complete before
 *	timing out (if 0 the wait is forever)
169
 *
170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191
 * 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 已提交
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 221
 * 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 已提交
222
 */
223 224
int usb_bulk_msg(struct usb_device *usb_dev, unsigned int pipe,
		 void *data, int len, int *actual_length, int timeout)
L
Linus Torvalds 已提交
225 226
{
	struct urb *urb;
227
	struct usb_host_endpoint *ep;
L
Linus Torvalds 已提交
228

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

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

238 239 240 241
	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,
242 243
				usb_api_blocking_completion, NULL,
				ep->desc.bInterval);
244 245 246
	} else
		usb_fill_bulk_urb(urb, usb_dev, pipe, data, len,
				usb_api_blocking_completion, NULL);
L
Linus Torvalds 已提交
247 248 249

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

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

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

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

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

	/* 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
287
				|| status != -ECONNRESET)
L
Linus Torvalds 已提交
288
			&& urb->actual_length) {
289
		dev_err(io->dev->bus->controller,
L
Linus Torvalds 已提交
290 291
			"dev %s ep%d%s scatterlist error %d/%d\n",
			io->dev->devpath,
A
Alan Stern 已提交
292 293
			usb_endpoint_num(&urb->ep->desc),
			usb_urb_dir_in(urb) ? "in" : "out",
294
			status, io->status);
295
		/* BUG (); */
L
Linus Torvalds 已提交
296 297
	}

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

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

		/* 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...
		 */
307
		spin_unlock(&io->lock);
L
Linus Torvalds 已提交
308 309 310 311
		for (i = 0, found = 0; i < io->entries; i++) {
			if (!io->urbs [i] || !io->urbs [i]->dev)
				continue;
			if (found) {
312
				retval = usb_unlink_urb(io->urbs [i]);
313 314 315
				if (retval != -EINPROGRESS &&
				    retval != -ENODEV &&
				    retval != -EBUSY)
316
					dev_err(&io->dev->dev,
L
Linus Torvalds 已提交
317
						"%s, unlink --> %d\n",
318
						__func__, retval);
L
Linus Torvalds 已提交
319 320 321
			} else if (urb == io->urbs [i])
				found = 1;
		}
322
		spin_lock(&io->lock);
L
Linus Torvalds 已提交
323 324 325 326 327 328 329
	}
	urb->dev = NULL;

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

332
	spin_unlock(&io->lock);
L
Linus Torvalds 已提交
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 360
}


/**
 * 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.
 */
361 362 363
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 已提交
364
{
365 366 367
	int i;
	int urb_flags;
	int dma;
368
	int use_sg;
L
Linus Torvalds 已提交
369 370

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

376
	spin_lock_init(&io->lock);
L
Linus Torvalds 已提交
377 378 379 380 381 382 383 384 385 386
	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 已提交
387
		io->entries = usb_buffer_map_sg(dev, usb_pipein(pipe),
388
						sg, nents);
L
Linus Torvalds 已提交
389 390 391 392 393 394 395
	else
		io->entries = nents;

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

396 397 398 399 400 401 402 403 404 405 406 407 408
	/* If we're running on an xHCI host controller, queue the whole scatter
	 * gather list with one call to urb_enqueue().  This is only for bulk,
	 * as that endpoint type does not care how the data gets broken up
	 * across frames.
	 */
	if (usb_pipebulk(pipe) &&
			bus_to_hcd(dev->bus)->driver->flags & HCD_USB3) {
		io->urbs = kmalloc(sizeof *io->urbs, mem_flags);
		use_sg = true;
	} else {
		io->urbs = kmalloc(io->entries * sizeof *io->urbs, mem_flags);
		use_sg = false;
	}
L
Linus Torvalds 已提交
409 410 411
	if (!io->urbs)
		goto nomem;

412 413 414
	urb_flags = URB_NO_INTERRUPT;
	if (dma)
		urb_flags |= URB_NO_TRANSFER_DMA_MAP;
415
	if (usb_pipein(pipe))
L
Linus Torvalds 已提交
416 417
		urb_flags |= URB_SHORT_NOT_OK;

418 419 420 421
	if (use_sg) {
		io->urbs[0] = usb_alloc_urb(0, mem_flags);
		if (!io->urbs[0]) {
			io->entries = 0;
L
Linus Torvalds 已提交
422 423 424
			goto nomem;
		}

425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482
		io->urbs[0]->dev = NULL;
		io->urbs[0]->pipe = pipe;
		io->urbs[0]->interval = period;
		io->urbs[0]->transfer_flags = urb_flags;

		io->urbs[0]->complete = sg_complete;
		io->urbs[0]->context = io;
		/* A length of zero means transfer the whole sg list */
		io->urbs[0]->transfer_buffer_length = length;
		if (length == 0) {
			for_each_sg(sg, sg, io->entries, i) {
				io->urbs[0]->transfer_buffer_length +=
					sg_dma_len(sg);
			}
		}
		io->urbs[0]->sg = io;
		io->urbs[0]->num_sgs = io->entries;
		io->entries = 1;
	} else {
		for_each_sg(sg, sg, io->entries, i) {
			unsigned len;

			io->urbs[i] = usb_alloc_urb(0, mem_flags);
			if (!io->urbs[i]) {
				io->entries = i;
				goto nomem;
			}

			io->urbs[i]->dev = NULL;
			io->urbs[i]->pipe = pipe;
			io->urbs[i]->interval = period;
			io->urbs[i]->transfer_flags = urb_flags;

			io->urbs[i]->complete = sg_complete;
			io->urbs[i]->context = io;

			/*
			 * 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 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 to prevent stale pointers and to help spot
			 * bugs.
			 */
			if (dma) {
				io->urbs[i]->transfer_dma = sg_dma_address(sg);
				len = sg_dma_len(sg);
483
#if defined(CONFIG_HIGHMEM) || defined(CONFIG_GART_IOMMU)
484
				io->urbs[i]->transfer_buffer = NULL;
485
#else
486
				io->urbs[i]->transfer_buffer = sg_virt(sg);
487
#endif
488 489 490 491 492 493 494 495 496 497 498 499 500
			} else {
				/* hc may use _only_ transfer_buffer */
				io->urbs[i]->transfer_buffer = sg_virt(sg);
				len = sg->length;
			}

			if (length) {
				len = min_t(unsigned, len, length);
				length -= len;
				if (length == 0)
					io->entries = i + 1;
			}
			io->urbs[i]->transfer_buffer_length = len;
L
Linus Torvalds 已提交
501
		}
502
		io->urbs[--i]->transfer_flags &= ~URB_NO_INTERRUPT;
L
Linus Torvalds 已提交
503 504 505
	}

	/* transaction state */
506
	io->count = io->entries;
L
Linus Torvalds 已提交
507 508
	io->status = 0;
	io->bytes = 0;
509
	init_completion(&io->complete);
L
Linus Torvalds 已提交
510 511 512
	return 0;

nomem:
513
	sg_clean(io);
L
Linus Torvalds 已提交
514 515
	return -ENOMEM;
}
516
EXPORT_SYMBOL_GPL(usb_sg_init);
L
Linus Torvalds 已提交
517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534

/**
 * 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.
535
 * (3) cancellation, a type of error with status -ECONNRESET that
L
Linus Torvalds 已提交
536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555
 *     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).
556 557 558 559
 *
 * It is not necessary to call this function to reserve bandwidth for devices
 * under an xHCI host controller, as the bandwidth is reserved when the
 * configuration or interface alt setting is selected.
L
Linus Torvalds 已提交
560
 */
561
void usb_sg_wait(struct usb_sg_request *io)
L
Linus Torvalds 已提交
562
{
563 564
	int i;
	int entries = io->entries;
L
Linus Torvalds 已提交
565 566

	/* queue the urbs.  */
567
	spin_lock_irq(&io->lock);
568 569
	i = 0;
	while (i < entries && !io->status) {
570
		int retval;
L
Linus Torvalds 已提交
571

572 573
		io->urbs[i]->dev = io->dev;
		retval = usb_submit_urb(io->urbs [i], GFP_ATOMIC);
L
Linus Torvalds 已提交
574 575 576 577

		/* after we submit, let completions or cancelations fire;
		 * we handshake using io->status.
		 */
578
		spin_unlock_irq(&io->lock);
L
Linus Torvalds 已提交
579 580
		switch (retval) {
			/* maybe we retrying will recover */
581
		case -ENXIO:	/* hc didn't queue this one */
L
Linus Torvalds 已提交
582 583 584 585
		case -EAGAIN:
		case -ENOMEM:
			io->urbs[i]->dev = NULL;
			retval = 0;
586
			yield();
L
Linus Torvalds 已提交
587 588 589 590 591 592 593 594 595
			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:
596
			++i;
597
			cpu_relax();
L
Linus Torvalds 已提交
598 599 600 601
			break;

			/* fail any uncompleted urbs */
		default:
602 603 604
			io->urbs[i]->dev = NULL;
			io->urbs[i]->status = retval;
			dev_dbg(&io->dev->dev, "%s, submit --> %d\n",
605
				__func__, retval);
606
			usb_sg_cancel(io);
L
Linus Torvalds 已提交
607
		}
608
		spin_lock_irq(&io->lock);
L
Linus Torvalds 已提交
609 610 611 612 613
		if (retval && (io->status == 0 || io->status == -ECONNRESET))
			io->status = retval;
	}
	io->count -= entries - i;
	if (io->count == 0)
614 615
		complete(&io->complete);
	spin_unlock_irq(&io->lock);
L
Linus Torvalds 已提交
616 617 618 619 620

	/* 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!
	 */
621
	wait_for_completion(&io->complete);
L
Linus Torvalds 已提交
622

623
	sg_clean(io);
L
Linus Torvalds 已提交
624
}
625
EXPORT_SYMBOL_GPL(usb_sg_wait);
L
Linus Torvalds 已提交
626 627 628 629 630 631 632 633 634

/**
 * 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.
 */
635
void usb_sg_cancel(struct usb_sg_request *io)
L
Linus Torvalds 已提交
636
{
637
	unsigned long flags;
L
Linus Torvalds 已提交
638

639
	spin_lock_irqsave(&io->lock, flags);
L
Linus Torvalds 已提交
640 641 642

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

		io->status = -ECONNRESET;
646
		spin_unlock(&io->lock);
L
Linus Torvalds 已提交
647
		for (i = 0; i < io->entries; i++) {
648
			int retval;
L
Linus Torvalds 已提交
649 650 651

			if (!io->urbs [i]->dev)
				continue;
652
			retval = usb_unlink_urb(io->urbs [i]);
L
Linus Torvalds 已提交
653
			if (retval != -EINPROGRESS && retval != -EBUSY)
654
				dev_warn(&io->dev->dev, "%s, unlink --> %d\n",
655
					__func__, retval);
L
Linus Torvalds 已提交
656
		}
657
		spin_lock(&io->lock);
L
Linus Torvalds 已提交
658
	}
659
	spin_unlock_irqrestore(&io->lock, flags);
L
Linus Torvalds 已提交
660
}
661
EXPORT_SYMBOL_GPL(usb_sg_cancel);
L
Linus Torvalds 已提交
662 663 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_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.
 */
687 688
int usb_get_descriptor(struct usb_device *dev, unsigned char type,
		       unsigned char index, void *buf, int size)
L
Linus Torvalds 已提交
689 690 691
{
	int i;
	int result;
692 693

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

	for (i = 0; i < 3; ++i) {
696
		/* retry on length 0 or error; some devices are flakey */
L
Linus Torvalds 已提交
697 698 699 700
		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);
701
		if (result <= 0 && result != -ETIMEDOUT)
L
Linus Torvalds 已提交
702 703
			continue;
		if (result > 1 && ((u8 *)buf)[1] != type) {
704
			result = -ENODATA;
L
Linus Torvalds 已提交
705 706 707 708 709 710
			continue;
		}
		break;
	}
	return result;
}
711
EXPORT_SYMBOL_GPL(usb_get_descriptor);
L
Linus Torvalds 已提交
712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734

/**
 * 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.
 */
735 736
static int usb_get_string(struct usb_device *dev, unsigned short langid,
			  unsigned char index, void *buf, int size)
L
Linus Torvalds 已提交
737 738 739 740 741 742 743 744 745 746
{
	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);
747 748 749 750 751 752 753
		if (result == 0 || result == -EPIPE)
			continue;
		if (result > 1 && ((u8 *) buf)[1] != USB_DT_STRING) {
			result = -ENODATA;
			continue;
		}
		break;
L
Linus Torvalds 已提交
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772
	}
	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,
773
			  unsigned int index, unsigned char *buf)
L
Linus Torvalds 已提交
774 775 776 777 778
{
	int rc;

	/* Try to read the string descriptor by asking for the maximum
	 * possible number of bytes */
779 780 781 782
	if (dev->quirks & USB_QUIRK_STRING_FETCH_255)
		rc = -EIO;
	else
		rc = usb_get_string(dev, langid, index, buf, 255);
L
Linus Torvalds 已提交
783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808

	/* 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;
}

D
Daniel Mack 已提交
809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
static int usb_get_langid(struct usb_device *dev, unsigned char *tbuf)
{
	int err;

	if (dev->have_langid)
		return 0;

	if (dev->string_langid < 0)
		return -EPIPE;

	err = usb_string_sub(dev, 0, 0, tbuf);

	/* If the string was reported but is malformed, default to english
	 * (0x0409) */
	if (err == -ENODATA || (err > 0 && err < 4)) {
		dev->string_langid = 0x0409;
		dev->have_langid = 1;
		dev_err(&dev->dev,
			"string descriptor 0 malformed (err = %d), "
			"defaulting to 0x%04x\n",
				err, dev->string_langid);
		return 0;
	}

	/* In case of all other errors, we assume the device is not able to
	 * deal with strings at all. Set string_langid to -1 in order to
	 * prevent any string to be retrieved from the device */
	if (err < 0) {
		dev_err(&dev->dev, "string descriptor 0 read error: %d\n",
					err);
		dev->string_langid = -1;
		return -EPIPE;
	}

	/* always use the first langid listed */
	dev->string_langid = tbuf[2] | (tbuf[3] << 8);
	dev->have_langid = 1;
	dev_dbg(&dev->dev, "default language 0x%04x\n",
				dev->string_langid);
	return 0;
}

L
Linus Torvalds 已提交
851
/**
852
 * usb_string - returns UTF-8 version of a string descriptor
L
Linus Torvalds 已提交
853 854 855 856 857
 * @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 ()
858
 *
L
Linus Torvalds 已提交
859
 * This converts the UTF-16LE encoded strings returned by devices, from
860 861
 * usb_get_string_descriptor(), to null-terminated UTF-8 encoded ones
 * that are more usable in most kernel contexts.  Note that this function
L
Linus Torvalds 已提交
862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877
 * chooses strings in the first language supported by the device.
 *
 * 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;

	if (dev->state == USB_STATE_SUSPENDED)
		return -EHOSTUNREACH;
	if (size <= 0 || !buf || !index)
		return -EINVAL;
	buf[0] = 0;
A
Alan Stern 已提交
878
	tbuf = kmalloc(256, GFP_NOIO);
L
Linus Torvalds 已提交
879 880 881
	if (!tbuf)
		return -ENOMEM;

D
Daniel Mack 已提交
882 883 884
	err = usb_get_langid(dev, tbuf);
	if (err < 0)
		goto errout;
885

L
Linus Torvalds 已提交
886 887 888 889 890
	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 */
A
Alan Stern 已提交
891 892
	err = utf16s_to_utf8s((wchar_t *) &tbuf[2], (err - 2) / 2,
			UTF16_LITTLE_ENDIAN, buf, size);
893
	buf[err] = 0;
L
Linus Torvalds 已提交
894 895

	if (tbuf[1] != USB_DT_STRING)
896 897 898
		dev_dbg(&dev->dev,
			"wrong descriptor type %02x for string %d (\"%s\")\n",
			tbuf[1], index, buf);
L
Linus Torvalds 已提交
899 900 901 902 903

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

906 907 908
/* one UTF-8-encoded 16-bit character has at most three bytes */
#define MAX_USB_STRING_SIZE (127 * 3 + 1)

909 910 911 912 913 914 915 916 917 918 919 920 921 922
/**
 * 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;

923 924 925
	if (index <= 0)
		return NULL;

926
	buf = kmalloc(MAX_USB_STRING_SIZE, GFP_KERNEL);
927
	if (buf) {
928
		len = usb_string(udev, index, buf, MAX_USB_STRING_SIZE);
929 930 931
		if (len > 0) {
			smallbuf = kmalloc(++len, GFP_KERNEL);
			if (!smallbuf)
932 933 934 935 936 937 938 939
				return buf;
			memcpy(smallbuf, buf, len);
		}
		kfree(buf);
	}
	return smallbuf;
}

L
Linus Torvalds 已提交
940 941 942 943 944 945 946
/*
 * 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,
947
 * which dedicates space for this purpose.
L
Linus Torvalds 已提交
948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969
 *
 * 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);
970
	if (ret >= 0)
L
Linus Torvalds 已提交
971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013
		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;
}
1014
EXPORT_SYMBOL_GPL(usb_get_status);
L
Linus Torvalds 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042

/**
 * 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);
1043 1044

	if (usb_pipein(pipe))
L
Linus Torvalds 已提交
1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067
		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.
	 */

1068
	usb_reset_endpoint(dev, endp);
L
Linus Torvalds 已提交
1069 1070 1071

	return 0;
}
1072
EXPORT_SYMBOL_GPL(usb_clear_halt);
L
Linus Torvalds 已提交
1073

A
Alan Stern 已提交
1074 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 1101
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 已提交
1102 1103 1104 1105 1106
/**
 * 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
1107 1108
 * @reset_hardware: flag to erase any endpoint state stored in the
 *	controller hardware
L
Linus Torvalds 已提交
1109
 *
1110 1111 1112
 * 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 已提交
1113
 */
1114 1115
void usb_disable_endpoint(struct usb_device *dev, unsigned int epaddr,
		bool reset_hardware)
L
Linus Torvalds 已提交
1116 1117 1118 1119 1120 1121 1122 1123 1124
{
	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];
1125 1126
		if (reset_hardware)
			dev->ep_out[epnum] = NULL;
L
Linus Torvalds 已提交
1127 1128
	} else {
		ep = dev->ep_in[epnum];
1129 1130
		if (reset_hardware)
			dev->ep_in[epnum] = NULL;
L
Linus Torvalds 已提交
1131
	}
A
Alan Stern 已提交
1132 1133
	if (ep) {
		ep->enabled = 0;
1134
		usb_hcd_flush_endpoint(dev, ep);
1135 1136
		if (reset_hardware)
			usb_hcd_disable_endpoint(dev, ep);
A
Alan Stern 已提交
1137
	}
L
Linus Torvalds 已提交
1138 1139
}

1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163
/**
 * 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 已提交
1164 1165 1166 1167
/**
 * usb_disable_interface -- Disable all endpoints for an interface
 * @dev: the device whose interface is being disabled
 * @intf: pointer to the interface descriptor
1168 1169
 * @reset_hardware: flag to erase any endpoint state stored in the
 *	controller hardware
L
Linus Torvalds 已提交
1170 1171 1172
 *
 * Disables all the endpoints for the interface's current altsetting.
 */
1173 1174
void usb_disable_interface(struct usb_device *dev, struct usb_interface *intf,
		bool reset_hardware)
L
Linus Torvalds 已提交
1175 1176 1177 1178 1179 1180
{
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i) {
		usb_disable_endpoint(dev,
1181 1182
				alt->endpoint[i].desc.bEndpointAddress,
				reset_hardware);
L
Linus Torvalds 已提交
1183 1184 1185
	}
}

1186
/**
L
Linus Torvalds 已提交
1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199
 * 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;

1200
	dev_dbg(&dev->dev, "%s nuking %s URBs\n", __func__,
1201
		skip_ep0 ? "non-ep0" : "all");
L
Linus Torvalds 已提交
1202
	for (i = skip_ep0; i < 16; ++i) {
1203 1204
		usb_disable_endpoint(dev, i, true);
		usb_disable_endpoint(dev, i + USB_DIR_IN, true);
L
Linus Torvalds 已提交
1205 1206 1207 1208 1209 1210 1211 1212 1213
	}

	/* 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;

1214
			/* remove this interface if it has been registered */
L
Linus Torvalds 已提交
1215
			interface = dev->actconfig->interface[i];
1216
			if (!device_is_registered(&interface->dev))
1217
				continue;
1218
			dev_dbg(&dev->dev, "unregistering interface %s\n",
1219
				dev_name(&interface->dev));
1220
			interface->unregistering = 1;
A
Alan Stern 已提交
1221
			remove_intf_ep_devs(interface);
1222
			device_del(&interface->dev);
L
Linus Torvalds 已提交
1223 1224 1225 1226 1227 1228
		}

		/* Now that the interfaces are unbound, nobody should
		 * try to access them.
		 */
		for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
1229
			put_device(&dev->actconfig->interface[i]->dev);
L
Linus Torvalds 已提交
1230 1231 1232 1233 1234 1235 1236 1237
			dev->actconfig->interface[i] = NULL;
		}
		dev->actconfig = NULL;
		if (dev->state == USB_STATE_CONFIGURED)
			usb_set_device_state(dev, USB_STATE_ADDRESS);
	}
}

1238
/**
L
Linus Torvalds 已提交
1239 1240 1241
 * usb_enable_endpoint - Enable an endpoint for USB communications
 * @dev: the device whose interface is being enabled
 * @ep: the endpoint
1242
 * @reset_ep: flag to reset the endpoint state
L
Linus Torvalds 已提交
1243
 *
1244
 * Resets the endpoint state if asked, and sets dev->ep_{in,out} pointers.
L
Linus Torvalds 已提交
1245 1246
 * For control endpoints, both the input and output sides are handled.
 */
1247
void usb_enable_endpoint(struct usb_device *dev, struct usb_host_endpoint *ep,
1248
		bool reset_ep)
L
Linus Torvalds 已提交
1249
{
A
Alan Stern 已提交
1250 1251 1252
	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 已提交
1253

1254 1255 1256
	if (reset_ep)
		usb_hcd_reset_endpoint(dev, ep);
	if (is_out || is_control)
L
Linus Torvalds 已提交
1257
		dev->ep_out[epnum] = ep;
1258
	if (!is_out || is_control)
L
Linus Torvalds 已提交
1259
		dev->ep_in[epnum] = ep;
A
Alan Stern 已提交
1260
	ep->enabled = 1;
L
Linus Torvalds 已提交
1261 1262
}

1263
/**
L
Linus Torvalds 已提交
1264 1265 1266
 * usb_enable_interface - Enable all the endpoints for an interface
 * @dev: the device whose interface is being enabled
 * @intf: pointer to the interface descriptor
1267
 * @reset_eps: flag to reset the endpoints' state
L
Linus Torvalds 已提交
1268 1269 1270
 *
 * Enables all the endpoints for the interface's current altsetting.
 */
1271
void usb_enable_interface(struct usb_device *dev,
1272
		struct usb_interface *intf, bool reset_eps)
L
Linus Torvalds 已提交
1273 1274 1275 1276 1277
{
	struct usb_host_interface *alt = intf->cur_altsetting;
	int i;

	for (i = 0; i < alt->desc.bNumEndpoints; ++i)
1278
		usb_enable_endpoint(dev, &alt->endpoint[i], reset_eps);
L
Linus Torvalds 已提交
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
}

/**
 * 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;
1320 1321
	unsigned int epaddr;
	unsigned int pipe;
L
Linus Torvalds 已提交
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334

	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) {
1335 1336
		dev_warn(&dev->dev, "selecting invalid altsetting %d",
			 alternate);
L
Linus Torvalds 已提交
1337 1338 1339
		return -EINVAL;
	}

1340 1341 1342 1343
	if (dev->quirks & USB_QUIRK_NO_SET_INTF)
		ret = -EPIPE;
	else
		ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
L
Linus Torvalds 已提交
1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364
				   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 已提交
1365 1366
	if (iface->cur_altsetting != alt) {
		remove_intf_ep_devs(iface);
1367
		usb_remove_sysfs_intf_files(iface);
A
Alan Stern 已提交
1368
	}
1369
	usb_disable_interface(dev, iface, true);
L
Linus Torvalds 已提交
1370 1371 1372 1373

	iface->cur_altsetting = alt;

	/* If the interface only has one altsetting and the device didn't
1374
	 * accept the request, we attempt to carry out the equivalent action
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379 1380 1381
	 * 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++) {
1382 1383 1384 1385 1386
			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 已提交
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402

			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.)
	 */
1403
	usb_enable_interface(dev, iface, true);
A
Alan Stern 已提交
1404
	if (device_is_registered(&iface->dev)) {
1405
		usb_create_sysfs_intf_files(iface);
A
Alan Stern 已提交
1406 1407
		create_intf_ep_devs(iface);
	}
L
Linus Torvalds 已提交
1408 1409
	return 0;
}
1410
EXPORT_SYMBOL_GPL(usb_set_interface);
L
Linus Torvalds 已提交
1411 1412 1413 1414 1415 1416 1417 1418

/**
 * 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),
1419
 * endpoint halts (cleared), and endpoint state (only for bulk and interrupt
L
Linus Torvalds 已提交
1420 1421 1422 1423 1424
 * 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
1425 1426
 * 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
1427
 * reset all the interface state (notably endpoint state).  Resetting the whole
L
Linus Torvalds 已提交
1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447
 * 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) {
1448 1449
		usb_disable_endpoint(dev, i, true);
		usb_disable_endpoint(dev, i + USB_DIR_IN, true);
L
Linus Torvalds 已提交
1450 1451 1452 1453 1454 1455 1456
	}

	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);
1457
	if (retval < 0)
L
Linus Torvalds 已提交
1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
		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 已提交
1475 1476 1477 1478
		if (alt != intf->cur_altsetting) {
			remove_intf_ep_devs(intf);
			usb_remove_sysfs_intf_files(intf);
		}
L
Linus Torvalds 已提交
1479
		intf->cur_altsetting = alt;
1480
		usb_enable_interface(dev, intf, true);
A
Alan Stern 已提交
1481
		if (device_is_registered(&intf->dev)) {
1482
			usb_create_sysfs_intf_files(intf);
A
Alan Stern 已提交
1483 1484
			create_intf_ep_devs(intf);
		}
L
Linus Torvalds 已提交
1485 1486 1487
	}
	return 0;
}
1488
EXPORT_SYMBOL_GPL(usb_reset_configuration);
L
Linus Torvalds 已提交
1489

1490
static void usb_release_interface(struct device *dev)
L
Linus Torvalds 已提交
1491 1492 1493 1494 1495 1496 1497 1498 1499
{
	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);
}

1500
#ifdef	CONFIG_HOTPLUG
1501
static int usb_if_uevent(struct device *dev, struct kobj_uevent_env *env)
1502 1503 1504 1505 1506 1507 1508 1509 1510
{
	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;

1511
	if (add_uevent_var(env, "INTERFACE=%d/%d/%d",
1512 1513 1514 1515 1516
		   alt->desc.bInterfaceClass,
		   alt->desc.bInterfaceSubClass,
		   alt->desc.bInterfaceProtocol))
		return -ENOMEM;

1517
	if (add_uevent_var(env,
1518 1519
		   "MODALIAS=usb:"
		   "v%04Xp%04Xd%04Xdc%02Xdsc%02Xdp%02Xic%02Xisc%02Xip%02X",
1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
		   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

1536
static int usb_if_uevent(struct device *dev, struct kobj_uevent_env *env)
1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547
{
	return -ENODEV;
}
#endif	/* CONFIG_HOTPLUG */

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

1548
static struct usb_interface_assoc_descriptor *find_iad(struct usb_device *dev,
1549 1550
						struct usb_host_config *config,
						u8 inum)
1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576
{
	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;
}

1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616

/*
 * 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 已提交
1617 1618 1619 1620 1621 1622 1623 1624 1625 1626
/*
 * 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.
 *
1627 1628 1629 1630 1631 1632 1633 1634
 * @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 已提交
1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
 * 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.
 *
1645 1646 1647
 * Note that a non-authorized device (dev->authorized == 0) will only
 * be put in unconfigured mode.
 *
L
Linus Torvalds 已提交
1648 1649 1650 1651 1652 1653
 * 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
1654
 * bus mutex; usb interface driver probe() methods cannot use this routine.
L
Linus Torvalds 已提交
1655 1656
 *
 * Returns zero on success, or else the status code returned by the
1657
 * underlying call that failed.  On successful completion, each interface
L
Linus Torvalds 已提交
1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668
 * 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;

1669
	if (dev->authorized == 0 || configuration == -1)
1670 1671 1672 1673 1674 1675 1676 1677
		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 已提交
1678 1679 1680 1681 1682 1683 1684 1685
		}
	}
	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.
1686
	 * Use -1 if you really want to unconfigure the device.
L
Linus Torvalds 已提交
1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698
	 */
	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) {
1699
			dev_err(&dev->dev, "Out of memory\n");
L
Linus Torvalds 已提交
1700 1701 1702 1703
			return -ENOMEM;
		}

		for (; n < nintf; ++n) {
1704
			new_interfaces[n] = kzalloc(
L
Linus Torvalds 已提交
1705 1706 1707
					sizeof(struct usb_interface),
					GFP_KERNEL);
			if (!new_interfaces[n]) {
1708
				dev_err(&dev->dev, "Out of memory\n");
L
Linus Torvalds 已提交
1709 1710 1711 1712 1713 1714 1715 1716 1717
				ret = -ENOMEM;
free_interfaces:
				while (--n >= 0)
					kfree(new_interfaces[n]);
				kfree(new_interfaces);
				return ret;
			}
		}

1718 1719 1720 1721 1722 1723
		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);
	}
1724

1725
	/* Wake up the device so we can send it the Set-Config request */
1726
	ret = usb_autoresume_device(dev);
1727 1728 1729
	if (ret)
		goto free_interfaces;

1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744
	/* Make sure we have bandwidth (and available HCD resources) for this
	 * configuration.  Remove endpoints from the schedule if we're dropping
	 * this configuration to set configuration 0.  After this point, the
	 * host controller will not allow submissions to dropped endpoints.  If
	 * this call fails, the device state is unchanged.
	 */
	if (cp)
		ret = usb_hcd_check_bandwidth(dev, cp, NULL);
	else
		ret = usb_hcd_check_bandwidth(dev, NULL, NULL);
	if (ret < 0) {
		usb_autosuspend_device(dev);
		goto free_interfaces;
	}

1745 1746 1747 1748
	/* 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)
1749
		usb_disable_device(dev, 1);	/* Skip ep0 */
1750

1751 1752 1753
	/* Get rid of pending async Set-Config requests for this device */
	cancel_async_set_config(dev);

1754 1755 1756 1757
	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) {
1758 1759 1760 1761 1762
		/* All the old state is gone, so what else can we do?
		 * The device is probably useless now anyway.
		 */
		cp = NULL;
	}
L
Linus Torvalds 已提交
1763 1764

	dev->actconfig = cp;
1765
	if (!cp) {
L
Linus Torvalds 已提交
1766
		usb_set_device_state(dev, USB_STATE_ADDRESS);
1767
		usb_hcd_check_bandwidth(dev, NULL, NULL);
1768
		usb_autosuspend_device(dev);
1769 1770 1771
		goto free_interfaces;
	}
	usb_set_device_state(dev, USB_STATE_CONFIGURED);
L
Linus Torvalds 已提交
1772

1773 1774 1775 1776 1777 1778 1779
	/* 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 已提交
1780

1781 1782 1783 1784
		cp->interface[i] = intf = new_interfaces[i];
		intfc = cp->intf_cache[i];
		intf->altsetting = intfc->altsetting;
		intf->num_altsetting = intfc->num_altsetting;
1785
		intf->intf_assoc = find_iad(dev, cp, i);
1786
		kref_get(&intfc->ref);
L
Linus Torvalds 已提交
1787

1788 1789 1790 1791 1792 1793
		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 已提交
1794
		 */
1795 1796 1797 1798
		if (!alt)
			alt = &intf->altsetting[0];

		intf->cur_altsetting = alt;
1799
		usb_enable_interface(dev, intf, true);
1800 1801 1802
		intf->dev.parent = &dev->dev;
		intf->dev.driver = NULL;
		intf->dev.bus = &usb_bus_type;
1803
		intf->dev.type = &usb_if_device_type;
1804
		intf->dev.groups = usb_interface_groups;
1805
		intf->dev.dma_mask = dev->dev.dma_mask;
1806
		INIT_WORK(&intf->reset_ws, __usb_queue_reset_device);
1807
		device_initialize(&intf->dev);
1808
		mark_quiesced(intf);
1809
		dev_set_name(&intf->dev, "%d-%s:%d.%d",
1810 1811
			dev->bus->busnum, dev->devpath,
			configuration, alt->desc.bInterfaceNumber);
1812 1813 1814
	}
	kfree(new_interfaces);

1815 1816
	if (cp->string == NULL &&
			!(dev->quirks & USB_QUIRK_CONFIG_INTF_STRINGS))
1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827
		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];

1828
		dev_dbg(&dev->dev,
1829
			"adding %s (config #%d, interface %d)\n",
1830
			dev_name(&intf->dev), configuration,
1831
			intf->cur_altsetting->desc.bInterfaceNumber);
1832
		ret = device_add(&intf->dev);
1833 1834
		if (ret != 0) {
			dev_err(&dev->dev, "device_add(%s) --> %d\n",
1835
				dev_name(&intf->dev), ret);
1836
			continue;
L
Linus Torvalds 已提交
1837
		}
A
Alan Stern 已提交
1838
		create_intf_ep_devs(intf);
L
Linus Torvalds 已提交
1839 1840
	}

1841
	usb_autosuspend_device(dev);
1842
	return 0;
L
Linus Torvalds 已提交
1843 1844
}

1845 1846 1847
static LIST_HEAD(set_config_list);
static DEFINE_SPINLOCK(set_config_lock);

1848 1849 1850 1851
struct set_config_request {
	struct usb_device	*udev;
	int			config;
	struct work_struct	work;
1852
	struct list_head	node;
1853 1854 1855
};

/* Worker routine for usb_driver_set_configuration() */
D
David Howells 已提交
1856
static void driver_set_config_work(struct work_struct *work)
1857
{
D
David Howells 已提交
1858 1859
	struct set_config_request *req =
		container_of(work, struct set_config_request, work);
1860
	struct usb_device *udev = req->udev;
1861

1862 1863 1864 1865 1866 1867 1868 1869 1870
	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);
1871 1872 1873
	kfree(req);
}

1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888
/* 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);
}

1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917
/**
 * 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 已提交
1918
	INIT_WORK(&req->work, driver_set_config_work);
1919

1920 1921 1922 1923
	spin_lock(&set_config_lock);
	list_add(&req->node, &set_config_list);
	spin_unlock(&set_config_lock);

1924
	usb_get_dev(udev);
1925
	schedule_work(&req->work);
1926 1927 1928
	return 0;
}
EXPORT_SYMBOL_GPL(usb_driver_set_configuration);