| 1 | |
| 2 |
|
| 3 |
|
| 4 | |
| 5 | * devio.c -- User space communication with USB devices.
|
| 6 | *
|
| 7 | * Copyright (C) 1999-2000 Thomas Sailer ([email protected])
|
| 8 | *
|
| 9 | * This file implements the usbfs/x/y files, where
|
| 10 | * x is the bus number and y the device number.
|
| 11 | *
|
| 12 | * It allows user space programs/"drivers" to communicate directly
|
| 13 | * with USB devices without intervening kernel driver.
|
| 14 | *
|
| 15 | * Revision history
|
| 16 | * 22.12.1999 0.1 Initial release (split from proc_usb.c)
|
| 17 | * 04.01.2000 0.2 Turned into its own filesystem
|
| 18 | * 30.09.2005 0.3 Fix user-triggerable oops in async URB delivery
|
| 19 | * (CAN-2005-3055)
|
| 20 |
|
| 21 |
|
| 22 |
|
| 23 |
|
| 24 | #include <linux/fs.h>
|
| 25 | #include <linux/mm.h>
|
| 26 | #include <linux/sched/signal.h>
|
| 27 | #include <linux/slab.h>
|
| 28 | #include <linux/signal.h>
|
| 29 | #include <linux/poll.h>
|
| 30 | #include <linux/module.h>
|
| 31 | #include <linux/string.h>
|
| 32 | #include <linux/usb.h>
|
| 33 | #include <linux/usbdevice_fs.h>
|
| 34 | #include <linux/usb/hcd.h>
|
| 35 | #include <linux/usb/quirks.h>
|
| 36 | #include <linux/cdev.h>
|
| 37 | #include <linux/notifier.h>
|
| 38 | #include <linux/security.h>
|
| 39 | #include <linux/user_namespace.h>
|
| 40 | #include <linux/scatterlist.h>
|
| 41 | #include <linux/uaccess.h>
|
| 42 | #include <linux/dma-mapping.h>
|
| 43 | #include <asm/byteorder.h>
|
| 44 | #include <linux/moduleparam.h>
|
| 45 |
|
| 46 | #include "usb.h"
|
| 47 |
|
| 48 | #ifdef CONFIG_PM
|
| 49 | #define MAYBE_CAP_SUSPEND USBDEVFS_CAP_SUSPEND
|
| 50 | #else
|
| 51 | #define MAYBE_CAP_SUSPEND 0
|
| 52 | #endif
|
| 53 |
|
| 54 | #define USB_MAXBUS 64
|
| 55 | #define USB_DEVICE_MAX (USB_MAXBUS * 128)
|
| 56 | #define USB_SG_SIZE 16384
|
| 57 |
|
| 58 |
|
| 59 | static DEFINE_MUTEX(usbfs_mutex);
|
| 60 |
|
| 61 | struct usb_dev_state {
|
| 62 | struct list_head list;
|
| 63 | struct usb_device *dev;
|
| 64 | struct file *file;
|
| 65 | spinlock_t lock;
|
| 66 | struct list_head async_pending;
|
| 67 | struct list_head async_completed;
|
| 68 | struct list_head memory_list;
|
| 69 | wait_queue_head_t wait;
|
| 70 | wait_queue_head_t wait_for_resume;
|
| 71 | unsigned int discsignr;
|
| 72 | struct pid *disc_pid;
|
| 73 | const struct cred *cred;
|
| 74 | sigval_t disccontext;
|
| 75 | unsigned long ifclaimed;
|
| 76 | u32 disabled_bulk_eps;
|
| 77 | unsigned long interface_allowed_mask;
|
| 78 | int not_yet_resumed;
|
| 79 | bool suspend_allowed;
|
| 80 | bool privileges_dropped;
|
| 81 | };
|
| 82 |
|
| 83 | struct usb_memory {
|
| 84 | struct list_head memlist;
|
| 85 | int vma_use_count;
|
| 86 | int urb_use_count;
|
| 87 | u32 size;
|
| 88 | void *mem;
|
| 89 | dma_addr_t dma_handle;
|
| 90 | unsigned long vm_start;
|
| 91 | struct usb_dev_state *ps;
|
| 92 | };
|
| 93 |
|
| 94 | struct async {
|
| 95 | struct list_head asynclist;
|
| 96 | struct usb_dev_state *ps;
|
| 97 | struct pid *pid;
|
| 98 | const struct cred *cred;
|
| 99 | unsigned int signr;
|
| 100 | unsigned int ifnum;
|
| 101 | void __user *userbuffer;
|
| 102 | void __user *userurb;
|
| 103 | sigval_t userurb_sigval;
|
| 104 | struct urb *urb;
|
| 105 | struct usb_memory *usbm;
|
| 106 | unsigned int mem_usage;
|
| 107 | int status;
|
| 108 | u8 bulk_addr;
|
| 109 | u8 bulk_status;
|
| 110 | };
|
| 111 |
|
| 112 | static bool usbfs_snoop;
|
| 113 | module_param(usbfs_snoop, bool, S_IRUGO | S_IWUSR);
|
| 114 | MODULE_PARM_DESC(usbfs_snoop, "true to log all usbfs traffic");
|
| 115 |
|
| 116 | static unsigned usbfs_snoop_max = 65536;
|
| 117 | module_param(usbfs_snoop_max, uint, S_IRUGO | S_IWUSR);
|
| 118 | MODULE_PARM_DESC(usbfs_snoop_max,
|
| 119 | "maximum number of bytes to print while snooping");
|
| 120 |
|
| 121 | #define snoop(dev, format, arg...) \
|
| 122 | do { \
|
| 123 | if (usbfs_snoop) \
|
| 124 | dev_info(dev, format, ## arg); \
|
| 125 | } while (0)
|
| 126 |
|
| 127 | enum snoop_when {
|
| 128 | SUBMIT, COMPLETE
|
| 129 | };
|
| 130 |
|
| 131 | #define USB_DEVICE_DEV MKDEV(USB_DEVICE_MAJOR, 0)
|
| 132 |
|
| 133 |
|
| 134 | static u32 usbfs_memory_mb = 16;
|
| 135 | module_param(usbfs_memory_mb, uint, 0644);
|
| 136 | MODULE_PARM_DESC(usbfs_memory_mb,
|
| 137 | "maximum MB allowed for usbfs buffers (0 = no limit)");
|
| 138 |
|
| 139 |
|
| 140 | #define USBFS_XFER_MAX (UINT_MAX / 2 - 1000000)
|
| 141 |
|
| 142 | static DEFINE_SPINLOCK(usbfs_memory_usage_lock);
|
| 143 | static u64 usbfs_memory_usage;
|
| 144 |
|
| 145 |
|
| 146 | static int usbfs_increase_memory_usage(u64 amount)
|
| 147 | {
|
| 148 | u64 lim, total_mem;
|
| 149 | unsigned long flags;
|
| 150 | int ret;
|
| 151 |
|
| 152 | lim = READ_ONCE(usbfs_memory_mb);
|
| 153 | lim <<= 20;
|
| 154 |
|
| 155 | ret = 0;
|
| 156 | spin_lock_irqsave(&usbfs_memory_usage_lock, flags);
|
| 157 | total_mem = usbfs_memory_usage + amount;
|
| 158 | if (lim > 0 && total_mem > lim)
|
| 159 | ret = -ENOMEM;
|
| 160 | else
|
| 161 | usbfs_memory_usage = total_mem;
|
| 162 | spin_unlock_irqrestore(&usbfs_memory_usage_lock, flags);
|
| 163 |
|
| 164 | return ret;
|
| 165 | }
|
| 166 |
|
| 167 |
|
| 168 | static void usbfs_decrease_memory_usage(u64 amount)
|
| 169 | {
|
| 170 | unsigned long flags;
|
| 171 |
|
| 172 | spin_lock_irqsave(&usbfs_memory_usage_lock, flags);
|
| 173 | if (amount > usbfs_memory_usage)
|
| 174 | usbfs_memory_usage = 0;
|
| 175 | else
|
| 176 | usbfs_memory_usage -= amount;
|
| 177 | spin_unlock_irqrestore(&usbfs_memory_usage_lock, flags);
|
| 178 | }
|
| 179 |
|
| 180 | static int connected(struct usb_dev_state *ps)
|
| 181 | {
|
| 182 | return (!list_empty(&ps->list) &&
|
| 183 | ps->dev->state != USB_STATE_NOTATTACHED);
|
| 184 | }
|
| 185 |
|
| 186 | static void dec_usb_memory_use_count(struct usb_memory *usbm, int *count)
|
| 187 | {
|
| 188 | struct usb_dev_state *ps = usbm->ps;
|
| 189 | struct usb_hcd *hcd = bus_to_hcd(ps->dev->bus);
|
| 190 | unsigned long flags;
|
| 191 |
|
| 192 | spin_lock_irqsave(&ps->lock, flags);
|
| 193 | --*count;
|
| 194 | if (usbm->urb_use_count == 0 && usbm->vma_use_count == 0) {
|
| 195 | list_del(&usbm->memlist);
|
| 196 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 197 |
|
| 198 | hcd_buffer_free_pages(hcd, usbm->size,
|
| 199 | usbm->mem, usbm->dma_handle);
|
| 200 | usbfs_decrease_memory_usage(
|
| 201 | usbm->size + sizeof(struct usb_memory));
|
| 202 | kfree(usbm);
|
| 203 | } else {
|
| 204 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 205 | }
|
| 206 | }
|
| 207 |
|
| 208 | static void usbdev_vm_open(struct vm_area_struct *vma)
|
| 209 | {
|
| 210 | struct usb_memory *usbm = vma->vm_private_data;
|
| 211 | unsigned long flags;
|
| 212 |
|
| 213 | spin_lock_irqsave(&usbm->ps->lock, flags);
|
| 214 | ++usbm->vma_use_count;
|
| 215 | spin_unlock_irqrestore(&usbm->ps->lock, flags);
|
| 216 | }
|
| 217 |
|
| 218 | static void usbdev_vm_close(struct vm_area_struct *vma)
|
| 219 | {
|
| 220 | struct usb_memory *usbm = vma->vm_private_data;
|
| 221 |
|
| 222 | dec_usb_memory_use_count(usbm, &usbm->vma_use_count);
|
| 223 | }
|
| 224 |
|
| 225 | static const struct vm_operations_struct usbdev_vm_ops = {
|
| 226 | .open = usbdev_vm_open,
|
| 227 | .close = usbdev_vm_close
|
| 228 | };
|
| 229 |
|
| 230 | static int usbdev_mmap(struct file *file, struct vm_area_struct *vma)
|
| 231 | {
|
| 232 | struct usb_memory *usbm = NULL;
|
| 233 | struct usb_dev_state *ps = file->private_data;
|
| 234 | struct usb_hcd *hcd = bus_to_hcd(ps->dev->bus);
|
| 235 | size_t size = vma->vm_end - vma->vm_start;
|
| 236 | void *mem;
|
| 237 | unsigned long flags;
|
| 238 | dma_addr_t dma_handle = DMA_MAPPING_ERROR;
|
| 239 | int ret;
|
| 240 |
|
| 241 | if (!(file->f_mode & FMODE_WRITE))
|
| 242 | return -EPERM;
|
| 243 |
|
| 244 | ret = usbfs_increase_memory_usage(size + sizeof(struct usb_memory));
|
| 245 | if (ret)
|
| 246 | goto error;
|
| 247 |
|
| 248 | usbm = kzalloc_obj(struct usb_memory);
|
| 249 | if (!usbm) {
|
| 250 | ret = -ENOMEM;
|
| 251 | goto error_decrease_mem;
|
| 252 | }
|
| 253 |
|
| 254 | mem = hcd_buffer_alloc_pages(hcd,
|
| 255 | size, GFP_USER | __GFP_NOWARN, &dma_handle);
|
| 256 | if (!mem) {
|
| 257 | ret = -ENOMEM;
|
| 258 | goto error_free_usbm;
|
| 259 | }
|
| 260 |
|
| 261 | memset(mem, 0, size);
|
| 262 |
|
| 263 | usbm->mem = mem;
|
| 264 | usbm->dma_handle = dma_handle;
|
| 265 | usbm->size = size;
|
| 266 | usbm->ps = ps;
|
| 267 | usbm->vm_start = vma->vm_start;
|
| 268 | usbm->vma_use_count = 1;
|
| 269 | INIT_LIST_HEAD(&usbm->memlist);
|
| 270 |
|
| 271 | |
| 272 | * In DMA-unavailable cases, hcd_buffer_alloc_pages allocates
|
| 273 | * normal pages and assigns DMA_MAPPING_ERROR to dma_handle. Check
|
| 274 | * whether we are in such cases, and then use remap_pfn_range (or
|
| 275 | * dma_mmap_coherent) to map normal (or DMA) pages into the user
|
| 276 | * space, respectively.
|
| 277 |
|
| 278 | if (dma_handle == DMA_MAPPING_ERROR) {
|
| 279 | if (remap_pfn_range(vma, vma->vm_start,
|
| 280 | virt_to_phys(usbm->mem) >> PAGE_SHIFT,
|
| 281 | size, vma->vm_page_prot) < 0) {
|
| 282 | dec_usb_memory_use_count(usbm, &usbm->vma_use_count);
|
| 283 | return -EAGAIN;
|
| 284 | }
|
| 285 | } else {
|
| 286 | if (dma_mmap_coherent(hcd->self.sysdev, vma, mem, dma_handle,
|
| 287 | size)) {
|
| 288 | dec_usb_memory_use_count(usbm, &usbm->vma_use_count);
|
| 289 | return -EAGAIN;
|
| 290 | }
|
| 291 | }
|
| 292 |
|
| 293 | vm_flags_set(vma, VM_IO | VM_DONTEXPAND | VM_DONTDUMP);
|
| 294 | vma->vm_ops = &usbdev_vm_ops;
|
| 295 | vma->vm_private_data = usbm;
|
| 296 |
|
| 297 | spin_lock_irqsave(&ps->lock, flags);
|
| 298 | list_add_tail(&usbm->memlist, &ps->memory_list);
|
| 299 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 300 |
|
| 301 | return 0;
|
| 302 |
|
| 303 | error_free_usbm:
|
| 304 | kfree(usbm);
|
| 305 | error_decrease_mem:
|
| 306 | usbfs_decrease_memory_usage(size + sizeof(struct usb_memory));
|
| 307 | error:
|
| 308 | return ret;
|
| 309 | }
|
| 310 |
|
| 311 | static ssize_t usbdev_read(struct file *file, char __user *buf, size_t nbytes,
|
| 312 | loff_t *ppos)
|
| 313 | {
|
| 314 | struct usb_dev_state *ps = file->private_data;
|
| 315 | struct usb_device *dev = ps->dev;
|
| 316 | ssize_t ret = 0;
|
| 317 | unsigned len;
|
| 318 | loff_t pos;
|
| 319 | int i;
|
| 320 |
|
| 321 | pos = *ppos;
|
| 322 | usb_lock_device(dev);
|
| 323 | if (!connected(ps)) {
|
| 324 | ret = -ENODEV;
|
| 325 | goto err;
|
| 326 | } else if (pos < 0) {
|
| 327 | ret = -EINVAL;
|
| 328 | goto err;
|
| 329 | }
|
| 330 |
|
| 331 | if (pos < sizeof(struct usb_device_descriptor)) {
|
| 332 |
|
| 333 | struct usb_device_descriptor temp_desc;
|
| 334 |
|
| 335 | memcpy(&temp_desc, &dev->descriptor, sizeof(dev->descriptor));
|
| 336 | le16_to_cpus(&temp_desc.bcdUSB);
|
| 337 | le16_to_cpus(&temp_desc.idVendor);
|
| 338 | le16_to_cpus(&temp_desc.idProduct);
|
| 339 | le16_to_cpus(&temp_desc.bcdDevice);
|
| 340 |
|
| 341 | len = sizeof(struct usb_device_descriptor) - pos;
|
| 342 | if (len > nbytes)
|
| 343 | len = nbytes;
|
| 344 | if (copy_to_user(buf, ((char *)&temp_desc) + pos, len)) {
|
| 345 | ret = -EFAULT;
|
| 346 | goto err;
|
| 347 | }
|
| 348 |
|
| 349 | *ppos += len;
|
| 350 | buf += len;
|
| 351 | nbytes -= len;
|
| 352 | ret += len;
|
| 353 | }
|
| 354 |
|
| 355 | pos = sizeof(struct usb_device_descriptor);
|
| 356 | for (i = 0; nbytes && i < dev->descriptor.bNumConfigurations; i++) {
|
| 357 | struct usb_config_descriptor *config =
|
| 358 | (struct usb_config_descriptor *)dev->rawdescriptors[i];
|
| 359 | unsigned int length = le16_to_cpu(config->wTotalLength);
|
| 360 |
|
| 361 | if (*ppos < pos + length) {
|
| 362 |
|
| 363 | |
| 364 | * really is. Here is the actual allocated length.
|
| 365 | unsigned alloclen =
|
| 366 | le16_to_cpu(dev->config[i].desc.wTotalLength);
|
| 367 |
|
| 368 | len = length - (*ppos - pos);
|
| 369 | if (len > nbytes)
|
| 370 | len = nbytes;
|
| 371 |
|
| 372 |
|
| 373 | if (alloclen > (*ppos - pos)) {
|
| 374 | alloclen -= (*ppos - pos);
|
| 375 | if (copy_to_user(buf,
|
| 376 | dev->rawdescriptors[i] + (*ppos - pos),
|
| 377 | min(len, alloclen))) {
|
| 378 | ret = -EFAULT;
|
| 379 | goto err;
|
| 380 | }
|
| 381 | }
|
| 382 |
|
| 383 | *ppos += len;
|
| 384 | buf += len;
|
| 385 | nbytes -= len;
|
| 386 | ret += len;
|
| 387 | }
|
| 388 |
|
| 389 | pos += length;
|
| 390 | }
|
| 391 |
|
| 392 | err:
|
| 393 | usb_unlock_device(dev);
|
| 394 | return ret;
|
| 395 | }
|
| 396 |
|
| 397 | |
| 398 | * async list handling
|
| 399 |
|
| 400 |
|
| 401 | static struct async *alloc_async(unsigned int numisoframes)
|
| 402 | {
|
| 403 | struct async *as;
|
| 404 |
|
| 405 | as = kzalloc_obj(struct async);
|
| 406 | if (!as)
|
| 407 | return NULL;
|
| 408 | as->urb = usb_alloc_urb(numisoframes, GFP_KERNEL);
|
| 409 | if (!as->urb) {
|
| 410 | kfree(as);
|
| 411 | return NULL;
|
| 412 | }
|
| 413 | return as;
|
| 414 | }
|
| 415 |
|
| 416 | static void free_async(struct async *as)
|
| 417 | {
|
| 418 | int i;
|
| 419 |
|
| 420 | put_pid(as->pid);
|
| 421 | if (as->cred)
|
| 422 | put_cred(as->cred);
|
| 423 | for (i = 0; i < as->urb->num_sgs; i++) {
|
| 424 | if (sg_page(&as->urb->sg[i]))
|
| 425 | kfree(sg_virt(&as->urb->sg[i]));
|
| 426 | }
|
| 427 |
|
| 428 | kfree(as->urb->sg);
|
| 429 | if (as->usbm == NULL)
|
| 430 | kfree(as->urb->transfer_buffer);
|
| 431 | else
|
| 432 | dec_usb_memory_use_count(as->usbm, &as->usbm->urb_use_count);
|
| 433 |
|
| 434 | kfree(as->urb->setup_packet);
|
| 435 | usb_free_urb(as->urb);
|
| 436 | usbfs_decrease_memory_usage(as->mem_usage);
|
| 437 | kfree(as);
|
| 438 | }
|
| 439 |
|
| 440 | static void async_newpending(struct async *as)
|
| 441 | {
|
| 442 | struct usb_dev_state *ps = as->ps;
|
| 443 | unsigned long flags;
|
| 444 |
|
| 445 | spin_lock_irqsave(&ps->lock, flags);
|
| 446 | list_add_tail(&as->asynclist, &ps->async_pending);
|
| 447 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 448 | }
|
| 449 |
|
| 450 | static void async_removepending(struct async *as)
|
| 451 | {
|
| 452 | struct usb_dev_state *ps = as->ps;
|
| 453 | unsigned long flags;
|
| 454 |
|
| 455 | spin_lock_irqsave(&ps->lock, flags);
|
| 456 | list_del_init(&as->asynclist);
|
| 457 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 458 | }
|
| 459 |
|
| 460 | static struct async *async_getcompleted(struct usb_dev_state *ps)
|
| 461 | {
|
| 462 | unsigned long flags;
|
| 463 | struct async *as = NULL;
|
| 464 |
|
| 465 | spin_lock_irqsave(&ps->lock, flags);
|
| 466 | if (!list_empty(&ps->async_completed)) {
|
| 467 | as = list_entry(ps->async_completed.next, struct async,
|
| 468 | asynclist);
|
| 469 | list_del_init(&as->asynclist);
|
| 470 | }
|
| 471 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 472 | return as;
|
| 473 | }
|
| 474 |
|
| 475 | static struct async *async_getpending(struct usb_dev_state *ps,
|
| 476 | void __user *userurb)
|
| 477 | {
|
| 478 | struct async *as;
|
| 479 |
|
| 480 | list_for_each_entry(as, &ps->async_pending, asynclist)
|
| 481 | if (as->userurb == userurb) {
|
| 482 | list_del_init(&as->asynclist);
|
| 483 | return as;
|
| 484 | }
|
| 485 |
|
| 486 | return NULL;
|
| 487 | }
|
| 488 |
|
| 489 | static void snoop_urb(struct usb_device *udev,
|
| 490 | void __user *userurb, int pipe, unsigned length,
|
| 491 | int timeout_or_status, enum snoop_when when,
|
| 492 | unsigned char *data, unsigned data_len)
|
| 493 | {
|
| 494 | static const char *types[] = {"isoc", "int", "ctrl", "bulk"};
|
| 495 | static const char *dirs[] = {"out", "in"};
|
| 496 | int ep;
|
| 497 | const char *t, *d;
|
| 498 |
|
| 499 | if (!usbfs_snoop)
|
| 500 | return;
|
| 501 |
|
| 502 | ep = usb_pipeendpoint(pipe);
|
| 503 | t = types[usb_pipetype(pipe)];
|
| 504 | d = dirs[!!usb_pipein(pipe)];
|
| 505 |
|
| 506 | if (userurb) {
|
| 507 | if (when == SUBMIT)
|
| 508 | dev_info(&udev->dev, "userurb %px, ep%d %s-%s, "
|
| 509 | "length %u\n",
|
| 510 | userurb, ep, t, d, length);
|
| 511 | else
|
| 512 | dev_info(&udev->dev, "userurb %px, ep%d %s-%s, "
|
| 513 | "actual_length %u status %d\n",
|
| 514 | userurb, ep, t, d, length,
|
| 515 | timeout_or_status);
|
| 516 | } else {
|
| 517 | if (when == SUBMIT)
|
| 518 | dev_info(&udev->dev, "ep%d %s-%s, length %u, "
|
| 519 | "timeout %d\n",
|
| 520 | ep, t, d, length, timeout_or_status);
|
| 521 | else
|
| 522 | dev_info(&udev->dev, "ep%d %s-%s, actual_length %u, "
|
| 523 | "status %d\n",
|
| 524 | ep, t, d, length, timeout_or_status);
|
| 525 | }
|
| 526 |
|
| 527 | data_len = min(data_len, usbfs_snoop_max);
|
| 528 | if (data && data_len > 0) {
|
| 529 | print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
|
| 530 | data, data_len, 1);
|
| 531 | }
|
| 532 | }
|
| 533 |
|
| 534 | static void snoop_urb_data(struct urb *urb, unsigned len)
|
| 535 | {
|
| 536 | int i, size;
|
| 537 |
|
| 538 | len = min(len, usbfs_snoop_max);
|
| 539 | if (!usbfs_snoop || len == 0)
|
| 540 | return;
|
| 541 |
|
| 542 | if (urb->num_sgs == 0) {
|
| 543 | print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
|
| 544 | urb->transfer_buffer, len, 1);
|
| 545 | return;
|
| 546 | }
|
| 547 |
|
| 548 | for (i = 0; i < urb->num_sgs && len; i++) {
|
| 549 | size = (len > USB_SG_SIZE) ? USB_SG_SIZE : len;
|
| 550 | print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
|
| 551 | sg_virt(&urb->sg[i]), size, 1);
|
| 552 | len -= size;
|
| 553 | }
|
| 554 | }
|
| 555 |
|
| 556 | static int copy_urb_data_to_user(u8 __user *userbuffer, struct urb *urb)
|
| 557 | {
|
| 558 | unsigned i, len, size;
|
| 559 |
|
| 560 | if (urb->number_of_packets > 0)
|
| 561 | len = urb->transfer_buffer_length;
|
| 562 | else
|
| 563 | len = urb->actual_length;
|
| 564 |
|
| 565 | if (urb->num_sgs == 0) {
|
| 566 | if (copy_to_user(userbuffer, urb->transfer_buffer, len))
|
| 567 | return -EFAULT;
|
| 568 | return 0;
|
| 569 | }
|
| 570 |
|
| 571 | for (i = 0; i < urb->num_sgs && len; i++) {
|
| 572 | size = (len > USB_SG_SIZE) ? USB_SG_SIZE : len;
|
| 573 | if (copy_to_user(userbuffer, sg_virt(&urb->sg[i]), size))
|
| 574 | return -EFAULT;
|
| 575 | userbuffer += size;
|
| 576 | len -= size;
|
| 577 | }
|
| 578 |
|
| 579 | return 0;
|
| 580 | }
|
| 581 |
|
| 582 | #define AS_CONTINUATION 1
|
| 583 | #define AS_UNLINK 2
|
| 584 |
|
| 585 | static void cancel_bulk_urbs(struct usb_dev_state *ps, unsigned bulk_addr)
|
| 586 | __releases(ps->lock)
|
| 587 | __acquires(ps->lock)
|
| 588 | {
|
| 589 | struct urb *urb;
|
| 590 | struct async *as;
|
| 591 |
|
| 592 | |
| 593 | * including the first one without AS_CONTINUATION. If such an
|
| 594 | * URB is encountered then a new transfer has already started so
|
| 595 | * the endpoint doesn't need to be disabled; otherwise it does.
|
| 596 |
|
| 597 | list_for_each_entry(as, &ps->async_pending, asynclist) {
|
| 598 | if (as->bulk_addr == bulk_addr) {
|
| 599 | if (as->bulk_status != AS_CONTINUATION)
|
| 600 | goto rescan;
|
| 601 | as->bulk_status = AS_UNLINK;
|
| 602 | as->bulk_addr = 0;
|
| 603 | }
|
| 604 | }
|
| 605 | ps->disabled_bulk_eps |= (1 << bulk_addr);
|
| 606 |
|
| 607 |
|
| 608 | rescan:
|
| 609 | list_for_each_entry_reverse(as, &ps->async_pending, asynclist) {
|
| 610 | if (as->bulk_status == AS_UNLINK) {
|
| 611 | as->bulk_status = 0;
|
| 612 | urb = as->urb;
|
| 613 | usb_get_urb(urb);
|
| 614 | spin_unlock(&ps->lock);
|
| 615 | usb_unlink_urb(urb);
|
| 616 | usb_put_urb(urb);
|
| 617 | spin_lock(&ps->lock);
|
| 618 | goto rescan;
|
| 619 | }
|
| 620 | }
|
| 621 | }
|
| 622 |
|
| 623 | static void async_completed(struct urb *urb)
|
| 624 | {
|
| 625 | struct async *as = urb->context;
|
| 626 | struct usb_dev_state *ps = as->ps;
|
| 627 | struct pid *pid = NULL;
|
| 628 | const struct cred *cred = NULL;
|
| 629 | unsigned long flags;
|
| 630 | sigval_t addr;
|
| 631 | int signr, errno;
|
| 632 |
|
| 633 | spin_lock_irqsave(&ps->lock, flags);
|
| 634 | list_move_tail(&as->asynclist, &ps->async_completed);
|
| 635 | as->status = urb->status;
|
| 636 | signr = as->signr;
|
| 637 | if (signr) {
|
| 638 | errno = as->status;
|
| 639 | addr = as->userurb_sigval;
|
| 640 | pid = get_pid(as->pid);
|
| 641 | cred = get_cred(as->cred);
|
| 642 | }
|
| 643 | snoop(&urb->dev->dev, "urb complete\n");
|
| 644 | snoop_urb(urb->dev, as->userurb, urb->pipe, urb->actual_length,
|
| 645 | as->status, COMPLETE, NULL, 0);
|
| 646 | if (usb_urb_dir_in(urb))
|
| 647 | snoop_urb_data(urb, urb->actual_length);
|
| 648 |
|
| 649 | if (as->status < 0 && as->bulk_addr && as->status != -ECONNRESET &&
|
| 650 | as->status != -ENOENT)
|
| 651 | cancel_bulk_urbs(ps, as->bulk_addr);
|
| 652 |
|
| 653 | wake_up(&ps->wait);
|
| 654 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 655 |
|
| 656 | if (signr) {
|
| 657 | kill_pid_usb_asyncio(signr, errno, addr, pid, cred);
|
| 658 | put_pid(pid);
|
| 659 | put_cred(cred);
|
| 660 | }
|
| 661 | }
|
| 662 |
|
| 663 | static void destroy_async(struct usb_dev_state *ps, struct list_head *list)
|
| 664 | {
|
| 665 | struct urb *urb;
|
| 666 | struct async *as;
|
| 667 | unsigned long flags;
|
| 668 |
|
| 669 | spin_lock_irqsave(&ps->lock, flags);
|
| 670 | while (!list_empty(list)) {
|
| 671 | as = list_last_entry(list, struct async, asynclist);
|
| 672 | list_del_init(&as->asynclist);
|
| 673 | urb = as->urb;
|
| 674 | usb_get_urb(urb);
|
| 675 |
|
| 676 |
|
| 677 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 678 | usb_kill_urb(urb);
|
| 679 | usb_put_urb(urb);
|
| 680 | spin_lock_irqsave(&ps->lock, flags);
|
| 681 | }
|
| 682 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 683 | }
|
| 684 |
|
| 685 | static void destroy_async_on_interface(struct usb_dev_state *ps,
|
| 686 | unsigned int ifnum)
|
| 687 | {
|
| 688 | struct list_head *p, *q, hitlist;
|
| 689 | unsigned long flags;
|
| 690 |
|
| 691 | INIT_LIST_HEAD(&hitlist);
|
| 692 | spin_lock_irqsave(&ps->lock, flags);
|
| 693 | list_for_each_safe(p, q, &ps->async_pending)
|
| 694 | if (ifnum == list_entry(p, struct async, asynclist)->ifnum)
|
| 695 | list_move_tail(p, &hitlist);
|
| 696 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 697 | destroy_async(ps, &hitlist);
|
| 698 | }
|
| 699 |
|
| 700 | static void destroy_all_async(struct usb_dev_state *ps)
|
| 701 | {
|
| 702 | destroy_async(ps, &ps->async_pending);
|
| 703 | }
|
| 704 |
|
| 705 | |
| 706 | * interface claims are made only at the request of user level code,
|
| 707 | * which can also release them (explicitly or by closing files).
|
| 708 | * they're also undone when devices disconnect.
|
| 709 |
|
| 710 |
|
| 711 | static int driver_probe(struct usb_interface *intf,
|
| 712 | const struct usb_device_id *id)
|
| 713 | {
|
| 714 | return -ENODEV;
|
| 715 | }
|
| 716 |
|
| 717 | static void driver_disconnect(struct usb_interface *intf)
|
| 718 | {
|
| 719 | struct usb_dev_state *ps = usb_get_intfdata(intf);
|
| 720 | unsigned int ifnum = intf->altsetting->desc.bInterfaceNumber;
|
| 721 |
|
| 722 | if (!ps)
|
| 723 | return;
|
| 724 |
|
| 725 | |
| 726 | * all pending I/O requests; 2.6 does that.
|
| 727 |
|
| 728 |
|
| 729 | if (likely(ifnum < 8*sizeof(ps->ifclaimed)))
|
| 730 | clear_bit(ifnum, &ps->ifclaimed);
|
| 731 | else
|
| 732 | dev_warn(&intf->dev, "interface number %u out of range\n",
|
| 733 | ifnum);
|
| 734 |
|
| 735 | usb_set_intfdata(intf, NULL);
|
| 736 |
|
| 737 |
|
| 738 | destroy_async_on_interface(ps, ifnum);
|
| 739 | }
|
| 740 |
|
| 741 |
|
| 742 | static int driver_suspend(struct usb_interface *intf, pm_message_t msg)
|
| 743 | {
|
| 744 | return 0;
|
| 745 | }
|
| 746 |
|
| 747 | static int driver_resume(struct usb_interface *intf)
|
| 748 | {
|
| 749 | return 0;
|
| 750 | }
|
| 751 |
|
| 752 | #ifdef CONFIG_PM
|
| 753 |
|
| 754 | void usbfs_notify_suspend(struct usb_device *udev)
|
| 755 | {
|
| 756 |
|
| 757 | }
|
| 758 |
|
| 759 | void usbfs_notify_resume(struct usb_device *udev)
|
| 760 | {
|
| 761 | struct usb_dev_state *ps;
|
| 762 |
|
| 763 |
|
| 764 | mutex_lock(&usbfs_mutex);
|
| 765 | list_for_each_entry(ps, &udev->filelist, list) {
|
| 766 | WRITE_ONCE(ps->not_yet_resumed, 0);
|
| 767 | wake_up_all(&ps->wait_for_resume);
|
| 768 | }
|
| 769 | mutex_unlock(&usbfs_mutex);
|
| 770 | }
|
| 771 | #endif
|
| 772 |
|
| 773 | struct usb_driver usbfs_driver = {
|
| 774 | .name = "usbfs",
|
| 775 | .probe = driver_probe,
|
| 776 | .disconnect = driver_disconnect,
|
| 777 | .suspend = driver_suspend,
|
| 778 | .resume = driver_resume,
|
| 779 | .supports_autosuspend = 1,
|
| 780 | };
|
| 781 |
|
| 782 | static int claimintf(struct usb_dev_state *ps, unsigned int ifnum)
|
| 783 | {
|
| 784 | struct usb_device *dev = ps->dev;
|
| 785 | struct usb_interface *intf;
|
| 786 | int err;
|
| 787 |
|
| 788 | if (ifnum >= 8*sizeof(ps->ifclaimed))
|
| 789 | return -EINVAL;
|
| 790 |
|
| 791 | if (test_bit(ifnum, &ps->ifclaimed))
|
| 792 | return 0;
|
| 793 |
|
| 794 | if (ps->privileges_dropped &&
|
| 795 | !test_bit(ifnum, &ps->interface_allowed_mask))
|
| 796 | return -EACCES;
|
| 797 |
|
| 798 | intf = usb_ifnum_to_if(dev, ifnum);
|
| 799 | if (!intf)
|
| 800 | err = -ENOENT;
|
| 801 | else {
|
| 802 | unsigned int old_suppress;
|
| 803 |
|
| 804 |
|
| 805 | old_suppress = dev_get_uevent_suppress(&intf->dev);
|
| 806 | dev_set_uevent_suppress(&intf->dev, 1);
|
| 807 | err = usb_driver_claim_interface(&usbfs_driver, intf, ps);
|
| 808 | dev_set_uevent_suppress(&intf->dev, old_suppress);
|
| 809 | }
|
| 810 | if (err == 0)
|
| 811 | set_bit(ifnum, &ps->ifclaimed);
|
| 812 | return err;
|
| 813 | }
|
| 814 |
|
| 815 | static int releaseintf(struct usb_dev_state *ps, unsigned int ifnum)
|
| 816 | {
|
| 817 | struct usb_device *dev;
|
| 818 | struct usb_interface *intf;
|
| 819 | int err;
|
| 820 |
|
| 821 | err = -EINVAL;
|
| 822 | if (ifnum >= 8*sizeof(ps->ifclaimed))
|
| 823 | return err;
|
| 824 | dev = ps->dev;
|
| 825 | intf = usb_ifnum_to_if(dev, ifnum);
|
| 826 | if (!intf)
|
| 827 | err = -ENOENT;
|
| 828 | else if (test_and_clear_bit(ifnum, &ps->ifclaimed)) {
|
| 829 | unsigned int old_suppress;
|
| 830 |
|
| 831 |
|
| 832 | old_suppress = dev_get_uevent_suppress(&intf->dev);
|
| 833 | dev_set_uevent_suppress(&intf->dev, 1);
|
| 834 | usb_driver_release_interface(&usbfs_driver, intf);
|
| 835 | dev_set_uevent_suppress(&intf->dev, old_suppress);
|
| 836 | err = 0;
|
| 837 | }
|
| 838 | return err;
|
| 839 | }
|
| 840 |
|
| 841 | static int checkintf(struct usb_dev_state *ps, unsigned int ifnum)
|
| 842 | {
|
| 843 | if (ps->dev->state != USB_STATE_CONFIGURED)
|
| 844 | return -EHOSTUNREACH;
|
| 845 | if (ifnum >= 8*sizeof(ps->ifclaimed))
|
| 846 | return -EINVAL;
|
| 847 | if (test_bit(ifnum, &ps->ifclaimed))
|
| 848 | return 0;
|
| 849 |
|
| 850 | dev_warn(&ps->dev->dev, "usbfs: process %d (%s) did not claim "
|
| 851 | "interface %u before use\n", task_pid_nr(current),
|
| 852 | current->comm, ifnum);
|
| 853 | return claimintf(ps, ifnum);
|
| 854 | }
|
| 855 |
|
| 856 | static int findintfep(struct usb_device *dev, unsigned int ep)
|
| 857 | {
|
| 858 | unsigned int i, j, e;
|
| 859 | struct usb_interface *intf;
|
| 860 | struct usb_host_interface *alts;
|
| 861 | struct usb_endpoint_descriptor *endpt;
|
| 862 |
|
| 863 | if (ep & ~(USB_DIR_IN|0xf))
|
| 864 | return -EINVAL;
|
| 865 | if (!dev->actconfig)
|
| 866 | return -ESRCH;
|
| 867 | for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
|
| 868 | intf = dev->actconfig->interface[i];
|
| 869 | for (j = 0; j < intf->num_altsetting; j++) {
|
| 870 | alts = &intf->altsetting[j];
|
| 871 | for (e = 0; e < alts->desc.bNumEndpoints; e++) {
|
| 872 | endpt = &alts->endpoint[e].desc;
|
| 873 | if (endpt->bEndpointAddress == ep)
|
| 874 | return alts->desc.bInterfaceNumber;
|
| 875 | }
|
| 876 | }
|
| 877 | }
|
| 878 | return -ENOENT;
|
| 879 | }
|
| 880 |
|
| 881 | static int check_ctrlrecip(struct usb_dev_state *ps, unsigned int requesttype,
|
| 882 | unsigned int request, unsigned int index)
|
| 883 | {
|
| 884 | int ret = 0;
|
| 885 | struct usb_host_interface *alt_setting;
|
| 886 |
|
| 887 | if (ps->dev->state != USB_STATE_UNAUTHENTICATED
|
| 888 | && ps->dev->state != USB_STATE_ADDRESS
|
| 889 | && ps->dev->state != USB_STATE_CONFIGURED)
|
| 890 | return -EHOSTUNREACH;
|
| 891 | if (USB_TYPE_VENDOR == (USB_TYPE_MASK & requesttype))
|
| 892 | return 0;
|
| 893 |
|
| 894 | |
| 895 | * check for the special corner case 'get_device_id' in the printer
|
| 896 | * class specification, which we always want to allow as it is used
|
| 897 | * to query things like ink level, etc.
|
| 898 |
|
| 899 | if (requesttype == 0xa1 && request == 0) {
|
| 900 | alt_setting = usb_find_alt_setting(ps->dev->actconfig,
|
| 901 | index >> 8, index & 0xff);
|
| 902 | if (alt_setting
|
| 903 | && alt_setting->desc.bInterfaceClass == USB_CLASS_PRINTER)
|
| 904 | return 0;
|
| 905 | }
|
| 906 |
|
| 907 | index &= 0xff;
|
| 908 | switch (requesttype & USB_RECIP_MASK) {
|
| 909 | case USB_RECIP_ENDPOINT:
|
| 910 | if ((index & ~USB_DIR_IN) == 0)
|
| 911 | return 0;
|
| 912 | ret = findintfep(ps->dev, index);
|
| 913 | if (ret < 0) {
|
| 914 | |
| 915 | * Some not fully compliant Win apps seem to get
|
| 916 | * index wrong and have the endpoint number here
|
| 917 | * rather than the endpoint address (with the
|
| 918 | * correct direction). Win does let this through,
|
| 919 | * so we'll not reject it here but leave it to
|
| 920 | * the device to not break KVM. But we warn.
|
| 921 |
|
| 922 | ret = findintfep(ps->dev, index ^ 0x80);
|
| 923 | if (ret >= 0)
|
| 924 | dev_info(&ps->dev->dev,
|
| 925 | "%s: process %i (%s) requesting ep %02x but needs %02x\n",
|
| 926 | __func__, task_pid_nr(current),
|
| 927 | current->comm, index, index ^ 0x80);
|
| 928 | }
|
| 929 | if (ret >= 0)
|
| 930 | ret = checkintf(ps, ret);
|
| 931 | break;
|
| 932 |
|
| 933 | case USB_RECIP_INTERFACE:
|
| 934 | ret = checkintf(ps, index);
|
| 935 | break;
|
| 936 | }
|
| 937 | return ret;
|
| 938 | }
|
| 939 |
|
| 940 | static struct usb_host_endpoint *ep_to_host_endpoint(struct usb_device *dev,
|
| 941 | unsigned char ep)
|
| 942 | {
|
| 943 | if (ep & USB_ENDPOINT_DIR_MASK)
|
| 944 | return dev->ep_in[ep & USB_ENDPOINT_NUMBER_MASK];
|
| 945 | else
|
| 946 | return dev->ep_out[ep & USB_ENDPOINT_NUMBER_MASK];
|
| 947 | }
|
| 948 |
|
| 949 | static int parse_usbdevfs_streams(struct usb_dev_state *ps,
|
| 950 | struct usbdevfs_streams __user *streams,
|
| 951 | unsigned int *num_streams_ret,
|
| 952 | unsigned int *num_eps_ret,
|
| 953 | struct usb_host_endpoint ***eps_ret,
|
| 954 | struct usb_interface **intf_ret)
|
| 955 | {
|
| 956 | unsigned int i, num_streams, num_eps;
|
| 957 | struct usb_host_endpoint **eps;
|
| 958 | struct usb_interface *intf = NULL;
|
| 959 | unsigned char ep;
|
| 960 | int ifnum, ret;
|
| 961 |
|
| 962 | if (get_user(num_streams, &streams->num_streams) ||
|
| 963 | get_user(num_eps, &streams->num_eps))
|
| 964 | return -EFAULT;
|
| 965 |
|
| 966 | if (num_eps < 1 || num_eps > USB_MAXENDPOINTS)
|
| 967 | return -EINVAL;
|
| 968 |
|
| 969 |
|
| 970 | if (num_streams_ret && (num_streams < 2 || num_streams > 65536))
|
| 971 | return -EINVAL;
|
| 972 |
|
| 973 | eps = kmalloc_objs(*eps, num_eps);
|
| 974 | if (!eps)
|
| 975 | return -ENOMEM;
|
| 976 |
|
| 977 | for (i = 0; i < num_eps; i++) {
|
| 978 | if (get_user(ep, &streams->eps[i])) {
|
| 979 | ret = -EFAULT;
|
| 980 | goto error;
|
| 981 | }
|
| 982 | eps[i] = ep_to_host_endpoint(ps->dev, ep);
|
| 983 | if (!eps[i]) {
|
| 984 | ret = -EINVAL;
|
| 985 | goto error;
|
| 986 | }
|
| 987 |
|
| 988 |
|
| 989 | ifnum = findintfep(ps->dev, ep);
|
| 990 | if (ifnum < 0) {
|
| 991 | ret = ifnum;
|
| 992 | goto error;
|
| 993 | }
|
| 994 |
|
| 995 | if (i == 0) {
|
| 996 | ret = checkintf(ps, ifnum);
|
| 997 | if (ret < 0)
|
| 998 | goto error;
|
| 999 | intf = usb_ifnum_to_if(ps->dev, ifnum);
|
| 1000 | } else {
|
| 1001 |
|
| 1002 | if (ifnum != intf->altsetting->desc.bInterfaceNumber) {
|
| 1003 | ret = -EINVAL;
|
| 1004 | goto error;
|
| 1005 | }
|
| 1006 | }
|
| 1007 | }
|
| 1008 |
|
| 1009 | if (num_streams_ret)
|
| 1010 | *num_streams_ret = num_streams;
|
| 1011 | *num_eps_ret = num_eps;
|
| 1012 | *eps_ret = eps;
|
| 1013 | *intf_ret = intf;
|
| 1014 |
|
| 1015 | return 0;
|
| 1016 |
|
| 1017 | error:
|
| 1018 | kfree(eps);
|
| 1019 | return ret;
|
| 1020 | }
|
| 1021 |
|
| 1022 | static struct usb_device *usbdev_lookup_by_devt(dev_t devt)
|
| 1023 | {
|
| 1024 | struct device *dev;
|
| 1025 |
|
| 1026 | dev = bus_find_device_by_devt(&usb_bus_type, devt);
|
| 1027 | if (!dev)
|
| 1028 | return NULL;
|
| 1029 | return to_usb_device(dev);
|
| 1030 | }
|
| 1031 |
|
| 1032 | |
| 1033 | * file operations
|
| 1034 |
|
| 1035 | static int usbdev_open(struct inode *inode, struct file *file)
|
| 1036 | {
|
| 1037 | struct usb_device *dev = NULL;
|
| 1038 | struct usb_dev_state *ps;
|
| 1039 | int ret;
|
| 1040 |
|
| 1041 | ret = -ENOMEM;
|
| 1042 | ps = kzalloc_obj(struct usb_dev_state);
|
| 1043 | if (!ps)
|
| 1044 | goto out_free_ps;
|
| 1045 |
|
| 1046 | ret = -ENODEV;
|
| 1047 |
|
| 1048 |
|
| 1049 | if (imajor(inode) == USB_DEVICE_MAJOR)
|
| 1050 | dev = usbdev_lookup_by_devt(inode->i_rdev);
|
| 1051 | if (!dev)
|
| 1052 | goto out_free_ps;
|
| 1053 |
|
| 1054 | usb_lock_device(dev);
|
| 1055 | if (dev->state == USB_STATE_NOTATTACHED)
|
| 1056 | goto out_unlock_device;
|
| 1057 |
|
| 1058 | ret = usb_autoresume_device(dev);
|
| 1059 | if (ret)
|
| 1060 | goto out_unlock_device;
|
| 1061 |
|
| 1062 | ps->dev = dev;
|
| 1063 | ps->file = file;
|
| 1064 | ps->interface_allowed_mask = 0xFFFFFFFF;
|
| 1065 | spin_lock_init(&ps->lock);
|
| 1066 | INIT_LIST_HEAD(&ps->list);
|
| 1067 | INIT_LIST_HEAD(&ps->async_pending);
|
| 1068 | INIT_LIST_HEAD(&ps->async_completed);
|
| 1069 | INIT_LIST_HEAD(&ps->memory_list);
|
| 1070 | init_waitqueue_head(&ps->wait);
|
| 1071 | init_waitqueue_head(&ps->wait_for_resume);
|
| 1072 | ps->disc_pid = get_pid(task_pid(current));
|
| 1073 | ps->cred = get_current_cred();
|
| 1074 | smp_wmb();
|
| 1075 |
|
| 1076 |
|
| 1077 | list_add_tail(&ps->list, &dev->filelist);
|
| 1078 | file->private_data = ps;
|
| 1079 | usb_unlock_device(dev);
|
| 1080 | snoop(&dev->dev, "opened by process %d: %s\n", task_pid_nr(current),
|
| 1081 | current->comm);
|
| 1082 | return ret;
|
| 1083 |
|
| 1084 | out_unlock_device:
|
| 1085 | usb_unlock_device(dev);
|
| 1086 | usb_put_dev(dev);
|
| 1087 | out_free_ps:
|
| 1088 | kfree(ps);
|
| 1089 | return ret;
|
| 1090 | }
|
| 1091 |
|
| 1092 | static int usbdev_release(struct inode *inode, struct file *file)
|
| 1093 | {
|
| 1094 | struct usb_dev_state *ps = file->private_data;
|
| 1095 | struct usb_device *dev = ps->dev;
|
| 1096 | unsigned int ifnum;
|
| 1097 | struct async *as;
|
| 1098 |
|
| 1099 | usb_lock_device(dev);
|
| 1100 | usb_hub_release_all_ports(dev, ps);
|
| 1101 |
|
| 1102 |
|
| 1103 | mutex_lock(&usbfs_mutex);
|
| 1104 | list_del_init(&ps->list);
|
| 1105 | mutex_unlock(&usbfs_mutex);
|
| 1106 |
|
| 1107 | for (ifnum = 0; ps->ifclaimed && ifnum < 8*sizeof(ps->ifclaimed);
|
| 1108 | ifnum++) {
|
| 1109 | if (test_bit(ifnum, &ps->ifclaimed))
|
| 1110 | releaseintf(ps, ifnum);
|
| 1111 | }
|
| 1112 | destroy_all_async(ps);
|
| 1113 | if (!ps->suspend_allowed)
|
| 1114 | usb_autosuspend_device(dev);
|
| 1115 | usb_unlock_device(dev);
|
| 1116 | put_pid(ps->disc_pid);
|
| 1117 | put_cred(ps->cred);
|
| 1118 |
|
| 1119 | as = async_getcompleted(ps);
|
| 1120 | while (as) {
|
| 1121 | free_async(as);
|
| 1122 | as = async_getcompleted(ps);
|
| 1123 | }
|
| 1124 | usb_put_dev(dev);
|
| 1125 |
|
| 1126 | kfree(ps);
|
| 1127 | return 0;
|
| 1128 | }
|
| 1129 |
|
| 1130 | static void usbfs_blocking_completion(struct urb *urb)
|
| 1131 | {
|
| 1132 | complete((struct completion *) urb->context);
|
| 1133 | }
|
| 1134 |
|
| 1135 | |
| 1136 | * Much like usb_start_wait_urb, but returns status separately from
|
| 1137 | * actual_length and uses a killable wait.
|
| 1138 |
|
| 1139 | static int usbfs_start_wait_urb(struct urb *urb, int timeout,
|
| 1140 | unsigned int *actlen)
|
| 1141 | {
|
| 1142 | DECLARE_COMPLETION_ONSTACK(ctx);
|
| 1143 | unsigned long expire;
|
| 1144 | int rc;
|
| 1145 |
|
| 1146 | urb->context = &ctx;
|
| 1147 | urb->complete = usbfs_blocking_completion;
|
| 1148 | *actlen = 0;
|
| 1149 | rc = usb_submit_urb(urb, GFP_KERNEL);
|
| 1150 | if (unlikely(rc))
|
| 1151 | return rc;
|
| 1152 |
|
| 1153 | expire = (timeout ? msecs_to_jiffies(timeout) : MAX_SCHEDULE_TIMEOUT);
|
| 1154 | rc = wait_for_completion_killable_timeout(&ctx, expire);
|
| 1155 | if (rc <= 0) {
|
| 1156 | usb_kill_urb(urb);
|
| 1157 | *actlen = urb->actual_length;
|
| 1158 | if (urb->status != -ENOENT)
|
| 1159 | ;
|
| 1160 | else if (rc < 0)
|
| 1161 | return -EINTR;
|
| 1162 | else
|
| 1163 | return -ETIMEDOUT;
|
| 1164 | }
|
| 1165 | *actlen = urb->actual_length;
|
| 1166 | return urb->status;
|
| 1167 | }
|
| 1168 |
|
| 1169 | static int do_proc_control(struct usb_dev_state *ps,
|
| 1170 | struct usbdevfs_ctrltransfer *ctrl)
|
| 1171 | {
|
| 1172 | struct usb_device *dev = ps->dev;
|
| 1173 | unsigned int tmo;
|
| 1174 | unsigned char *tbuf;
|
| 1175 | unsigned int wLength, actlen;
|
| 1176 | int i, pipe, ret;
|
| 1177 | struct urb *urb = NULL;
|
| 1178 | struct usb_ctrlrequest *dr = NULL;
|
| 1179 |
|
| 1180 | ret = check_ctrlrecip(ps, ctrl->bRequestType, ctrl->bRequest,
|
| 1181 | ctrl->wIndex);
|
| 1182 | if (ret)
|
| 1183 | return ret;
|
| 1184 | wLength = ctrl->wLength;
|
| 1185 | if (wLength > PAGE_SIZE)
|
| 1186 | return -EINVAL;
|
| 1187 | ret = usbfs_increase_memory_usage(PAGE_SIZE + sizeof(struct urb) +
|
| 1188 | sizeof(struct usb_ctrlrequest));
|
| 1189 | if (ret)
|
| 1190 | return ret;
|
| 1191 |
|
| 1192 | ret = -ENOMEM;
|
| 1193 | tbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
|
| 1194 | if (!tbuf)
|
| 1195 | goto done;
|
| 1196 | urb = usb_alloc_urb(0, GFP_NOIO);
|
| 1197 | if (!urb)
|
| 1198 | goto done;
|
| 1199 | dr = kmalloc_obj(struct usb_ctrlrequest, GFP_NOIO);
|
| 1200 | if (!dr)
|
| 1201 | goto done;
|
| 1202 |
|
| 1203 | dr->bRequestType = ctrl->bRequestType;
|
| 1204 | dr->bRequest = ctrl->bRequest;
|
| 1205 | dr->wValue = cpu_to_le16(ctrl->wValue);
|
| 1206 | dr->wIndex = cpu_to_le16(ctrl->wIndex);
|
| 1207 | dr->wLength = cpu_to_le16(ctrl->wLength);
|
| 1208 |
|
| 1209 | tmo = ctrl->timeout;
|
| 1210 | snoop(&dev->dev, "control urb: bRequestType=%02x "
|
| 1211 | "bRequest=%02x wValue=%04x "
|
| 1212 | "wIndex=%04x wLength=%04x\n",
|
| 1213 | ctrl->bRequestType, ctrl->bRequest, ctrl->wValue,
|
| 1214 | ctrl->wIndex, ctrl->wLength);
|
| 1215 |
|
| 1216 | if ((ctrl->bRequestType & USB_DIR_IN) && wLength) {
|
| 1217 | pipe = usb_rcvctrlpipe(dev, 0);
|
| 1218 | usb_fill_control_urb(urb, dev, pipe, (unsigned char *) dr, tbuf,
|
| 1219 | wLength, NULL, NULL);
|
| 1220 | snoop_urb(dev, NULL, pipe, wLength, tmo, SUBMIT, NULL, 0);
|
| 1221 |
|
| 1222 | usb_unlock_device(dev);
|
| 1223 | i = usbfs_start_wait_urb(urb, tmo, &actlen);
|
| 1224 |
|
| 1225 |
|
| 1226 | if (dev->quirks & USB_QUIRK_DELAY_CTRL_MSG)
|
| 1227 | msleep(200);
|
| 1228 | usb_lock_device(dev);
|
| 1229 | snoop_urb(dev, NULL, pipe, actlen, i, COMPLETE, tbuf, actlen);
|
| 1230 | if (!i && actlen) {
|
| 1231 | if (copy_to_user(ctrl->data, tbuf, actlen)) {
|
| 1232 | ret = -EFAULT;
|
| 1233 | goto done;
|
| 1234 | }
|
| 1235 | }
|
| 1236 | } else {
|
| 1237 | if (wLength) {
|
| 1238 | if (copy_from_user(tbuf, ctrl->data, wLength)) {
|
| 1239 | ret = -EFAULT;
|
| 1240 | goto done;
|
| 1241 | }
|
| 1242 | }
|
| 1243 | pipe = usb_sndctrlpipe(dev, 0);
|
| 1244 | usb_fill_control_urb(urb, dev, pipe, (unsigned char *) dr, tbuf,
|
| 1245 | wLength, NULL, NULL);
|
| 1246 | snoop_urb(dev, NULL, pipe, wLength, tmo, SUBMIT, tbuf, wLength);
|
| 1247 |
|
| 1248 | usb_unlock_device(dev);
|
| 1249 | i = usbfs_start_wait_urb(urb, tmo, &actlen);
|
| 1250 |
|
| 1251 |
|
| 1252 | if (dev->quirks & USB_QUIRK_DELAY_CTRL_MSG)
|
| 1253 | msleep(200);
|
| 1254 | usb_lock_device(dev);
|
| 1255 | snoop_urb(dev, NULL, pipe, actlen, i, COMPLETE, NULL, 0);
|
| 1256 | }
|
| 1257 | if (i < 0 && i != -EPIPE) {
|
| 1258 | dev_printk(KERN_DEBUG, &dev->dev, "usbfs: USBDEVFS_CONTROL "
|
| 1259 | "failed cmd %s rqt %u rq %u len %u ret %d\n",
|
| 1260 | current->comm, ctrl->bRequestType, ctrl->bRequest,
|
| 1261 | ctrl->wLength, i);
|
| 1262 | }
|
| 1263 | ret = (i < 0 ? i : actlen);
|
| 1264 |
|
| 1265 | done:
|
| 1266 | kfree(dr);
|
| 1267 | usb_free_urb(urb);
|
| 1268 | free_page((unsigned long) tbuf);
|
| 1269 | usbfs_decrease_memory_usage(PAGE_SIZE + sizeof(struct urb) +
|
| 1270 | sizeof(struct usb_ctrlrequest));
|
| 1271 | return ret;
|
| 1272 | }
|
| 1273 |
|
| 1274 | static int proc_control(struct usb_dev_state *ps, void __user *arg)
|
| 1275 | {
|
| 1276 | struct usbdevfs_ctrltransfer ctrl;
|
| 1277 |
|
| 1278 | if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
|
| 1279 | return -EFAULT;
|
| 1280 | return do_proc_control(ps, &ctrl);
|
| 1281 | }
|
| 1282 |
|
| 1283 | static int do_proc_bulk(struct usb_dev_state *ps,
|
| 1284 | struct usbdevfs_bulktransfer *bulk)
|
| 1285 | {
|
| 1286 | struct usb_device *dev = ps->dev;
|
| 1287 | unsigned int tmo, len1, len2, pipe;
|
| 1288 | unsigned char *tbuf;
|
| 1289 | int i, ret;
|
| 1290 | struct urb *urb = NULL;
|
| 1291 | struct usb_host_endpoint *ep;
|
| 1292 |
|
| 1293 | ret = findintfep(ps->dev, bulk->ep);
|
| 1294 | if (ret < 0)
|
| 1295 | return ret;
|
| 1296 | ret = checkintf(ps, ret);
|
| 1297 | if (ret)
|
| 1298 | return ret;
|
| 1299 |
|
| 1300 | len1 = bulk->len;
|
| 1301 | if (len1 >= (INT_MAX - sizeof(struct urb)))
|
| 1302 | return -EINVAL;
|
| 1303 |
|
| 1304 | if (bulk->ep & USB_DIR_IN)
|
| 1305 | pipe = usb_rcvbulkpipe(dev, bulk->ep & 0x7f);
|
| 1306 | else
|
| 1307 | pipe = usb_sndbulkpipe(dev, bulk->ep & 0x7f);
|
| 1308 | ep = usb_pipe_endpoint(dev, pipe);
|
| 1309 | if (!ep || !usb_endpoint_maxp(&ep->desc))
|
| 1310 | return -EINVAL;
|
| 1311 | ret = usbfs_increase_memory_usage(len1 + sizeof(struct urb));
|
| 1312 | if (ret)
|
| 1313 | return ret;
|
| 1314 |
|
| 1315 | |
| 1316 | * len1 can be almost arbitrarily large. Don't WARN if it's
|
| 1317 | * too big, just fail the request.
|
| 1318 |
|
| 1319 | ret = -ENOMEM;
|
| 1320 | tbuf = kmalloc(len1, GFP_KERNEL | __GFP_NOWARN);
|
| 1321 | if (!tbuf)
|
| 1322 | goto done;
|
| 1323 | urb = usb_alloc_urb(0, GFP_KERNEL);
|
| 1324 | if (!urb)
|
| 1325 | goto done;
|
| 1326 |
|
| 1327 | if ((ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
|
| 1328 | USB_ENDPOINT_XFER_INT) {
|
| 1329 | pipe = (pipe & ~(3 << 30)) | (PIPE_INTERRUPT << 30);
|
| 1330 | usb_fill_int_urb(urb, dev, pipe, tbuf, len1,
|
| 1331 | NULL, NULL, ep->desc.bInterval);
|
| 1332 | } else {
|
| 1333 | usb_fill_bulk_urb(urb, dev, pipe, tbuf, len1, NULL, NULL);
|
| 1334 | }
|
| 1335 |
|
| 1336 | tmo = bulk->timeout;
|
| 1337 | if (bulk->ep & 0x80) {
|
| 1338 | snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, NULL, 0);
|
| 1339 |
|
| 1340 | usb_unlock_device(dev);
|
| 1341 | i = usbfs_start_wait_urb(urb, tmo, &len2);
|
| 1342 | usb_lock_device(dev);
|
| 1343 | snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, tbuf, len2);
|
| 1344 |
|
| 1345 | if (!i && len2) {
|
| 1346 | if (copy_to_user(bulk->data, tbuf, len2)) {
|
| 1347 | ret = -EFAULT;
|
| 1348 | goto done;
|
| 1349 | }
|
| 1350 | }
|
| 1351 | } else {
|
| 1352 | if (len1) {
|
| 1353 | if (copy_from_user(tbuf, bulk->data, len1)) {
|
| 1354 | ret = -EFAULT;
|
| 1355 | goto done;
|
| 1356 | }
|
| 1357 | }
|
| 1358 | snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, tbuf, len1);
|
| 1359 |
|
| 1360 | usb_unlock_device(dev);
|
| 1361 | i = usbfs_start_wait_urb(urb, tmo, &len2);
|
| 1362 | usb_lock_device(dev);
|
| 1363 | snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, NULL, 0);
|
| 1364 | }
|
| 1365 | ret = (i < 0 ? i : len2);
|
| 1366 | done:
|
| 1367 | usb_free_urb(urb);
|
| 1368 | kfree(tbuf);
|
| 1369 | usbfs_decrease_memory_usage(len1 + sizeof(struct urb));
|
| 1370 | return ret;
|
| 1371 | }
|
| 1372 |
|
| 1373 | static int proc_bulk(struct usb_dev_state *ps, void __user *arg)
|
| 1374 | {
|
| 1375 | struct usbdevfs_bulktransfer bulk;
|
| 1376 |
|
| 1377 | if (copy_from_user(&bulk, arg, sizeof(bulk)))
|
| 1378 | return -EFAULT;
|
| 1379 | return do_proc_bulk(ps, &bulk);
|
| 1380 | }
|
| 1381 |
|
| 1382 | static void check_reset_of_active_ep(struct usb_device *udev,
|
| 1383 | unsigned int epnum, char *ioctl_name)
|
| 1384 | {
|
| 1385 | struct usb_host_endpoint **eps;
|
| 1386 | struct usb_host_endpoint *ep;
|
| 1387 |
|
| 1388 | eps = (epnum & USB_DIR_IN) ? udev->ep_in : udev->ep_out;
|
| 1389 | ep = eps[epnum & 0x0f];
|
| 1390 | if (ep && !list_empty(&ep->urb_list))
|
| 1391 | dev_warn(&udev->dev, "Process %d (%s) called USBDEVFS_%s for active endpoint 0x%02x\n",
|
| 1392 | task_pid_nr(current), current->comm,
|
| 1393 | ioctl_name, epnum);
|
| 1394 | }
|
| 1395 |
|
| 1396 | static int proc_resetep(struct usb_dev_state *ps, void __user *arg)
|
| 1397 | {
|
| 1398 | unsigned int ep;
|
| 1399 | int ret;
|
| 1400 |
|
| 1401 | if (get_user(ep, (unsigned int __user *)arg))
|
| 1402 | return -EFAULT;
|
| 1403 | ret = findintfep(ps->dev, ep);
|
| 1404 | if (ret < 0)
|
| 1405 | return ret;
|
| 1406 | ret = checkintf(ps, ret);
|
| 1407 | if (ret)
|
| 1408 | return ret;
|
| 1409 | check_reset_of_active_ep(ps->dev, ep, "RESETEP");
|
| 1410 | usb_reset_endpoint(ps->dev, ep);
|
| 1411 | return 0;
|
| 1412 | }
|
| 1413 |
|
| 1414 | static int proc_clearhalt(struct usb_dev_state *ps, void __user *arg)
|
| 1415 | {
|
| 1416 | unsigned int ep;
|
| 1417 | int pipe;
|
| 1418 | int ret;
|
| 1419 |
|
| 1420 | if (get_user(ep, (unsigned int __user *)arg))
|
| 1421 | return -EFAULT;
|
| 1422 | ret = findintfep(ps->dev, ep);
|
| 1423 | if (ret < 0)
|
| 1424 | return ret;
|
| 1425 | ret = checkintf(ps, ret);
|
| 1426 | if (ret)
|
| 1427 | return ret;
|
| 1428 | check_reset_of_active_ep(ps->dev, ep, "CLEAR_HALT");
|
| 1429 | if (ep & USB_DIR_IN)
|
| 1430 | pipe = usb_rcvbulkpipe(ps->dev, ep & 0x7f);
|
| 1431 | else
|
| 1432 | pipe = usb_sndbulkpipe(ps->dev, ep & 0x7f);
|
| 1433 |
|
| 1434 | return usb_clear_halt(ps->dev, pipe);
|
| 1435 | }
|
| 1436 |
|
| 1437 | static int proc_getdriver(struct usb_dev_state *ps, void __user *arg)
|
| 1438 | {
|
| 1439 | struct usbdevfs_getdriver gd;
|
| 1440 | struct usb_interface *intf;
|
| 1441 | int ret;
|
| 1442 |
|
| 1443 | if (copy_from_user(&gd, arg, sizeof(gd)))
|
| 1444 | return -EFAULT;
|
| 1445 | intf = usb_ifnum_to_if(ps->dev, gd.interface);
|
| 1446 | if (!intf || !intf->dev.driver)
|
| 1447 | ret = -ENODATA;
|
| 1448 | else {
|
| 1449 | strscpy(gd.driver, intf->dev.driver->name,
|
| 1450 | sizeof(gd.driver));
|
| 1451 | ret = (copy_to_user(arg, &gd, sizeof(gd)) ? -EFAULT : 0);
|
| 1452 | }
|
| 1453 | return ret;
|
| 1454 | }
|
| 1455 |
|
| 1456 | static int proc_connectinfo(struct usb_dev_state *ps, void __user *arg)
|
| 1457 | {
|
| 1458 | struct usbdevfs_connectinfo ci;
|
| 1459 |
|
| 1460 | memset(&ci, 0, sizeof(ci));
|
| 1461 | ci.devnum = ps->dev->devnum;
|
| 1462 | ci.slow = ps->dev->speed == USB_SPEED_LOW;
|
| 1463 |
|
| 1464 | if (copy_to_user(arg, &ci, sizeof(ci)))
|
| 1465 | return -EFAULT;
|
| 1466 | return 0;
|
| 1467 | }
|
| 1468 |
|
| 1469 | static int proc_conninfo_ex(struct usb_dev_state *ps,
|
| 1470 | void __user *arg, size_t size)
|
| 1471 | {
|
| 1472 | struct usbdevfs_conninfo_ex ci;
|
| 1473 | struct usb_device *udev = ps->dev;
|
| 1474 |
|
| 1475 | if (size < sizeof(ci.size))
|
| 1476 | return -EINVAL;
|
| 1477 |
|
| 1478 | memset(&ci, 0, sizeof(ci));
|
| 1479 | ci.size = sizeof(ci);
|
| 1480 | ci.busnum = udev->bus->busnum;
|
| 1481 | ci.devnum = udev->devnum;
|
| 1482 | ci.speed = udev->speed;
|
| 1483 |
|
| 1484 | while (udev && udev->portnum != 0) {
|
| 1485 | if (++ci.num_ports <= ARRAY_SIZE(ci.ports))
|
| 1486 | ci.ports[ARRAY_SIZE(ci.ports) - ci.num_ports] =
|
| 1487 | udev->portnum;
|
| 1488 | udev = udev->parent;
|
| 1489 | }
|
| 1490 |
|
| 1491 | if (ci.num_ports < ARRAY_SIZE(ci.ports))
|
| 1492 | memmove(&ci.ports[0],
|
| 1493 | &ci.ports[ARRAY_SIZE(ci.ports) - ci.num_ports],
|
| 1494 | ci.num_ports);
|
| 1495 |
|
| 1496 | if (copy_to_user(arg, &ci, min(sizeof(ci), size)))
|
| 1497 | return -EFAULT;
|
| 1498 |
|
| 1499 | return 0;
|
| 1500 | }
|
| 1501 |
|
| 1502 | static int proc_resetdevice(struct usb_dev_state *ps)
|
| 1503 | {
|
| 1504 | struct usb_host_config *actconfig = ps->dev->actconfig;
|
| 1505 | struct usb_interface *interface;
|
| 1506 | int i, number;
|
| 1507 |
|
| 1508 | |
| 1509 | * privilege to do such things and any of the interfaces are
|
| 1510 | * currently claimed.
|
| 1511 |
|
| 1512 | if (ps->privileges_dropped && actconfig) {
|
| 1513 | for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
|
| 1514 | interface = actconfig->interface[i];
|
| 1515 | number = interface->cur_altsetting->desc.bInterfaceNumber;
|
| 1516 | if (usb_interface_claimed(interface) &&
|
| 1517 | !test_bit(number, &ps->ifclaimed)) {
|
| 1518 | dev_warn(&ps->dev->dev,
|
| 1519 | "usbfs: interface %d claimed by %s while '%s' resets device\n",
|
| 1520 | number, interface->dev.driver->name, current->comm);
|
| 1521 | return -EACCES;
|
| 1522 | }
|
| 1523 | }
|
| 1524 | }
|
| 1525 |
|
| 1526 | return usb_reset_device(ps->dev);
|
| 1527 | }
|
| 1528 |
|
| 1529 | static int proc_setintf(struct usb_dev_state *ps, void __user *arg)
|
| 1530 | {
|
| 1531 | struct usbdevfs_setinterface setintf;
|
| 1532 | int ret;
|
| 1533 |
|
| 1534 | if (copy_from_user(&setintf, arg, sizeof(setintf)))
|
| 1535 | return -EFAULT;
|
| 1536 | ret = checkintf(ps, setintf.interface);
|
| 1537 | if (ret)
|
| 1538 | return ret;
|
| 1539 |
|
| 1540 | destroy_async_on_interface(ps, setintf.interface);
|
| 1541 |
|
| 1542 | return usb_set_interface(ps->dev, setintf.interface,
|
| 1543 | setintf.altsetting);
|
| 1544 | }
|
| 1545 |
|
| 1546 | static int proc_setconfig(struct usb_dev_state *ps, void __user *arg)
|
| 1547 | {
|
| 1548 | int u;
|
| 1549 | int status = 0;
|
| 1550 | struct usb_host_config *actconfig;
|
| 1551 |
|
| 1552 | if (get_user(u, (int __user *)arg))
|
| 1553 | return -EFAULT;
|
| 1554 |
|
| 1555 | actconfig = ps->dev->actconfig;
|
| 1556 |
|
| 1557 | |
| 1558 | * It could interfere with other drivers' operations, and if
|
| 1559 | * an interface is claimed by usbfs it could easily deadlock.
|
| 1560 |
|
| 1561 | if (actconfig) {
|
| 1562 | int i;
|
| 1563 |
|
| 1564 | for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
|
| 1565 | if (usb_interface_claimed(actconfig->interface[i])) {
|
| 1566 | dev_warn(&ps->dev->dev,
|
| 1567 | "usbfs: interface %d claimed by %s "
|
| 1568 | "while '%s' sets config #%d\n",
|
| 1569 | actconfig->interface[i]
|
| 1570 | ->cur_altsetting
|
| 1571 | ->desc.bInterfaceNumber,
|
| 1572 | actconfig->interface[i]
|
| 1573 | ->dev.driver->name,
|
| 1574 | current->comm, u);
|
| 1575 | status = -EBUSY;
|
| 1576 | break;
|
| 1577 | }
|
| 1578 | }
|
| 1579 | }
|
| 1580 |
|
| 1581 | |
| 1582 | * so avoid usb_set_configuration()'s kick to sysfs
|
| 1583 |
|
| 1584 | if (status == 0) {
|
| 1585 | if (actconfig && actconfig->desc.bConfigurationValue == u)
|
| 1586 | status = usb_reset_configuration(ps->dev);
|
| 1587 | else
|
| 1588 | status = usb_set_configuration(ps->dev, u);
|
| 1589 | }
|
| 1590 |
|
| 1591 | return status;
|
| 1592 | }
|
| 1593 |
|
| 1594 | static struct usb_memory *
|
| 1595 | find_memory_area(struct usb_dev_state *ps, const struct usbdevfs_urb *uurb)
|
| 1596 | {
|
| 1597 | struct usb_memory *usbm = NULL, *iter;
|
| 1598 | unsigned long flags;
|
| 1599 | unsigned long uurb_start = (unsigned long)uurb->buffer;
|
| 1600 |
|
| 1601 | spin_lock_irqsave(&ps->lock, flags);
|
| 1602 | list_for_each_entry(iter, &ps->memory_list, memlist) {
|
| 1603 | if (uurb_start >= iter->vm_start &&
|
| 1604 | uurb_start < iter->vm_start + iter->size) {
|
| 1605 | if (uurb->buffer_length > iter->vm_start + iter->size -
|
| 1606 | uurb_start) {
|
| 1607 | usbm = ERR_PTR(-EINVAL);
|
| 1608 | } else {
|
| 1609 | usbm = iter;
|
| 1610 | usbm->urb_use_count++;
|
| 1611 | }
|
| 1612 | break;
|
| 1613 | }
|
| 1614 | }
|
| 1615 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 1616 | return usbm;
|
| 1617 | }
|
| 1618 |
|
| 1619 | static int proc_do_submiturb(struct usb_dev_state *ps, struct usbdevfs_urb *uurb,
|
| 1620 | struct usbdevfs_iso_packet_desc __user *iso_frame_desc,
|
| 1621 | void __user *arg, sigval_t userurb_sigval)
|
| 1622 | {
|
| 1623 | struct usbdevfs_iso_packet_desc *isopkt = NULL;
|
| 1624 | struct usb_host_endpoint *ep;
|
| 1625 | struct async *as = NULL;
|
| 1626 | struct usb_ctrlrequest *dr = NULL;
|
| 1627 | unsigned int u, totlen, isofrmlen;
|
| 1628 | int i, ret, num_sgs = 0, ifnum = -1;
|
| 1629 | int number_of_packets = 0;
|
| 1630 | unsigned int stream_id = 0;
|
| 1631 | void *buf;
|
| 1632 | bool is_in;
|
| 1633 | bool allow_short = false;
|
| 1634 | bool allow_zero = false;
|
| 1635 | unsigned long mask = USBDEVFS_URB_SHORT_NOT_OK |
|
| 1636 | USBDEVFS_URB_BULK_CONTINUATION |
|
| 1637 | USBDEVFS_URB_NO_FSBR |
|
| 1638 | USBDEVFS_URB_ZERO_PACKET |
|
| 1639 | USBDEVFS_URB_NO_INTERRUPT;
|
| 1640 |
|
| 1641 | if (uurb->type == USBDEVFS_URB_TYPE_ISO)
|
| 1642 | mask |= USBDEVFS_URB_ISO_ASAP;
|
| 1643 |
|
| 1644 | if (uurb->flags & ~mask)
|
| 1645 | return -EINVAL;
|
| 1646 |
|
| 1647 | if ((unsigned int)uurb->buffer_length >= USBFS_XFER_MAX)
|
| 1648 | return -EINVAL;
|
| 1649 | if (uurb->buffer_length > 0 && !uurb->buffer)
|
| 1650 | return -EINVAL;
|
| 1651 | if (!(uurb->type == USBDEVFS_URB_TYPE_CONTROL &&
|
| 1652 | (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) == 0)) {
|
| 1653 | ifnum = findintfep(ps->dev, uurb->endpoint);
|
| 1654 | if (ifnum < 0)
|
| 1655 | return ifnum;
|
| 1656 | ret = checkintf(ps, ifnum);
|
| 1657 | if (ret)
|
| 1658 | return ret;
|
| 1659 | }
|
| 1660 | ep = ep_to_host_endpoint(ps->dev, uurb->endpoint);
|
| 1661 | if (!ep)
|
| 1662 | return -ENOENT;
|
| 1663 | is_in = (uurb->endpoint & USB_ENDPOINT_DIR_MASK) != 0;
|
| 1664 |
|
| 1665 | u = 0;
|
| 1666 | switch (uurb->type) {
|
| 1667 | case USBDEVFS_URB_TYPE_CONTROL:
|
| 1668 | if (!usb_endpoint_xfer_control(&ep->desc))
|
| 1669 | return -EINVAL;
|
| 1670 |
|
| 1671 | if (uurb->buffer_length < 8)
|
| 1672 | return -EINVAL;
|
| 1673 | dr = kmalloc_obj(struct usb_ctrlrequest);
|
| 1674 | if (!dr)
|
| 1675 | return -ENOMEM;
|
| 1676 | if (copy_from_user(dr, uurb->buffer, 8)) {
|
| 1677 | ret = -EFAULT;
|
| 1678 | goto error;
|
| 1679 | }
|
| 1680 | if (uurb->buffer_length < (le16_to_cpu(dr->wLength) + 8)) {
|
| 1681 | ret = -EINVAL;
|
| 1682 | goto error;
|
| 1683 | }
|
| 1684 | ret = check_ctrlrecip(ps, dr->bRequestType, dr->bRequest,
|
| 1685 | le16_to_cpu(dr->wIndex));
|
| 1686 | if (ret)
|
| 1687 | goto error;
|
| 1688 | uurb->buffer_length = le16_to_cpu(dr->wLength);
|
| 1689 | uurb->buffer += 8;
|
| 1690 | if ((dr->bRequestType & USB_DIR_IN) && uurb->buffer_length) {
|
| 1691 | is_in = true;
|
| 1692 | uurb->endpoint |= USB_DIR_IN;
|
| 1693 | } else {
|
| 1694 | is_in = false;
|
| 1695 | uurb->endpoint &= ~USB_DIR_IN;
|
| 1696 | }
|
| 1697 | if (is_in)
|
| 1698 | allow_short = true;
|
| 1699 | snoop(&ps->dev->dev, "control urb: bRequestType=%02x "
|
| 1700 | "bRequest=%02x wValue=%04x "
|
| 1701 | "wIndex=%04x wLength=%04x\n",
|
| 1702 | dr->bRequestType, dr->bRequest,
|
| 1703 | __le16_to_cpu(dr->wValue),
|
| 1704 | __le16_to_cpu(dr->wIndex),
|
| 1705 | __le16_to_cpu(dr->wLength));
|
| 1706 | u = sizeof(struct usb_ctrlrequest);
|
| 1707 | break;
|
| 1708 |
|
| 1709 | case USBDEVFS_URB_TYPE_BULK:
|
| 1710 | if (!is_in)
|
| 1711 | allow_zero = true;
|
| 1712 | else
|
| 1713 | allow_short = true;
|
| 1714 | switch (usb_endpoint_type(&ep->desc)) {
|
| 1715 | case USB_ENDPOINT_XFER_CONTROL:
|
| 1716 | case USB_ENDPOINT_XFER_ISOC:
|
| 1717 | return -EINVAL;
|
| 1718 | case USB_ENDPOINT_XFER_INT:
|
| 1719 |
|
| 1720 | uurb->type = USBDEVFS_URB_TYPE_INTERRUPT;
|
| 1721 | goto interrupt_urb;
|
| 1722 | }
|
| 1723 | num_sgs = DIV_ROUND_UP(uurb->buffer_length, USB_SG_SIZE);
|
| 1724 | if (num_sgs == 1 || num_sgs > ps->dev->bus->sg_tablesize)
|
| 1725 | num_sgs = 0;
|
| 1726 | if (ep->streams)
|
| 1727 | stream_id = uurb->stream_id;
|
| 1728 | break;
|
| 1729 |
|
| 1730 | case USBDEVFS_URB_TYPE_INTERRUPT:
|
| 1731 | if (!usb_endpoint_xfer_int(&ep->desc))
|
| 1732 | return -EINVAL;
|
| 1733 | interrupt_urb:
|
| 1734 | if (!is_in)
|
| 1735 | allow_zero = true;
|
| 1736 | else
|
| 1737 | allow_short = true;
|
| 1738 | break;
|
| 1739 |
|
| 1740 | case USBDEVFS_URB_TYPE_ISO:
|
| 1741 |
|
| 1742 | if (uurb->number_of_packets < 1 ||
|
| 1743 | uurb->number_of_packets > 128)
|
| 1744 | return -EINVAL;
|
| 1745 | if (!usb_endpoint_xfer_isoc(&ep->desc))
|
| 1746 | return -EINVAL;
|
| 1747 | number_of_packets = uurb->number_of_packets;
|
| 1748 | isofrmlen = sizeof(struct usbdevfs_iso_packet_desc) *
|
| 1749 | number_of_packets;
|
| 1750 | isopkt = memdup_user(iso_frame_desc, isofrmlen);
|
| 1751 | if (IS_ERR(isopkt)) {
|
| 1752 | ret = PTR_ERR(isopkt);
|
| 1753 | isopkt = NULL;
|
| 1754 | goto error;
|
| 1755 | }
|
| 1756 | for (totlen = u = 0; u < number_of_packets; u++) {
|
| 1757 | |
| 1758 | * arbitrary limit need for USB 3.1 Gen2
|
| 1759 | * sizemax: 96 DPs at SSP, 96 * 1024 = 98304
|
| 1760 |
|
| 1761 | if (isopkt[u].length > 98304) {
|
| 1762 | ret = -EINVAL;
|
| 1763 | goto error;
|
| 1764 | }
|
| 1765 | totlen += isopkt[u].length;
|
| 1766 | }
|
| 1767 | u *= sizeof(struct usb_iso_packet_descriptor);
|
| 1768 | uurb->buffer_length = totlen;
|
| 1769 | break;
|
| 1770 |
|
| 1771 | default:
|
| 1772 | return -EINVAL;
|
| 1773 | }
|
| 1774 |
|
| 1775 | if (uurb->buffer_length > 0 &&
|
| 1776 | !access_ok(uurb->buffer, uurb->buffer_length)) {
|
| 1777 | ret = -EFAULT;
|
| 1778 | goto error;
|
| 1779 | }
|
| 1780 | as = alloc_async(number_of_packets);
|
| 1781 | if (!as) {
|
| 1782 | ret = -ENOMEM;
|
| 1783 | goto error;
|
| 1784 | }
|
| 1785 |
|
| 1786 | as->usbm = find_memory_area(ps, uurb);
|
| 1787 | if (IS_ERR(as->usbm)) {
|
| 1788 | ret = PTR_ERR(as->usbm);
|
| 1789 | as->usbm = NULL;
|
| 1790 | goto error;
|
| 1791 | }
|
| 1792 |
|
| 1793 | |
| 1794 | * are in use
|
| 1795 |
|
| 1796 | if (as->usbm)
|
| 1797 | num_sgs = 0;
|
| 1798 |
|
| 1799 | u += sizeof(struct async) + sizeof(struct urb) +
|
| 1800 | (as->usbm ? 0 : uurb->buffer_length) +
|
| 1801 | num_sgs * sizeof(struct scatterlist);
|
| 1802 | ret = usbfs_increase_memory_usage(u);
|
| 1803 | if (ret)
|
| 1804 | goto error;
|
| 1805 | as->mem_usage = u;
|
| 1806 |
|
| 1807 | if (num_sgs) {
|
| 1808 | as->urb->sg = kmalloc_objs(struct scatterlist, num_sgs,
|
| 1809 | GFP_KERNEL | __GFP_NOWARN);
|
| 1810 | if (!as->urb->sg) {
|
| 1811 | ret = -ENOMEM;
|
| 1812 | goto error;
|
| 1813 | }
|
| 1814 | as->urb->num_sgs = num_sgs;
|
| 1815 | sg_init_table(as->urb->sg, as->urb->num_sgs);
|
| 1816 |
|
| 1817 | totlen = uurb->buffer_length;
|
| 1818 | for (i = 0; i < as->urb->num_sgs; i++) {
|
| 1819 | u = (totlen > USB_SG_SIZE) ? USB_SG_SIZE : totlen;
|
| 1820 | buf = kmalloc(u, GFP_KERNEL);
|
| 1821 | if (!buf) {
|
| 1822 | ret = -ENOMEM;
|
| 1823 | goto error;
|
| 1824 | }
|
| 1825 | sg_set_buf(&as->urb->sg[i], buf, u);
|
| 1826 |
|
| 1827 | if (!is_in) {
|
| 1828 | if (copy_from_user(buf, uurb->buffer, u)) {
|
| 1829 | ret = -EFAULT;
|
| 1830 | goto error;
|
| 1831 | }
|
| 1832 | uurb->buffer += u;
|
| 1833 | }
|
| 1834 | totlen -= u;
|
| 1835 | }
|
| 1836 | } else if (uurb->buffer_length > 0) {
|
| 1837 | if (as->usbm) {
|
| 1838 | unsigned long uurb_start = (unsigned long)uurb->buffer;
|
| 1839 |
|
| 1840 | as->urb->transfer_buffer = as->usbm->mem +
|
| 1841 | (uurb_start - as->usbm->vm_start);
|
| 1842 | } else {
|
| 1843 | as->urb->transfer_buffer = kmalloc(uurb->buffer_length,
|
| 1844 | GFP_KERNEL | __GFP_NOWARN);
|
| 1845 | if (!as->urb->transfer_buffer) {
|
| 1846 | ret = -ENOMEM;
|
| 1847 | goto error;
|
| 1848 | }
|
| 1849 | if (!is_in) {
|
| 1850 | if (copy_from_user(as->urb->transfer_buffer,
|
| 1851 | uurb->buffer,
|
| 1852 | uurb->buffer_length)) {
|
| 1853 | ret = -EFAULT;
|
| 1854 | goto error;
|
| 1855 | }
|
| 1856 | } else if (uurb->type == USBDEVFS_URB_TYPE_ISO) {
|
| 1857 | |
| 1858 | * Isochronous input data may end up being
|
| 1859 | * discontiguous if some of the packets are
|
| 1860 | * short. Clear the buffer so that the gaps
|
| 1861 | * don't leak kernel data to userspace.
|
| 1862 |
|
| 1863 | memset(as->urb->transfer_buffer, 0,
|
| 1864 | uurb->buffer_length);
|
| 1865 | }
|
| 1866 | }
|
| 1867 | }
|
| 1868 | as->urb->dev = ps->dev;
|
| 1869 | as->urb->pipe = (uurb->type << 30) |
|
| 1870 | __create_pipe(ps->dev, uurb->endpoint & 0xf) |
|
| 1871 | (uurb->endpoint & USB_DIR_IN);
|
| 1872 |
|
| 1873 | |
| 1874 | * are internal to the kernel and subject to change, whereas
|
| 1875 | * the USBDEVFS_URB_* flags are a user API and must not be changed.
|
| 1876 |
|
| 1877 | u = (is_in ? URB_DIR_IN : URB_DIR_OUT);
|
| 1878 | if (uurb->flags & USBDEVFS_URB_ISO_ASAP)
|
| 1879 | u |= URB_ISO_ASAP;
|
| 1880 | if (allow_short && uurb->flags & USBDEVFS_URB_SHORT_NOT_OK)
|
| 1881 | u |= URB_SHORT_NOT_OK;
|
| 1882 | if (allow_zero && uurb->flags & USBDEVFS_URB_ZERO_PACKET)
|
| 1883 | u |= URB_ZERO_PACKET;
|
| 1884 | if (uurb->flags & USBDEVFS_URB_NO_INTERRUPT)
|
| 1885 | u |= URB_NO_INTERRUPT;
|
| 1886 | as->urb->transfer_flags = u;
|
| 1887 |
|
| 1888 | if (!allow_short && uurb->flags & USBDEVFS_URB_SHORT_NOT_OK)
|
| 1889 | dev_warn(&ps->dev->dev, "Requested nonsensical USBDEVFS_URB_SHORT_NOT_OK.\n");
|
| 1890 | if (!allow_zero && uurb->flags & USBDEVFS_URB_ZERO_PACKET)
|
| 1891 | dev_warn(&ps->dev->dev, "Requested nonsensical USBDEVFS_URB_ZERO_PACKET.\n");
|
| 1892 |
|
| 1893 | as->urb->transfer_buffer_length = uurb->buffer_length;
|
| 1894 | as->urb->setup_packet = (unsigned char *)dr;
|
| 1895 | dr = NULL;
|
| 1896 | as->urb->start_frame = uurb->start_frame;
|
| 1897 | as->urb->number_of_packets = number_of_packets;
|
| 1898 | as->urb->stream_id = stream_id;
|
| 1899 |
|
| 1900 | if (ep->desc.bInterval) {
|
| 1901 | if (uurb->type == USBDEVFS_URB_TYPE_ISO ||
|
| 1902 | ps->dev->speed == USB_SPEED_HIGH ||
|
| 1903 | ps->dev->speed >= USB_SPEED_SUPER)
|
| 1904 | as->urb->interval = 1 <<
|
| 1905 | min(15, ep->desc.bInterval - 1);
|
| 1906 | else
|
| 1907 | as->urb->interval = ep->desc.bInterval;
|
| 1908 | }
|
| 1909 |
|
| 1910 | as->urb->context = as;
|
| 1911 | as->urb->complete = async_completed;
|
| 1912 | for (totlen = u = 0; u < number_of_packets; u++) {
|
| 1913 | as->urb->iso_frame_desc[u].offset = totlen;
|
| 1914 | as->urb->iso_frame_desc[u].length = isopkt[u].length;
|
| 1915 | totlen += isopkt[u].length;
|
| 1916 | }
|
| 1917 | kfree(isopkt);
|
| 1918 | isopkt = NULL;
|
| 1919 | as->ps = ps;
|
| 1920 | as->userurb = arg;
|
| 1921 | as->userurb_sigval = userurb_sigval;
|
| 1922 | if (as->usbm) {
|
| 1923 | unsigned long uurb_start = (unsigned long)uurb->buffer;
|
| 1924 |
|
| 1925 | as->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
| 1926 | as->urb->transfer_dma = as->usbm->dma_handle +
|
| 1927 | (uurb_start - as->usbm->vm_start);
|
| 1928 | } else if (is_in && uurb->buffer_length > 0)
|
| 1929 | as->userbuffer = uurb->buffer;
|
| 1930 | as->signr = uurb->signr;
|
| 1931 | as->ifnum = ifnum;
|
| 1932 | as->pid = get_pid(task_pid(current));
|
| 1933 | as->cred = get_current_cred();
|
| 1934 | snoop_urb(ps->dev, as->userurb, as->urb->pipe,
|
| 1935 | as->urb->transfer_buffer_length, 0, SUBMIT,
|
| 1936 | NULL, 0);
|
| 1937 | if (!is_in)
|
| 1938 | snoop_urb_data(as->urb, as->urb->transfer_buffer_length);
|
| 1939 |
|
| 1940 | async_newpending(as);
|
| 1941 |
|
| 1942 | if (usb_endpoint_xfer_bulk(&ep->desc)) {
|
| 1943 | spin_lock_irq(&ps->lock);
|
| 1944 |
|
| 1945 | |
| 1946 | * shifted to the 0x10 position so that the value will be
|
| 1947 | * between 0 and 31.
|
| 1948 |
|
| 1949 | as->bulk_addr = usb_endpoint_num(&ep->desc) |
|
| 1950 | ((ep->desc.bEndpointAddress & USB_ENDPOINT_DIR_MASK)
|
| 1951 | >> 3);
|
| 1952 |
|
| 1953 | |
| 1954 | * the endpoint. Otherwise mark it as a continuation URB.
|
| 1955 |
|
| 1956 | if (uurb->flags & USBDEVFS_URB_BULK_CONTINUATION)
|
| 1957 | as->bulk_status = AS_CONTINUATION;
|
| 1958 | else
|
| 1959 | ps->disabled_bulk_eps &= ~(1 << as->bulk_addr);
|
| 1960 |
|
| 1961 | |
| 1962 | * disabled because of an earlier error.
|
| 1963 |
|
| 1964 | if (ps->disabled_bulk_eps & (1 << as->bulk_addr))
|
| 1965 | ret = -EREMOTEIO;
|
| 1966 | else
|
| 1967 | ret = usb_submit_urb(as->urb, GFP_ATOMIC);
|
| 1968 | spin_unlock_irq(&ps->lock);
|
| 1969 | } else {
|
| 1970 | ret = usb_submit_urb(as->urb, GFP_KERNEL);
|
| 1971 | }
|
| 1972 |
|
| 1973 | if (ret) {
|
| 1974 | dev_printk(KERN_DEBUG, &ps->dev->dev,
|
| 1975 | "usbfs: usb_submit_urb returned %d\n", ret);
|
| 1976 | snoop_urb(ps->dev, as->userurb, as->urb->pipe,
|
| 1977 | 0, ret, COMPLETE, NULL, 0);
|
| 1978 | async_removepending(as);
|
| 1979 | goto error;
|
| 1980 | }
|
| 1981 | return 0;
|
| 1982 |
|
| 1983 | error:
|
| 1984 | kfree(isopkt);
|
| 1985 | kfree(dr);
|
| 1986 | if (as)
|
| 1987 | free_async(as);
|
| 1988 | return ret;
|
| 1989 | }
|
| 1990 |
|
| 1991 | static int proc_submiturb(struct usb_dev_state *ps, void __user *arg)
|
| 1992 | {
|
| 1993 | struct usbdevfs_urb uurb;
|
| 1994 | sigval_t userurb_sigval;
|
| 1995 |
|
| 1996 | if (copy_from_user(&uurb, arg, sizeof(uurb)))
|
| 1997 | return -EFAULT;
|
| 1998 |
|
| 1999 | memset(&userurb_sigval, 0, sizeof(userurb_sigval));
|
| 2000 | userurb_sigval.sival_ptr = arg;
|
| 2001 |
|
| 2002 | return proc_do_submiturb(ps, &uurb,
|
| 2003 | (((struct usbdevfs_urb __user *)arg)->iso_frame_desc),
|
| 2004 | arg, userurb_sigval);
|
| 2005 | }
|
| 2006 |
|
| 2007 | static int proc_unlinkurb(struct usb_dev_state *ps, void __user *arg)
|
| 2008 | {
|
| 2009 | struct urb *urb;
|
| 2010 | struct async *as;
|
| 2011 | unsigned long flags;
|
| 2012 |
|
| 2013 | spin_lock_irqsave(&ps->lock, flags);
|
| 2014 | as = async_getpending(ps, arg);
|
| 2015 | if (!as) {
|
| 2016 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 2017 | return -EINVAL;
|
| 2018 | }
|
| 2019 |
|
| 2020 | urb = as->urb;
|
| 2021 | usb_get_urb(urb);
|
| 2022 | spin_unlock_irqrestore(&ps->lock, flags);
|
| 2023 |
|
| 2024 | usb_kill_urb(urb);
|
| 2025 | usb_put_urb(urb);
|
| 2026 |
|
| 2027 | return 0;
|
| 2028 | }
|
| 2029 |
|
| 2030 | static void compute_isochronous_actual_length(struct urb *urb)
|
| 2031 | {
|
| 2032 | unsigned int i;
|
| 2033 |
|
| 2034 | if (urb->number_of_packets > 0) {
|
| 2035 | urb->actual_length = 0;
|
| 2036 | for (i = 0; i < urb->number_of_packets; i++)
|
| 2037 | urb->actual_length +=
|
| 2038 | urb->iso_frame_desc[i].actual_length;
|
| 2039 | }
|
| 2040 | }
|
| 2041 |
|
| 2042 | static int processcompl(struct async *as, void __user * __user *arg)
|
| 2043 | {
|
| 2044 | struct urb *urb = as->urb;
|
| 2045 | struct usbdevfs_urb __user *userurb = as->userurb;
|
| 2046 | void __user *addr = as->userurb;
|
| 2047 | unsigned int i;
|
| 2048 |
|
| 2049 | compute_isochronous_actual_length(urb);
|
| 2050 | if (as->userbuffer && urb->actual_length) {
|
| 2051 | if (copy_urb_data_to_user(as->userbuffer, urb))
|
| 2052 | goto err_out;
|
| 2053 | }
|
| 2054 | if (put_user(as->status, &userurb->status))
|
| 2055 | goto err_out;
|
| 2056 | if (put_user(urb->actual_length, &userurb->actual_length))
|
| 2057 | goto err_out;
|
| 2058 | if (put_user(urb->error_count, &userurb->error_count))
|
| 2059 | goto err_out;
|
| 2060 |
|
| 2061 | if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
|
| 2062 | for (i = 0; i < urb->number_of_packets; i++) {
|
| 2063 | if (put_user(urb->iso_frame_desc[i].actual_length,
|
| 2064 | &userurb->iso_frame_desc[i].actual_length))
|
| 2065 | goto err_out;
|
| 2066 | if (put_user(urb->iso_frame_desc[i].status,
|
| 2067 | &userurb->iso_frame_desc[i].status))
|
| 2068 | goto err_out;
|
| 2069 | }
|
| 2070 | }
|
| 2071 |
|
| 2072 | if (put_user(addr, (void __user * __user *)arg))
|
| 2073 | return -EFAULT;
|
| 2074 | return 0;
|
| 2075 |
|
| 2076 | err_out:
|
| 2077 | return -EFAULT;
|
| 2078 | }
|
| 2079 |
|
| 2080 | static struct async *reap_as(struct usb_dev_state *ps)
|
| 2081 | {
|
| 2082 | DECLARE_WAITQUEUE(wait, current);
|
| 2083 | struct async *as = NULL;
|
| 2084 | struct usb_device *dev = ps->dev;
|
| 2085 |
|
| 2086 | add_wait_queue(&ps->wait, &wait);
|
| 2087 | for (;;) {
|
| 2088 | __set_current_state(TASK_INTERRUPTIBLE);
|
| 2089 | as = async_getcompleted(ps);
|
| 2090 | if (as || !connected(ps))
|
| 2091 | break;
|
| 2092 | if (signal_pending(current))
|
| 2093 | break;
|
| 2094 | usb_unlock_device(dev);
|
| 2095 | schedule();
|
| 2096 | usb_lock_device(dev);
|
| 2097 | }
|
| 2098 | remove_wait_queue(&ps->wait, &wait);
|
| 2099 | set_current_state(TASK_RUNNING);
|
| 2100 | return as;
|
| 2101 | }
|
| 2102 |
|
| 2103 | static int proc_reapurb(struct usb_dev_state *ps, void __user *arg)
|
| 2104 | {
|
| 2105 | struct async *as = reap_as(ps);
|
| 2106 |
|
| 2107 | if (as) {
|
| 2108 | int retval;
|
| 2109 |
|
| 2110 | snoop(&ps->dev->dev, "reap %px\n", as->userurb);
|
| 2111 | retval = processcompl(as, (void __user * __user *)arg);
|
| 2112 | free_async(as);
|
| 2113 | return retval;
|
| 2114 | }
|
| 2115 | if (signal_pending(current))
|
| 2116 | return -EINTR;
|
| 2117 | return -ENODEV;
|
| 2118 | }
|
| 2119 |
|
| 2120 | static int proc_reapurbnonblock(struct usb_dev_state *ps, void __user *arg)
|
| 2121 | {
|
| 2122 | int retval;
|
| 2123 | struct async *as;
|
| 2124 |
|
| 2125 | as = async_getcompleted(ps);
|
| 2126 | if (as) {
|
| 2127 | snoop(&ps->dev->dev, "reap %px\n", as->userurb);
|
| 2128 | retval = processcompl(as, (void __user * __user *)arg);
|
| 2129 | free_async(as);
|
| 2130 | } else {
|
| 2131 | retval = (connected(ps) ? -EAGAIN : -ENODEV);
|
| 2132 | }
|
| 2133 | return retval;
|
| 2134 | }
|
| 2135 |
|
| 2136 | #ifdef CONFIG_COMPAT
|
| 2137 | static int proc_control_compat(struct usb_dev_state *ps,
|
| 2138 | struct usbdevfs_ctrltransfer32 __user *p32)
|
| 2139 | {
|
| 2140 | struct usbdevfs_ctrltransfer ctrl;
|
| 2141 | u32 udata;
|
| 2142 |
|
| 2143 | if (copy_from_user(&ctrl, p32, sizeof(*p32) - sizeof(compat_caddr_t)) ||
|
| 2144 | get_user(udata, &p32->data))
|
| 2145 | return -EFAULT;
|
| 2146 | ctrl.data = compat_ptr(udata);
|
| 2147 | return do_proc_control(ps, &ctrl);
|
| 2148 | }
|
| 2149 |
|
| 2150 | static int proc_bulk_compat(struct usb_dev_state *ps,
|
| 2151 | struct usbdevfs_bulktransfer32 __user *p32)
|
| 2152 | {
|
| 2153 | struct usbdevfs_bulktransfer bulk;
|
| 2154 | compat_caddr_t addr;
|
| 2155 |
|
| 2156 | if (get_user(bulk.ep, &p32->ep) ||
|
| 2157 | get_user(bulk.len, &p32->len) ||
|
| 2158 | get_user(bulk.timeout, &p32->timeout) ||
|
| 2159 | get_user(addr, &p32->data))
|
| 2160 | return -EFAULT;
|
| 2161 | bulk.data = compat_ptr(addr);
|
| 2162 | return do_proc_bulk(ps, &bulk);
|
| 2163 | }
|
| 2164 |
|
| 2165 | static int proc_disconnectsignal_compat(struct usb_dev_state *ps, void __user *arg)
|
| 2166 | {
|
| 2167 | struct usbdevfs_disconnectsignal32 ds;
|
| 2168 |
|
| 2169 | if (copy_from_user(&ds, arg, sizeof(ds)))
|
| 2170 | return -EFAULT;
|
| 2171 | ps->discsignr = ds.signr;
|
| 2172 | ps->disccontext.sival_int = ds.context;
|
| 2173 | return 0;
|
| 2174 | }
|
| 2175 |
|
| 2176 | static int get_urb32(struct usbdevfs_urb *kurb,
|
| 2177 | struct usbdevfs_urb32 __user *uurb)
|
| 2178 | {
|
| 2179 | struct usbdevfs_urb32 urb32;
|
| 2180 | if (copy_from_user(&urb32, uurb, sizeof(*uurb)))
|
| 2181 | return -EFAULT;
|
| 2182 | kurb->type = urb32.type;
|
| 2183 | kurb->endpoint = urb32.endpoint;
|
| 2184 | kurb->status = urb32.status;
|
| 2185 | kurb->flags = urb32.flags;
|
| 2186 | kurb->buffer = compat_ptr(urb32.buffer);
|
| 2187 | kurb->buffer_length = urb32.buffer_length;
|
| 2188 | kurb->actual_length = urb32.actual_length;
|
| 2189 | kurb->start_frame = urb32.start_frame;
|
| 2190 | kurb->number_of_packets = urb32.number_of_packets;
|
| 2191 | kurb->error_count = urb32.error_count;
|
| 2192 | kurb->signr = urb32.signr;
|
| 2193 | kurb->usercontext = compat_ptr(urb32.usercontext);
|
| 2194 | return 0;
|
| 2195 | }
|
| 2196 |
|
| 2197 | static int proc_submiturb_compat(struct usb_dev_state *ps, void __user *arg)
|
| 2198 | {
|
| 2199 | struct usbdevfs_urb uurb;
|
| 2200 | sigval_t userurb_sigval;
|
| 2201 |
|
| 2202 | if (get_urb32(&uurb, (struct usbdevfs_urb32 __user *)arg))
|
| 2203 | return -EFAULT;
|
| 2204 |
|
| 2205 | memset(&userurb_sigval, 0, sizeof(userurb_sigval));
|
| 2206 | userurb_sigval.sival_int = ptr_to_compat(arg);
|
| 2207 |
|
| 2208 | return proc_do_submiturb(ps, &uurb,
|
| 2209 | ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc,
|
| 2210 | arg, userurb_sigval);
|
| 2211 | }
|
| 2212 |
|
| 2213 | static int processcompl_compat(struct async *as, void __user * __user *arg)
|
| 2214 | {
|
| 2215 | struct urb *urb = as->urb;
|
| 2216 | struct usbdevfs_urb32 __user *userurb = as->userurb;
|
| 2217 | void __user *addr = as->userurb;
|
| 2218 | unsigned int i;
|
| 2219 |
|
| 2220 | compute_isochronous_actual_length(urb);
|
| 2221 | if (as->userbuffer && urb->actual_length) {
|
| 2222 | if (copy_urb_data_to_user(as->userbuffer, urb))
|
| 2223 | return -EFAULT;
|
| 2224 | }
|
| 2225 | if (put_user(as->status, &userurb->status))
|
| 2226 | return -EFAULT;
|
| 2227 | if (put_user(urb->actual_length, &userurb->actual_length))
|
| 2228 | return -EFAULT;
|
| 2229 | if (put_user(urb->error_count, &userurb->error_count))
|
| 2230 | return -EFAULT;
|
| 2231 |
|
| 2232 | if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
|
| 2233 | for (i = 0; i < urb->number_of_packets; i++) {
|
| 2234 | if (put_user(urb->iso_frame_desc[i].actual_length,
|
| 2235 | &userurb->iso_frame_desc[i].actual_length))
|
| 2236 | return -EFAULT;
|
| 2237 | if (put_user(urb->iso_frame_desc[i].status,
|
| 2238 | &userurb->iso_frame_desc[i].status))
|
| 2239 | return -EFAULT;
|
| 2240 | }
|
| 2241 | }
|
| 2242 |
|
| 2243 | if (put_user(ptr_to_compat(addr), (u32 __user *)arg))
|
| 2244 | return -EFAULT;
|
| 2245 | return 0;
|
| 2246 | }
|
| 2247 |
|
| 2248 | static int proc_reapurb_compat(struct usb_dev_state *ps, void __user *arg)
|
| 2249 | {
|
| 2250 | struct async *as = reap_as(ps);
|
| 2251 |
|
| 2252 | if (as) {
|
| 2253 | int retval;
|
| 2254 |
|
| 2255 | snoop(&ps->dev->dev, "reap %px\n", as->userurb);
|
| 2256 | retval = processcompl_compat(as, (void __user * __user *)arg);
|
| 2257 | free_async(as);
|
| 2258 | return retval;
|
| 2259 | }
|
| 2260 | if (signal_pending(current))
|
| 2261 | return -EINTR;
|
| 2262 | return -ENODEV;
|
| 2263 | }
|
| 2264 |
|
| 2265 | static int proc_reapurbnonblock_compat(struct usb_dev_state *ps, void __user *arg)
|
| 2266 | {
|
| 2267 | int retval;
|
| 2268 | struct async *as;
|
| 2269 |
|
| 2270 | as = async_getcompleted(ps);
|
| 2271 | if (as) {
|
| 2272 | snoop(&ps->dev->dev, "reap %px\n", as->userurb);
|
| 2273 | retval = processcompl_compat(as, (void __user * __user *)arg);
|
| 2274 | free_async(as);
|
| 2275 | } else {
|
| 2276 | retval = (connected(ps) ? -EAGAIN : -ENODEV);
|
| 2277 | }
|
| 2278 | return retval;
|
| 2279 | }
|
| 2280 |
|
| 2281 |
|
| 2282 | #endif
|
| 2283 |
|
| 2284 | static int proc_disconnectsignal(struct usb_dev_state *ps, void __user *arg)
|
| 2285 | {
|
| 2286 | struct usbdevfs_disconnectsignal ds;
|
| 2287 |
|
| 2288 | if (copy_from_user(&ds, arg, sizeof(ds)))
|
| 2289 | return -EFAULT;
|
| 2290 | ps->discsignr = ds.signr;
|
| 2291 | ps->disccontext.sival_ptr = ds.context;
|
| 2292 | return 0;
|
| 2293 | }
|
| 2294 |
|
| 2295 | static int proc_claiminterface(struct usb_dev_state *ps, void __user *arg)
|
| 2296 | {
|
| 2297 | unsigned int ifnum;
|
| 2298 |
|
| 2299 | if (get_user(ifnum, (unsigned int __user *)arg))
|
| 2300 | return -EFAULT;
|
| 2301 | return claimintf(ps, ifnum);
|
| 2302 | }
|
| 2303 |
|
| 2304 | static int proc_releaseinterface(struct usb_dev_state *ps, void __user *arg)
|
| 2305 | {
|
| 2306 | unsigned int ifnum;
|
| 2307 | int ret;
|
| 2308 |
|
| 2309 | if (get_user(ifnum, (unsigned int __user *)arg))
|
| 2310 | return -EFAULT;
|
| 2311 | ret = releaseintf(ps, ifnum);
|
| 2312 | if (ret < 0)
|
| 2313 | return ret;
|
| 2314 | destroy_async_on_interface(ps, ifnum);
|
| 2315 | return 0;
|
| 2316 | }
|
| 2317 |
|
| 2318 | static int proc_ioctl(struct usb_dev_state *ps, struct usbdevfs_ioctl *ctl)
|
| 2319 | {
|
| 2320 | int size;
|
| 2321 | void *buf = NULL;
|
| 2322 | int retval = 0;
|
| 2323 | struct usb_interface *intf = NULL;
|
| 2324 | struct usb_driver *driver = NULL;
|
| 2325 |
|
| 2326 | if (ps->privileges_dropped)
|
| 2327 | return -EACCES;
|
| 2328 |
|
| 2329 | if (!connected(ps))
|
| 2330 | return -ENODEV;
|
| 2331 |
|
| 2332 | if (ps->dev->state != USB_STATE_CONFIGURED)
|
| 2333 | return -EHOSTUNREACH;
|
| 2334 |
|
| 2335 | intf = usb_ifnum_to_if(ps->dev, ctl->ifno);
|
| 2336 | if (!intf)
|
| 2337 | return -EINVAL;
|
| 2338 |
|
| 2339 |
|
| 2340 | size = _IOC_SIZE(ctl->ioctl_code);
|
| 2341 | if (size > 0) {
|
| 2342 | buf = kmalloc(size, GFP_KERNEL);
|
| 2343 | if (buf == NULL)
|
| 2344 | return -ENOMEM;
|
| 2345 | if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) {
|
| 2346 | if (copy_from_user(buf, ctl->data, size)) {
|
| 2347 | kfree(buf);
|
| 2348 | return -EFAULT;
|
| 2349 | }
|
| 2350 | } else {
|
| 2351 | memset(buf, 0, size);
|
| 2352 | }
|
| 2353 | }
|
| 2354 |
|
| 2355 | switch (ctl->ioctl_code) {
|
| 2356 |
|
| 2357 |
|
| 2358 | case USBDEVFS_DISCONNECT:
|
| 2359 | if (intf->dev.driver) {
|
| 2360 | driver = to_usb_driver(intf->dev.driver);
|
| 2361 | dev_dbg(&intf->dev, "disconnect by usbfs\n");
|
| 2362 | usb_driver_release_interface(driver, intf);
|
| 2363 | } else
|
| 2364 | retval = -ENODATA;
|
| 2365 | break;
|
| 2366 |
|
| 2367 |
|
| 2368 | case USBDEVFS_CONNECT:
|
| 2369 | if (!intf->dev.driver)
|
| 2370 | retval = device_attach(&intf->dev);
|
| 2371 | else
|
| 2372 | retval = -EBUSY;
|
| 2373 | break;
|
| 2374 |
|
| 2375 |
|
| 2376 | default:
|
| 2377 | if (intf->dev.driver)
|
| 2378 | driver = to_usb_driver(intf->dev.driver);
|
| 2379 | if (driver == NULL || driver->unlocked_ioctl == NULL) {
|
| 2380 | retval = -ENOTTY;
|
| 2381 | } else {
|
| 2382 | retval = driver->unlocked_ioctl(intf, ctl->ioctl_code, buf);
|
| 2383 | if (retval == -ENOIOCTLCMD)
|
| 2384 | retval = -ENOTTY;
|
| 2385 | }
|
| 2386 | }
|
| 2387 |
|
| 2388 |
|
| 2389 | if (retval >= 0
|
| 2390 | && (_IOC_DIR(ctl->ioctl_code) & _IOC_READ) != 0
|
| 2391 | && size > 0
|
| 2392 | && copy_to_user(ctl->data, buf, size) != 0)
|
| 2393 | retval = -EFAULT;
|
| 2394 |
|
| 2395 | kfree(buf);
|
| 2396 | return retval;
|
| 2397 | }
|
| 2398 |
|
| 2399 | static int proc_ioctl_default(struct usb_dev_state *ps, void __user *arg)
|
| 2400 | {
|
| 2401 | struct usbdevfs_ioctl ctrl;
|
| 2402 |
|
| 2403 | if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
|
| 2404 | return -EFAULT;
|
| 2405 | return proc_ioctl(ps, &ctrl);
|
| 2406 | }
|
| 2407 |
|
| 2408 | #ifdef CONFIG_COMPAT
|
| 2409 | static int proc_ioctl_compat(struct usb_dev_state *ps, compat_uptr_t arg)
|
| 2410 | {
|
| 2411 | struct usbdevfs_ioctl32 ioc32;
|
| 2412 | struct usbdevfs_ioctl ctrl;
|
| 2413 |
|
| 2414 | if (copy_from_user(&ioc32, compat_ptr(arg), sizeof(ioc32)))
|
| 2415 | return -EFAULT;
|
| 2416 | ctrl.ifno = ioc32.ifno;
|
| 2417 | ctrl.ioctl_code = ioc32.ioctl_code;
|
| 2418 | ctrl.data = compat_ptr(ioc32.data);
|
| 2419 | return proc_ioctl(ps, &ctrl);
|
| 2420 | }
|
| 2421 | #endif
|
| 2422 |
|
| 2423 | static int proc_claim_port(struct usb_dev_state *ps, void __user *arg)
|
| 2424 | {
|
| 2425 | unsigned portnum;
|
| 2426 | int rc;
|
| 2427 |
|
| 2428 | if (get_user(portnum, (unsigned __user *) arg))
|
| 2429 | return -EFAULT;
|
| 2430 | rc = usb_hub_claim_port(ps->dev, portnum, ps);
|
| 2431 | if (rc == 0)
|
| 2432 | snoop(&ps->dev->dev, "port %d claimed by process %d: %s\n",
|
| 2433 | portnum, task_pid_nr(current), current->comm);
|
| 2434 | return rc;
|
| 2435 | }
|
| 2436 |
|
| 2437 | static int proc_release_port(struct usb_dev_state *ps, void __user *arg)
|
| 2438 | {
|
| 2439 | unsigned portnum;
|
| 2440 |
|
| 2441 | if (get_user(portnum, (unsigned __user *) arg))
|
| 2442 | return -EFAULT;
|
| 2443 | return usb_hub_release_port(ps->dev, portnum, ps);
|
| 2444 | }
|
| 2445 |
|
| 2446 | static int proc_get_capabilities(struct usb_dev_state *ps, void __user *arg)
|
| 2447 | {
|
| 2448 | __u32 caps;
|
| 2449 |
|
| 2450 | caps = USBDEVFS_CAP_ZERO_PACKET | USBDEVFS_CAP_NO_PACKET_SIZE_LIM |
|
| 2451 | USBDEVFS_CAP_REAP_AFTER_DISCONNECT | USBDEVFS_CAP_MMAP |
|
| 2452 | USBDEVFS_CAP_DROP_PRIVILEGES |
|
| 2453 | USBDEVFS_CAP_CONNINFO_EX | MAYBE_CAP_SUSPEND;
|
| 2454 | if (!ps->dev->bus->no_stop_on_short)
|
| 2455 | caps |= USBDEVFS_CAP_BULK_CONTINUATION;
|
| 2456 | if (ps->dev->bus->sg_tablesize)
|
| 2457 | caps |= USBDEVFS_CAP_BULK_SCATTER_GATHER;
|
| 2458 |
|
| 2459 | if (put_user(caps, (__u32 __user *)arg))
|
| 2460 | return -EFAULT;
|
| 2461 |
|
| 2462 | return 0;
|
| 2463 | }
|
| 2464 |
|
| 2465 | static int proc_disconnect_claim(struct usb_dev_state *ps, void __user *arg)
|
| 2466 | {
|
| 2467 | struct usbdevfs_disconnect_claim dc;
|
| 2468 | struct usb_interface *intf;
|
| 2469 |
|
| 2470 | if (copy_from_user(&dc, arg, sizeof(dc)))
|
| 2471 | return -EFAULT;
|
| 2472 |
|
| 2473 | intf = usb_ifnum_to_if(ps->dev, dc.interface);
|
| 2474 | if (!intf)
|
| 2475 | return -EINVAL;
|
| 2476 |
|
| 2477 | if (intf->dev.driver) {
|
| 2478 | struct usb_driver *driver = to_usb_driver(intf->dev.driver);
|
| 2479 |
|
| 2480 | if (ps->privileges_dropped)
|
| 2481 | return -EACCES;
|
| 2482 |
|
| 2483 | if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_IF_DRIVER) &&
|
| 2484 | strncmp(dc.driver, intf->dev.driver->name,
|
| 2485 | sizeof(dc.driver)) != 0)
|
| 2486 | return -EBUSY;
|
| 2487 |
|
| 2488 | if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_EXCEPT_DRIVER) &&
|
| 2489 | strncmp(dc.driver, intf->dev.driver->name,
|
| 2490 | sizeof(dc.driver)) == 0)
|
| 2491 | return -EBUSY;
|
| 2492 |
|
| 2493 | dev_dbg(&intf->dev, "disconnect by usbfs\n");
|
| 2494 | usb_driver_release_interface(driver, intf);
|
| 2495 | }
|
| 2496 |
|
| 2497 | return claimintf(ps, dc.interface);
|
| 2498 | }
|
| 2499 |
|
| 2500 | static int proc_alloc_streams(struct usb_dev_state *ps, void __user *arg)
|
| 2501 | {
|
| 2502 | unsigned num_streams, num_eps;
|
| 2503 | struct usb_host_endpoint **eps;
|
| 2504 | struct usb_interface *intf;
|
| 2505 | int r;
|
| 2506 |
|
| 2507 | r = parse_usbdevfs_streams(ps, arg, &num_streams, &num_eps,
|
| 2508 | &eps, &intf);
|
| 2509 | if (r)
|
| 2510 | return r;
|
| 2511 |
|
| 2512 | destroy_async_on_interface(ps,
|
| 2513 | intf->altsetting[0].desc.bInterfaceNumber);
|
| 2514 |
|
| 2515 | r = usb_alloc_streams(intf, eps, num_eps, num_streams, GFP_KERNEL);
|
| 2516 | kfree(eps);
|
| 2517 | return r;
|
| 2518 | }
|
| 2519 |
|
| 2520 | static int proc_free_streams(struct usb_dev_state *ps, void __user *arg)
|
| 2521 | {
|
| 2522 | unsigned num_eps;
|
| 2523 | struct usb_host_endpoint **eps;
|
| 2524 | struct usb_interface *intf;
|
| 2525 | int r;
|
| 2526 |
|
| 2527 | r = parse_usbdevfs_streams(ps, arg, NULL, &num_eps, &eps, &intf);
|
| 2528 | if (r)
|
| 2529 | return r;
|
| 2530 |
|
| 2531 | destroy_async_on_interface(ps,
|
| 2532 | intf->altsetting[0].desc.bInterfaceNumber);
|
| 2533 |
|
| 2534 | r = usb_free_streams(intf, eps, num_eps, GFP_KERNEL);
|
| 2535 | kfree(eps);
|
| 2536 | return r;
|
| 2537 | }
|
| 2538 |
|
| 2539 | static int proc_drop_privileges(struct usb_dev_state *ps, void __user *arg)
|
| 2540 | {
|
| 2541 | u32 data;
|
| 2542 |
|
| 2543 | if (copy_from_user(&data, arg, sizeof(data)))
|
| 2544 | return -EFAULT;
|
| 2545 |
|
| 2546 | |
| 2547 | * dropped, you cannot regain them. You may however reissue
|
| 2548 | * this ioctl to shrink the allowed interfaces mask.
|
| 2549 |
|
| 2550 | ps->interface_allowed_mask &= data;
|
| 2551 | ps->privileges_dropped = true;
|
| 2552 |
|
| 2553 | return 0;
|
| 2554 | }
|
| 2555 |
|
| 2556 | static int proc_forbid_suspend(struct usb_dev_state *ps)
|
| 2557 | {
|
| 2558 | int ret = 0;
|
| 2559 |
|
| 2560 | if (ps->suspend_allowed) {
|
| 2561 | ret = usb_autoresume_device(ps->dev);
|
| 2562 | if (ret == 0)
|
| 2563 | ps->suspend_allowed = false;
|
| 2564 | else if (ret != -ENODEV)
|
| 2565 | ret = -EIO;
|
| 2566 | }
|
| 2567 | return ret;
|
| 2568 | }
|
| 2569 |
|
| 2570 | static int proc_allow_suspend(struct usb_dev_state *ps)
|
| 2571 | {
|
| 2572 | if (!connected(ps))
|
| 2573 | return -ENODEV;
|
| 2574 |
|
| 2575 | WRITE_ONCE(ps->not_yet_resumed, 1);
|
| 2576 | if (!ps->suspend_allowed) {
|
| 2577 | usb_autosuspend_device(ps->dev);
|
| 2578 | ps->suspend_allowed = true;
|
| 2579 | }
|
| 2580 | return 0;
|
| 2581 | }
|
| 2582 |
|
| 2583 | static int proc_wait_for_resume(struct usb_dev_state *ps)
|
| 2584 | {
|
| 2585 | int ret;
|
| 2586 |
|
| 2587 | usb_unlock_device(ps->dev);
|
| 2588 | ret = wait_event_interruptible(ps->wait_for_resume,
|
| 2589 | READ_ONCE(ps->not_yet_resumed) == 0);
|
| 2590 | usb_lock_device(ps->dev);
|
| 2591 |
|
| 2592 | if (ret != 0)
|
| 2593 | return -EINTR;
|
| 2594 | return proc_forbid_suspend(ps);
|
| 2595 | }
|
| 2596 |
|
| 2597 | |
| 2598 | * NOTE: All requests here that have interface numbers as parameters
|
| 2599 | * are assuming that somehow the configuration has been prevented from
|
| 2600 | * changing. But there's no mechanism to ensure that...
|
| 2601 |
|
| 2602 | static long usbdev_do_ioctl(struct file *file, unsigned int cmd,
|
| 2603 | void __user *p)
|
| 2604 | {
|
| 2605 | struct usb_dev_state *ps = file->private_data;
|
| 2606 | struct inode *inode = file_inode(file);
|
| 2607 | struct usb_device *dev = ps->dev;
|
| 2608 | int ret = -ENOTTY;
|
| 2609 |
|
| 2610 | if (!(file->f_mode & FMODE_WRITE))
|
| 2611 | return -EPERM;
|
| 2612 |
|
| 2613 | usb_lock_device(dev);
|
| 2614 |
|
| 2615 |
|
| 2616 | switch (cmd) {
|
| 2617 | case USBDEVFS_REAPURB:
|
| 2618 | snoop(&dev->dev, "%s: REAPURB\n", __func__);
|
| 2619 | ret = proc_reapurb(ps, p);
|
| 2620 | goto done;
|
| 2621 |
|
| 2622 | case USBDEVFS_REAPURBNDELAY:
|
| 2623 | snoop(&dev->dev, "%s: REAPURBNDELAY\n", __func__);
|
| 2624 | ret = proc_reapurbnonblock(ps, p);
|
| 2625 | goto done;
|
| 2626 |
|
| 2627 | #ifdef CONFIG_COMPAT
|
| 2628 | case USBDEVFS_REAPURB32:
|
| 2629 | snoop(&dev->dev, "%s: REAPURB32\n", __func__);
|
| 2630 | ret = proc_reapurb_compat(ps, p);
|
| 2631 | goto done;
|
| 2632 |
|
| 2633 | case USBDEVFS_REAPURBNDELAY32:
|
| 2634 | snoop(&dev->dev, "%s: REAPURBNDELAY32\n", __func__);
|
| 2635 | ret = proc_reapurbnonblock_compat(ps, p);
|
| 2636 | goto done;
|
| 2637 | #endif
|
| 2638 | }
|
| 2639 |
|
| 2640 | if (!connected(ps)) {
|
| 2641 | usb_unlock_device(dev);
|
| 2642 | return -ENODEV;
|
| 2643 | }
|
| 2644 |
|
| 2645 | switch (cmd) {
|
| 2646 | case USBDEVFS_CONTROL:
|
| 2647 | snoop(&dev->dev, "%s: CONTROL\n", __func__);
|
| 2648 | ret = proc_control(ps, p);
|
| 2649 | if (ret >= 0)
|
| 2650 | inode_set_mtime_to_ts(inode,
|
| 2651 | inode_set_ctime_current(inode));
|
| 2652 | break;
|
| 2653 |
|
| 2654 | case USBDEVFS_BULK:
|
| 2655 | snoop(&dev->dev, "%s: BULK\n", __func__);
|
| 2656 | ret = proc_bulk(ps, p);
|
| 2657 | if (ret >= 0)
|
| 2658 | inode_set_mtime_to_ts(inode,
|
| 2659 | inode_set_ctime_current(inode));
|
| 2660 | break;
|
| 2661 |
|
| 2662 | case USBDEVFS_RESETEP:
|
| 2663 | snoop(&dev->dev, "%s: RESETEP\n", __func__);
|
| 2664 | ret = proc_resetep(ps, p);
|
| 2665 | if (ret >= 0)
|
| 2666 | inode_set_mtime_to_ts(inode,
|
| 2667 | inode_set_ctime_current(inode));
|
| 2668 | break;
|
| 2669 |
|
| 2670 | case USBDEVFS_RESET:
|
| 2671 | snoop(&dev->dev, "%s: RESET\n", __func__);
|
| 2672 | ret = proc_resetdevice(ps);
|
| 2673 | break;
|
| 2674 |
|
| 2675 | case USBDEVFS_CLEAR_HALT:
|
| 2676 | snoop(&dev->dev, "%s: CLEAR_HALT\n", __func__);
|
| 2677 | ret = proc_clearhalt(ps, p);
|
| 2678 | if (ret >= 0)
|
| 2679 | inode_set_mtime_to_ts(inode,
|
| 2680 | inode_set_ctime_current(inode));
|
| 2681 | break;
|
| 2682 |
|
| 2683 | case USBDEVFS_GETDRIVER:
|
| 2684 | snoop(&dev->dev, "%s: GETDRIVER\n", __func__);
|
| 2685 | ret = proc_getdriver(ps, p);
|
| 2686 | break;
|
| 2687 |
|
| 2688 | case USBDEVFS_CONNECTINFO:
|
| 2689 | snoop(&dev->dev, "%s: CONNECTINFO\n", __func__);
|
| 2690 | ret = proc_connectinfo(ps, p);
|
| 2691 | break;
|
| 2692 |
|
| 2693 | case USBDEVFS_SETINTERFACE:
|
| 2694 | snoop(&dev->dev, "%s: SETINTERFACE\n", __func__);
|
| 2695 | ret = proc_setintf(ps, p);
|
| 2696 | break;
|
| 2697 |
|
| 2698 | case USBDEVFS_SETCONFIGURATION:
|
| 2699 | snoop(&dev->dev, "%s: SETCONFIGURATION\n", __func__);
|
| 2700 | ret = proc_setconfig(ps, p);
|
| 2701 | break;
|
| 2702 |
|
| 2703 | case USBDEVFS_SUBMITURB:
|
| 2704 | snoop(&dev->dev, "%s: SUBMITURB\n", __func__);
|
| 2705 | ret = proc_submiturb(ps, p);
|
| 2706 | if (ret >= 0)
|
| 2707 | inode_set_mtime_to_ts(inode,
|
| 2708 | inode_set_ctime_current(inode));
|
| 2709 | break;
|
| 2710 |
|
| 2711 | #ifdef CONFIG_COMPAT
|
| 2712 | case USBDEVFS_CONTROL32:
|
| 2713 | snoop(&dev->dev, "%s: CONTROL32\n", __func__);
|
| 2714 | ret = proc_control_compat(ps, p);
|
| 2715 | if (ret >= 0)
|
| 2716 | inode_set_mtime_to_ts(inode,
|
| 2717 | inode_set_ctime_current(inode));
|
| 2718 | break;
|
| 2719 |
|
| 2720 | case USBDEVFS_BULK32:
|
| 2721 | snoop(&dev->dev, "%s: BULK32\n", __func__);
|
| 2722 | ret = proc_bulk_compat(ps, p);
|
| 2723 | if (ret >= 0)
|
| 2724 | inode_set_mtime_to_ts(inode,
|
| 2725 | inode_set_ctime_current(inode));
|
| 2726 | break;
|
| 2727 |
|
| 2728 | case USBDEVFS_DISCSIGNAL32:
|
| 2729 | snoop(&dev->dev, "%s: DISCSIGNAL32\n", __func__);
|
| 2730 | ret = proc_disconnectsignal_compat(ps, p);
|
| 2731 | break;
|
| 2732 |
|
| 2733 | case USBDEVFS_SUBMITURB32:
|
| 2734 | snoop(&dev->dev, "%s: SUBMITURB32\n", __func__);
|
| 2735 | ret = proc_submiturb_compat(ps, p);
|
| 2736 | if (ret >= 0)
|
| 2737 | inode_set_mtime_to_ts(inode,
|
| 2738 | inode_set_ctime_current(inode));
|
| 2739 | break;
|
| 2740 |
|
| 2741 | case USBDEVFS_IOCTL32:
|
| 2742 | snoop(&dev->dev, "%s: IOCTL32\n", __func__);
|
| 2743 | ret = proc_ioctl_compat(ps, ptr_to_compat(p));
|
| 2744 | break;
|
| 2745 | #endif
|
| 2746 |
|
| 2747 | case USBDEVFS_DISCARDURB:
|
| 2748 | snoop(&dev->dev, "%s: DISCARDURB %px\n", __func__, p);
|
| 2749 | ret = proc_unlinkurb(ps, p);
|
| 2750 | break;
|
| 2751 |
|
| 2752 | case USBDEVFS_DISCSIGNAL:
|
| 2753 | snoop(&dev->dev, "%s: DISCSIGNAL\n", __func__);
|
| 2754 | ret = proc_disconnectsignal(ps, p);
|
| 2755 | break;
|
| 2756 |
|
| 2757 | case USBDEVFS_CLAIMINTERFACE:
|
| 2758 | snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __func__);
|
| 2759 | ret = proc_claiminterface(ps, p);
|
| 2760 | break;
|
| 2761 |
|
| 2762 | case USBDEVFS_RELEASEINTERFACE:
|
| 2763 | snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __func__);
|
| 2764 | ret = proc_releaseinterface(ps, p);
|
| 2765 | break;
|
| 2766 |
|
| 2767 | case USBDEVFS_IOCTL:
|
| 2768 | snoop(&dev->dev, "%s: IOCTL\n", __func__);
|
| 2769 | ret = proc_ioctl_default(ps, p);
|
| 2770 | break;
|
| 2771 |
|
| 2772 | case USBDEVFS_CLAIM_PORT:
|
| 2773 | snoop(&dev->dev, "%s: CLAIM_PORT\n", __func__);
|
| 2774 | ret = proc_claim_port(ps, p);
|
| 2775 | break;
|
| 2776 |
|
| 2777 | case USBDEVFS_RELEASE_PORT:
|
| 2778 | snoop(&dev->dev, "%s: RELEASE_PORT\n", __func__);
|
| 2779 | ret = proc_release_port(ps, p);
|
| 2780 | break;
|
| 2781 | case USBDEVFS_GET_CAPABILITIES:
|
| 2782 | ret = proc_get_capabilities(ps, p);
|
| 2783 | break;
|
| 2784 | case USBDEVFS_DISCONNECT_CLAIM:
|
| 2785 | ret = proc_disconnect_claim(ps, p);
|
| 2786 | break;
|
| 2787 | case USBDEVFS_ALLOC_STREAMS:
|
| 2788 | ret = proc_alloc_streams(ps, p);
|
| 2789 | break;
|
| 2790 | case USBDEVFS_FREE_STREAMS:
|
| 2791 | ret = proc_free_streams(ps, p);
|
| 2792 | break;
|
| 2793 | case USBDEVFS_DROP_PRIVILEGES:
|
| 2794 | ret = proc_drop_privileges(ps, p);
|
| 2795 | break;
|
| 2796 | case USBDEVFS_GET_SPEED:
|
| 2797 | ret = ps->dev->speed;
|
| 2798 | break;
|
| 2799 | case USBDEVFS_FORBID_SUSPEND:
|
| 2800 | ret = proc_forbid_suspend(ps);
|
| 2801 | break;
|
| 2802 | case USBDEVFS_ALLOW_SUSPEND:
|
| 2803 | ret = proc_allow_suspend(ps);
|
| 2804 | break;
|
| 2805 | case USBDEVFS_WAIT_FOR_RESUME:
|
| 2806 | ret = proc_wait_for_resume(ps);
|
| 2807 | break;
|
| 2808 | }
|
| 2809 |
|
| 2810 |
|
| 2811 | switch (cmd & ~IOCSIZE_MASK) {
|
| 2812 | case USBDEVFS_CONNINFO_EX(0):
|
| 2813 | ret = proc_conninfo_ex(ps, p, _IOC_SIZE(cmd));
|
| 2814 | break;
|
| 2815 | }
|
| 2816 |
|
| 2817 | done:
|
| 2818 | usb_unlock_device(dev);
|
| 2819 | if (ret >= 0)
|
| 2820 | inode_set_atime_to_ts(inode, current_time(inode));
|
| 2821 | return ret;
|
| 2822 | }
|
| 2823 |
|
| 2824 | static long usbdev_ioctl(struct file *file, unsigned int cmd,
|
| 2825 | unsigned long arg)
|
| 2826 | {
|
| 2827 | int ret;
|
| 2828 |
|
| 2829 | ret = usbdev_do_ioctl(file, cmd, (void __user *)arg);
|
| 2830 |
|
| 2831 | return ret;
|
| 2832 | }
|
| 2833 |
|
| 2834 |
|
| 2835 | static __poll_t usbdev_poll(struct file *file,
|
| 2836 | struct poll_table_struct *wait)
|
| 2837 | {
|
| 2838 | struct usb_dev_state *ps = file->private_data;
|
| 2839 | __poll_t mask = 0;
|
| 2840 |
|
| 2841 | poll_wait(file, &ps->wait, wait);
|
| 2842 | if (file->f_mode & FMODE_WRITE && !list_empty(&ps->async_completed))
|
| 2843 | mask |= EPOLLOUT | EPOLLWRNORM;
|
| 2844 | if (!connected(ps))
|
| 2845 | mask |= EPOLLHUP;
|
| 2846 | if (list_empty(&ps->list))
|
| 2847 | mask |= EPOLLERR;
|
| 2848 | return mask;
|
| 2849 | }
|
| 2850 |
|
| 2851 | const struct file_operations usbdev_file_operations = {
|
| 2852 | .owner = THIS_MODULE,
|
| 2853 | .llseek = no_seek_end_llseek,
|
| 2854 | .read = usbdev_read,
|
| 2855 | .poll = usbdev_poll,
|
| 2856 | .unlocked_ioctl = usbdev_ioctl,
|
| 2857 | .compat_ioctl = compat_ptr_ioctl,
|
| 2858 | .mmap = usbdev_mmap,
|
| 2859 | .open = usbdev_open,
|
| 2860 | .release = usbdev_release,
|
| 2861 | };
|
| 2862 |
|
| 2863 | static void usbdev_remove(struct usb_device *udev)
|
| 2864 | {
|
| 2865 | struct usb_dev_state *ps;
|
| 2866 |
|
| 2867 |
|
| 2868 | mutex_lock(&usbfs_mutex);
|
| 2869 | while (!list_empty(&udev->filelist)) {
|
| 2870 | ps = list_entry(udev->filelist.next, struct usb_dev_state, list);
|
| 2871 | destroy_all_async(ps);
|
| 2872 | wake_up_all(&ps->wait);
|
| 2873 | WRITE_ONCE(ps->not_yet_resumed, 0);
|
| 2874 | wake_up_all(&ps->wait_for_resume);
|
| 2875 | list_del_init(&ps->list);
|
| 2876 | if (ps->discsignr)
|
| 2877 | kill_pid_usb_asyncio(ps->discsignr, EPIPE, ps->disccontext,
|
| 2878 | ps->disc_pid, ps->cred);
|
| 2879 | }
|
| 2880 | mutex_unlock(&usbfs_mutex);
|
| 2881 | }
|
| 2882 |
|
| 2883 | static int usbdev_notify(struct notifier_block *self,
|
| 2884 | unsigned long action, void *dev)
|
| 2885 | {
|
| 2886 | switch (action) {
|
| 2887 | case USB_DEVICE_ADD:
|
| 2888 | break;
|
| 2889 | case USB_DEVICE_REMOVE:
|
| 2890 | usbdev_remove(dev);
|
| 2891 | break;
|
| 2892 | }
|
| 2893 | return NOTIFY_OK;
|
| 2894 | }
|
| 2895 |
|
| 2896 | static struct notifier_block usbdev_nb = {
|
| 2897 | .notifier_call = usbdev_notify,
|
| 2898 | };
|
| 2899 |
|
| 2900 | static struct cdev usb_device_cdev;
|
| 2901 |
|
| 2902 | int __init usb_devio_init(void)
|
| 2903 | {
|
| 2904 | int retval;
|
| 2905 |
|
| 2906 | retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX,
|
| 2907 | "usb_device");
|
| 2908 | if (retval) {
|
| 2909 | printk(KERN_ERR "Unable to register minors for usb_device\n");
|
| 2910 | goto out;
|
| 2911 | }
|
| 2912 | cdev_init(&usb_device_cdev, &usbdev_file_operations);
|
| 2913 | retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX);
|
| 2914 | if (retval) {
|
| 2915 | printk(KERN_ERR "Unable to get usb_device major %d\n",
|
| 2916 | USB_DEVICE_MAJOR);
|
| 2917 | goto error_cdev;
|
| 2918 | }
|
| 2919 | usb_register_notify(&usbdev_nb);
|
| 2920 | out:
|
| 2921 | return retval;
|
| 2922 |
|
| 2923 | error_cdev:
|
| 2924 | unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
|
| 2925 | goto out;
|
| 2926 | }
|
| 2927 |
|
| 2928 | void usb_devio_cleanup(void)
|
| 2929 | {
|
| 2930 | usb_unregister_notify(&usbdev_nb);
|
| 2931 | cdev_del(&usb_device_cdev);
|
| 2932 | unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
|
| 2933 | }
|