| 1 | // SPDX-License-Identifier: GPL-2.0+ | 
|---|
| 2 | /*****************************************************************************/ | 
|---|
| 3 |  | 
|---|
| 4 | /* | 
|---|
| 5 | *      devio.c  --  User space communication with USB devices. | 
|---|
| 6 | * | 
|---|
| 7 | *      Copyright (C) 1999-2000  Thomas Sailer (sailer@ife.ee.ethz.ch) | 
|---|
| 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>	/* for usbcore internals */ | 
|---|
| 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 /* split-size for large txs */ | 
|---|
| 57 |  | 
|---|
| 58 | /* Mutual exclusion for ps->list in resume vs. release and remove */ | 
|---|
| 59 | static DEFINE_MUTEX(usbfs_mutex); | 
|---|
| 60 |  | 
|---|
| 61 | struct usb_dev_state { | 
|---|
| 62 | struct list_head list;      /* state list */ | 
|---|
| 63 | struct usb_device *dev; | 
|---|
| 64 | struct file *file; | 
|---|
| 65 | spinlock_t lock;            /* protects the async urb lists */ | 
|---|
| 66 | struct list_head async_pending; | 
|---|
| 67 | struct list_head async_completed; | 
|---|
| 68 | struct list_head memory_list; | 
|---|
| 69 | wait_queue_head_t wait;     /* wake up if a request completed */ | 
|---|
| 70 | wait_queue_head_t wait_for_resume;   /* wake up upon runtime 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 | /* Limit on the total amount of memory we can allocate for transfers */ | 
|---|
| 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 | /* Hard limit, necessary to avoid arithmetic overflow */ | 
|---|
| 140 | #define USBFS_XFER_MAX         (UINT_MAX / 2 - 1000000) | 
|---|
| 141 |  | 
|---|
| 142 | static DEFINE_SPINLOCK(usbfs_memory_usage_lock); | 
|---|
| 143 | static u64 usbfs_memory_usage;	/* Total memory currently allocated */ | 
|---|
| 144 |  | 
|---|
| 145 | /* Check whether it's okay to allocate more memory for a transfer */ | 
|---|
| 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(lock: &usbfs_memory_usage_lock, flags); | 
|---|
| 163 |  | 
|---|
| 164 | return ret; | 
|---|
| 165 | } | 
|---|
| 166 |  | 
|---|
| 167 | /* Memory for a transfer is being deallocated */ | 
|---|
| 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(lock: &usbfs_memory_usage_lock, flags); | 
|---|
| 178 | } | 
|---|
| 179 |  | 
|---|
| 180 | static int connected(struct usb_dev_state *ps) | 
|---|
| 181 | { | 
|---|
| 182 | return (!list_empty(head: &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(bus: 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(entry: &usbm->memlist); | 
|---|
| 196 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 197 |  | 
|---|
| 198 | hcd_buffer_free_pages(hcd, size: usbm->size, | 
|---|
| 199 | addr: usbm->mem, dma: usbm->dma_handle); | 
|---|
| 200 | usbfs_decrease_memory_usage( | 
|---|
| 201 | amount: usbm->size + sizeof(struct usb_memory)); | 
|---|
| 202 | kfree(objp: usbm); | 
|---|
| 203 | } else { | 
|---|
| 204 | spin_unlock_irqrestore(lock: &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(lock: &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, count: &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(bus: 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(amount: size + sizeof(struct usb_memory)); | 
|---|
| 245 | if (ret) | 
|---|
| 246 | goto error; | 
|---|
| 247 |  | 
|---|
| 248 | usbm = kzalloc(sizeof(struct usb_memory), GFP_KERNEL); | 
|---|
| 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: &dma_handle); | 
|---|
| 256 | if (!mem) { | 
|---|
| 257 | ret = -ENOMEM; | 
|---|
| 258 | goto error_free_usbm; | 
|---|
| 259 | } | 
|---|
| 260 |  | 
|---|
| 261 | memset(s: mem, c: 0, n: 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(list: &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, addr: vma->vm_start, | 
|---|
| 280 | virt_to_phys(address: usbm->mem) >> PAGE_SHIFT, | 
|---|
| 281 | size, vma->vm_page_prot) < 0) { | 
|---|
| 282 | dec_usb_memory_use_count(usbm, count: &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, count: &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(new: &usbm->memlist, head: &ps->memory_list); | 
|---|
| 299 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 300 |  | 
|---|
| 301 | return 0; | 
|---|
| 302 |  | 
|---|
| 303 | error_free_usbm: | 
|---|
| 304 | kfree(objp: usbm); | 
|---|
| 305 | error_decrease_mem: | 
|---|
| 306 | usbfs_decrease_memory_usage(amount: 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 | /* 18 bytes - fits on the stack */ | 
|---|
| 333 | struct usb_device_descriptor temp_desc; | 
|---|
| 334 |  | 
|---|
| 335 | memcpy(to: &temp_desc, from: &dev->descriptor, len: 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(to: buf, from: ((char *)&temp_desc) + pos, n: 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 | /* The descriptor may claim to be longer than it | 
|---|
| 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 | /* Simply don't write (skip over) unallocated parts */ | 
|---|
| 373 | if (alloclen > (*ppos - pos)) { | 
|---|
| 374 | alloclen -= (*ppos - pos); | 
|---|
| 375 | if (copy_to_user(to: buf, | 
|---|
| 376 | from: 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(sizeof(struct async), GFP_KERNEL); | 
|---|
| 406 | if (!as) | 
|---|
| 407 | return NULL; | 
|---|
| 408 | as->urb = usb_alloc_urb(iso_packets: numisoframes, GFP_KERNEL); | 
|---|
| 409 | if (!as->urb) { | 
|---|
| 410 | kfree(objp: 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(pid: as->pid); | 
|---|
| 421 | if (as->cred) | 
|---|
| 422 | put_cred(cred: as->cred); | 
|---|
| 423 | for (i = 0; i < as->urb->num_sgs; i++) { | 
|---|
| 424 | if (sg_page(sg: &as->urb->sg[i])) | 
|---|
| 425 | kfree(objp: sg_virt(sg: &as->urb->sg[i])); | 
|---|
| 426 | } | 
|---|
| 427 |  | 
|---|
| 428 | kfree(objp: as->urb->sg); | 
|---|
| 429 | if (as->usbm == NULL) | 
|---|
| 430 | kfree(objp: as->urb->transfer_buffer); | 
|---|
| 431 | else | 
|---|
| 432 | dec_usb_memory_use_count(usbm: as->usbm, count: &as->usbm->urb_use_count); | 
|---|
| 433 |  | 
|---|
| 434 | kfree(objp: as->urb->setup_packet); | 
|---|
| 435 | usb_free_urb(urb: as->urb); | 
|---|
| 436 | usbfs_decrease_memory_usage(amount: as->mem_usage); | 
|---|
| 437 | kfree(objp: 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(new: &as->asynclist, head: &ps->async_pending); | 
|---|
| 447 | spin_unlock_irqrestore(lock: &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(entry: &as->asynclist); | 
|---|
| 457 | spin_unlock_irqrestore(lock: &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(head: &ps->async_completed)) { | 
|---|
| 467 | as = list_entry(ps->async_completed.next, struct async, | 
|---|
| 468 | asynclist); | 
|---|
| 469 | list_del_init(entry: &as->asynclist); | 
|---|
| 470 | } | 
|---|
| 471 | spin_unlock_irqrestore(lock: &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(entry: &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) {		/* Async */ | 
|---|
| 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, prefix_str: "data: ", prefix_type: DUMP_PREFIX_NONE, rowsize: 32, groupsize: 1, | 
|---|
| 530 | buf: data, len: data_len, ascii: 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, prefix_str: "data: ", prefix_type: DUMP_PREFIX_NONE, rowsize: 32, groupsize: 1, | 
|---|
| 544 | buf: urb->transfer_buffer, len, ascii: 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, prefix_str: "data: ", prefix_type: DUMP_PREFIX_NONE, rowsize: 32, groupsize: 1, | 
|---|
| 551 | buf: sg_virt(sg: &urb->sg[i]), len: size, ascii: 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)		/* Isochronous */ | 
|---|
| 561 | len = urb->transfer_buffer_length; | 
|---|
| 562 | else					/* Non-Isoc */ | 
|---|
| 563 | len = urb->actual_length; | 
|---|
| 564 |  | 
|---|
| 565 | if (urb->num_sgs == 0) { | 
|---|
| 566 | if (copy_to_user(to: userbuffer, from: urb->transfer_buffer, n: 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(to: userbuffer, from: sg_virt(sg: &urb->sg[i]), n: 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 | /* Mark all the pending URBs that match bulk_addr, up to but not | 
|---|
| 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 | /* Now carefully unlink all the marked pending URBs */ | 
|---|
| 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;		/* Only once */ | 
|---|
| 612 | urb = as->urb; | 
|---|
| 613 | usb_get_urb(urb); | 
|---|
| 614 | spin_unlock(lock: &ps->lock);		/* Allow completions */ | 
|---|
| 615 | usb_unlink_urb(urb); | 
|---|
| 616 | usb_put_urb(urb); | 
|---|
| 617 | spin_lock(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(list: &as->asynclist, head: &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(pid: as->pid); | 
|---|
| 641 | cred = get_cred(cred: as->cred); | 
|---|
| 642 | } | 
|---|
| 643 | snoop(&urb->dev->dev, "urb complete\n"); | 
|---|
| 644 | snoop_urb(udev: urb->dev, userurb: as->userurb, pipe: urb->pipe, length: urb->actual_length, | 
|---|
| 645 | timeout_or_status: as->status, when: COMPLETE, NULL, data_len: 0); | 
|---|
| 646 | if (usb_urb_dir_in(urb)) | 
|---|
| 647 | snoop_urb_data(urb, len: urb->actual_length); | 
|---|
| 648 |  | 
|---|
| 649 | if (as->status < 0 && as->bulk_addr && as->status != -ECONNRESET && | 
|---|
| 650 | as->status != -ENOENT) | 
|---|
| 651 | cancel_bulk_urbs(ps, bulk_addr: as->bulk_addr); | 
|---|
| 652 |  | 
|---|
| 653 | wake_up(&ps->wait); | 
|---|
| 654 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 655 |  | 
|---|
| 656 | if (signr) { | 
|---|
| 657 | kill_pid_usb_asyncio(sig: 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(head: list)) { | 
|---|
| 671 | as = list_last_entry(list, struct async, asynclist); | 
|---|
| 672 | list_del_init(entry: &as->asynclist); | 
|---|
| 673 | urb = as->urb; | 
|---|
| 674 | usb_get_urb(urb); | 
|---|
| 675 |  | 
|---|
| 676 | /* drop the spinlock so the completion handler can run */ | 
|---|
| 677 | spin_unlock_irqrestore(lock: &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(lock: &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(list: &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(list: p, head: &hitlist); | 
|---|
| 696 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 697 | destroy_async(ps, list: &hitlist); | 
|---|
| 698 | } | 
|---|
| 699 |  | 
|---|
| 700 | static void destroy_all_async(struct usb_dev_state *ps) | 
|---|
| 701 | { | 
|---|
| 702 | destroy_async(ps, list: &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 | /* NOTE:  this relies on usbcore having canceled and completed | 
|---|
| 726 | * all pending I/O requests; 2.6 does that. | 
|---|
| 727 | */ | 
|---|
| 728 |  | 
|---|
| 729 | if (likely(ifnum < 8*sizeof(ps->ifclaimed))) | 
|---|
| 730 | clear_bit(nr: ifnum, addr: &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 | /* force async requests to complete */ | 
|---|
| 738 | destroy_async_on_interface(ps, ifnum); | 
|---|
| 739 | } | 
|---|
| 740 |  | 
|---|
| 741 | /* We don't care about suspend/resume of claimed interfaces */ | 
|---|
| 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 | /* The following routines apply to the entire device, not interfaces */ | 
|---|
| 754 | void usbfs_notify_suspend(struct usb_device *udev) | 
|---|
| 755 | { | 
|---|
| 756 | /* We don't need to handle this */ | 
|---|
| 757 | } | 
|---|
| 758 |  | 
|---|
| 759 | void usbfs_notify_resume(struct usb_device *udev) | 
|---|
| 760 | { | 
|---|
| 761 | struct usb_dev_state *ps; | 
|---|
| 762 |  | 
|---|
| 763 | /* Protect against simultaneous remove or release */ | 
|---|
| 764 | mutex_lock(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(lock: &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 | /* already claimed */ | 
|---|
| 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 | /* suppress uevents while claiming interface */ | 
|---|
| 805 | old_suppress = dev_get_uevent_suppress(dev: &intf->dev); | 
|---|
| 806 | dev_set_uevent_suppress(dev: &intf->dev, val: 1); | 
|---|
| 807 | err = usb_driver_claim_interface(driver: &usbfs_driver, iface: intf, data: ps); | 
|---|
| 808 | dev_set_uevent_suppress(dev: &intf->dev, val: old_suppress); | 
|---|
| 809 | } | 
|---|
| 810 | if (err == 0) | 
|---|
| 811 | set_bit(nr: ifnum, addr: &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(nr: ifnum, addr: &ps->ifclaimed)) { | 
|---|
| 829 | unsigned int old_suppress; | 
|---|
| 830 |  | 
|---|
| 831 | /* suppress uevents while releasing interface */ | 
|---|
| 832 | old_suppress = dev_get_uevent_suppress(dev: &intf->dev); | 
|---|
| 833 | dev_set_uevent_suppress(dev: &intf->dev, val: 1); | 
|---|
| 834 | usb_driver_release_interface(driver: &usbfs_driver, iface: intf); | 
|---|
| 835 | dev_set_uevent_suppress(dev: &intf->dev, val: 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 | /* if not yet claimed, claim it for the driver */ | 
|---|
| 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(config: ps->dev->actconfig, | 
|---|
| 901 | iface_num: index >> 8, alt_num: 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(dev: ps->dev, ep: 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(dev: ps->dev, ep: 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, ifnum: ret); | 
|---|
| 931 | break; | 
|---|
| 932 |  | 
|---|
| 933 | case USB_RECIP_INTERFACE: | 
|---|
| 934 | ret = checkintf(ps, ifnum: 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 | /* The XHCI controller allows max 2 ^ 16 streams */ | 
|---|
| 970 | if (num_streams_ret && (num_streams < 2 || num_streams > 65536)) | 
|---|
| 971 | return -EINVAL; | 
|---|
| 972 |  | 
|---|
| 973 | eps = kmalloc_array(num_eps, sizeof(*eps), GFP_KERNEL); | 
|---|
| 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(dev: ps->dev, ep); | 
|---|
| 983 | if (!eps[i]) { | 
|---|
| 984 | ret = -EINVAL; | 
|---|
| 985 | goto error; | 
|---|
| 986 | } | 
|---|
| 987 |  | 
|---|
| 988 | /* usb_alloc/free_streams operate on an usb_interface */ | 
|---|
| 989 | ifnum = findintfep(dev: 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(dev: ps->dev, ifnum); | 
|---|
| 1000 | } else { | 
|---|
| 1001 | /* Verify all eps belong to the same interface */ | 
|---|
| 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(objp: 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(bus: &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(sizeof(struct usb_dev_state), GFP_KERNEL); | 
|---|
| 1043 | if (!ps) | 
|---|
| 1044 | goto out_free_ps; | 
|---|
| 1045 |  | 
|---|
| 1046 | ret = -ENODEV; | 
|---|
| 1047 |  | 
|---|
| 1048 | /* usbdev device-node */ | 
|---|
| 1049 | if (imajor(inode) == USB_DEVICE_MAJOR) | 
|---|
| 1050 | dev = usbdev_lookup_by_devt(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(udev: dev); | 
|---|
| 1059 | if (ret) | 
|---|
| 1060 | goto out_unlock_device; | 
|---|
| 1061 |  | 
|---|
| 1062 | ps->dev = dev; | 
|---|
| 1063 | ps->file = file; | 
|---|
| 1064 | ps->interface_allowed_mask = 0xFFFFFFFF; /* 32 bits */ | 
|---|
| 1065 | spin_lock_init(&ps->lock); | 
|---|
| 1066 | INIT_LIST_HEAD(list: &ps->list); | 
|---|
| 1067 | INIT_LIST_HEAD(list: &ps->async_pending); | 
|---|
| 1068 | INIT_LIST_HEAD(list: &ps->async_completed); | 
|---|
| 1069 | INIT_LIST_HEAD(list: &ps->memory_list); | 
|---|
| 1070 | init_waitqueue_head(&ps->wait); | 
|---|
| 1071 | init_waitqueue_head(&ps->wait_for_resume); | 
|---|
| 1072 | ps->disc_pid = get_pid(pid: task_pid(current)); | 
|---|
| 1073 | ps->cred = get_current_cred(); | 
|---|
| 1074 | smp_wmb(); | 
|---|
| 1075 |  | 
|---|
| 1076 | /* Can't race with resume; the device is already active */ | 
|---|
| 1077 | list_add_tail(new: &ps->list, head: &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(objp: 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(hdev: dev, owner: ps); | 
|---|
| 1101 |  | 
|---|
| 1102 | /* Protect against simultaneous resume */ | 
|---|
| 1103 | mutex_lock(lock: &usbfs_mutex); | 
|---|
| 1104 | list_del_init(entry: &ps->list); | 
|---|
| 1105 | mutex_unlock(lock: &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(udev: dev); | 
|---|
| 1115 | usb_unlock_device(dev); | 
|---|
| 1116 | usb_put_dev(dev); | 
|---|
| 1117 | put_pid(pid: ps->disc_pid); | 
|---|
| 1118 | put_cred(cred: ps->cred); | 
|---|
| 1119 |  | 
|---|
| 1120 | as = async_getcompleted(ps); | 
|---|
| 1121 | while (as) { | 
|---|
| 1122 | free_async(as); | 
|---|
| 1123 | as = async_getcompleted(ps); | 
|---|
| 1124 | } | 
|---|
| 1125 |  | 
|---|
| 1126 | kfree(objp: 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(m: timeout) : MAX_SCHEDULE_TIMEOUT); | 
|---|
| 1154 | rc = wait_for_completion_killable_timeout(x: &ctx, timeout: expire); | 
|---|
| 1155 | if (rc <= 0) { | 
|---|
| 1156 | usb_kill_urb(urb); | 
|---|
| 1157 | *actlen = urb->actual_length; | 
|---|
| 1158 | if (urb->status != -ENOENT) | 
|---|
| 1159 | ;	/* Completed before it was killed */ | 
|---|
| 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, requesttype: ctrl->bRequestType, request: ctrl->bRequest, | 
|---|
| 1181 | index: ctrl->wIndex); | 
|---|
| 1182 | if (ret) | 
|---|
| 1183 | return ret; | 
|---|
| 1184 | wLength = ctrl->wLength;	/* To suppress 64k PAGE_SIZE warning */ | 
|---|
| 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(iso_packets: 0, GFP_NOIO); | 
|---|
| 1197 | if (!urb) | 
|---|
| 1198 | goto done; | 
|---|
| 1199 | dr = kmalloc(sizeof(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, setup_packet: (unsigned char *) dr, transfer_buffer: tbuf, | 
|---|
| 1219 | buffer_length: wLength, NULL, NULL); | 
|---|
| 1220 | snoop_urb(udev: dev, NULL, pipe, length: wLength, timeout_or_status: tmo, when: SUBMIT, NULL, data_len: 0); | 
|---|
| 1221 |  | 
|---|
| 1222 | usb_unlock_device(dev); | 
|---|
| 1223 | i = usbfs_start_wait_urb(urb, timeout: tmo, actlen: &actlen); | 
|---|
| 1224 |  | 
|---|
| 1225 | /* Linger a bit, prior to the next control message. */ | 
|---|
| 1226 | if (dev->quirks & USB_QUIRK_DELAY_CTRL_MSG) | 
|---|
| 1227 | msleep(msecs: 200); | 
|---|
| 1228 | usb_lock_device(dev); | 
|---|
| 1229 | snoop_urb(udev: dev, NULL, pipe, length: actlen, timeout_or_status: i, when: COMPLETE, data: tbuf, data_len: actlen); | 
|---|
| 1230 | if (!i && actlen) { | 
|---|
| 1231 | if (copy_to_user(to: ctrl->data, from: tbuf, n: actlen)) { | 
|---|
| 1232 | ret = -EFAULT; | 
|---|
| 1233 | goto done; | 
|---|
| 1234 | } | 
|---|
| 1235 | } | 
|---|
| 1236 | } else { | 
|---|
| 1237 | if (wLength) { | 
|---|
| 1238 | if (copy_from_user(to: tbuf, from: ctrl->data, n: wLength)) { | 
|---|
| 1239 | ret = -EFAULT; | 
|---|
| 1240 | goto done; | 
|---|
| 1241 | } | 
|---|
| 1242 | } | 
|---|
| 1243 | pipe = usb_sndctrlpipe(dev, 0); | 
|---|
| 1244 | usb_fill_control_urb(urb, dev, pipe, setup_packet: (unsigned char *) dr, transfer_buffer: tbuf, | 
|---|
| 1245 | buffer_length: wLength, NULL, NULL); | 
|---|
| 1246 | snoop_urb(udev: dev, NULL, pipe, length: wLength, timeout_or_status: tmo, when: SUBMIT, data: tbuf, data_len: wLength); | 
|---|
| 1247 |  | 
|---|
| 1248 | usb_unlock_device(dev); | 
|---|
| 1249 | i = usbfs_start_wait_urb(urb, timeout: tmo, actlen: &actlen); | 
|---|
| 1250 |  | 
|---|
| 1251 | /* Linger a bit, prior to the next control message. */ | 
|---|
| 1252 | if (dev->quirks & USB_QUIRK_DELAY_CTRL_MSG) | 
|---|
| 1253 | msleep(msecs: 200); | 
|---|
| 1254 | usb_lock_device(dev); | 
|---|
| 1255 | snoop_urb(udev: dev, NULL, pipe, length: actlen, timeout_or_status: i, when: COMPLETE, NULL, data_len: 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(objp: 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(to: &ctrl, from: arg, n: sizeof(ctrl))) | 
|---|
| 1279 | return -EFAULT; | 
|---|
| 1280 | return do_proc_control(ps, ctrl: &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(dev: ps->dev, ep: bulk->ep); | 
|---|
| 1294 | if (ret < 0) | 
|---|
| 1295 | return ret; | 
|---|
| 1296 | ret = checkintf(ps, ifnum: 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(epd: &ep->desc)) | 
|---|
| 1310 | return -EINVAL; | 
|---|
| 1311 | ret = usbfs_increase_memory_usage(amount: 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(iso_packets: 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, transfer_buffer: tbuf, buffer_length: len1, | 
|---|
| 1331 | NULL, NULL, interval: ep->desc.bInterval); | 
|---|
| 1332 | } else { | 
|---|
| 1333 | usb_fill_bulk_urb(urb, dev, pipe, transfer_buffer: tbuf, buffer_length: len1, NULL, NULL); | 
|---|
| 1334 | } | 
|---|
| 1335 |  | 
|---|
| 1336 | tmo = bulk->timeout; | 
|---|
| 1337 | if (bulk->ep & 0x80) { | 
|---|
| 1338 | snoop_urb(udev: dev, NULL, pipe, length: len1, timeout_or_status: tmo, when: SUBMIT, NULL, data_len: 0); | 
|---|
| 1339 |  | 
|---|
| 1340 | usb_unlock_device(dev); | 
|---|
| 1341 | i = usbfs_start_wait_urb(urb, timeout: tmo, actlen: &len2); | 
|---|
| 1342 | usb_lock_device(dev); | 
|---|
| 1343 | snoop_urb(udev: dev, NULL, pipe, length: len2, timeout_or_status: i, when: COMPLETE, data: tbuf, data_len: len2); | 
|---|
| 1344 |  | 
|---|
| 1345 | if (!i && len2) { | 
|---|
| 1346 | if (copy_to_user(to: bulk->data, from: tbuf, n: len2)) { | 
|---|
| 1347 | ret = -EFAULT; | 
|---|
| 1348 | goto done; | 
|---|
| 1349 | } | 
|---|
| 1350 | } | 
|---|
| 1351 | } else { | 
|---|
| 1352 | if (len1) { | 
|---|
| 1353 | if (copy_from_user(to: tbuf, from: bulk->data, n: len1)) { | 
|---|
| 1354 | ret = -EFAULT; | 
|---|
| 1355 | goto done; | 
|---|
| 1356 | } | 
|---|
| 1357 | } | 
|---|
| 1358 | snoop_urb(udev: dev, NULL, pipe, length: len1, timeout_or_status: tmo, when: SUBMIT, data: tbuf, data_len: len1); | 
|---|
| 1359 |  | 
|---|
| 1360 | usb_unlock_device(dev); | 
|---|
| 1361 | i = usbfs_start_wait_urb(urb, timeout: tmo, actlen: &len2); | 
|---|
| 1362 | usb_lock_device(dev); | 
|---|
| 1363 | snoop_urb(udev: dev, NULL, pipe, length: len2, timeout_or_status: i, when: COMPLETE, NULL, data_len: 0); | 
|---|
| 1364 | } | 
|---|
| 1365 | ret = (i < 0 ? i : len2); | 
|---|
| 1366 | done: | 
|---|
| 1367 | usb_free_urb(urb); | 
|---|
| 1368 | kfree(objp: tbuf); | 
|---|
| 1369 | usbfs_decrease_memory_usage(amount: 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(to: &bulk, from: arg, n: sizeof(bulk))) | 
|---|
| 1378 | return -EFAULT; | 
|---|
| 1379 | return do_proc_bulk(ps, bulk: &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(head: &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(dev: ps->dev, ep); | 
|---|
| 1404 | if (ret < 0) | 
|---|
| 1405 | return ret; | 
|---|
| 1406 | ret = checkintf(ps, ifnum: ret); | 
|---|
| 1407 | if (ret) | 
|---|
| 1408 | return ret; | 
|---|
| 1409 | check_reset_of_active_ep(udev: ps->dev, epnum: ep, ioctl_name: "RESETEP"); | 
|---|
| 1410 | usb_reset_endpoint(dev: ps->dev, epaddr: 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(dev: ps->dev, ep); | 
|---|
| 1423 | if (ret < 0) | 
|---|
| 1424 | return ret; | 
|---|
| 1425 | ret = checkintf(ps, ifnum: ret); | 
|---|
| 1426 | if (ret) | 
|---|
| 1427 | return ret; | 
|---|
| 1428 | check_reset_of_active_ep(udev: ps->dev, epnum: ep, ioctl_name: "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(dev: 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(to: &gd, from: arg, n: sizeof(gd))) | 
|---|
| 1444 | return -EFAULT; | 
|---|
| 1445 | intf = usb_ifnum_to_if(dev: ps->dev, ifnum: 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(to: arg, from: &gd, n: 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(s: &ci, c: 0, n: sizeof(ci)); | 
|---|
| 1461 | ci.devnum = ps->dev->devnum; | 
|---|
| 1462 | ci.slow = ps->dev->speed == USB_SPEED_LOW; | 
|---|
| 1463 |  | 
|---|
| 1464 | if (copy_to_user(to: arg, from: &ci, n: 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(s: &ci, c: 0, n: 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(dest: &ci.ports[0], | 
|---|
| 1493 | src: &ci.ports[ARRAY_SIZE(ci.ports) - ci.num_ports], | 
|---|
| 1494 | count: ci.num_ports); | 
|---|
| 1495 |  | 
|---|
| 1496 | if (copy_to_user(to: arg, from: &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 | /* Don't allow a device reset if the process has dropped the | 
|---|
| 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(iface: 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(dev: 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(to: &setintf, from: arg, n: sizeof(setintf))) | 
|---|
| 1535 | return -EFAULT; | 
|---|
| 1536 | ret = checkintf(ps, ifnum: setintf.interface); | 
|---|
| 1537 | if (ret) | 
|---|
| 1538 | return ret; | 
|---|
| 1539 |  | 
|---|
| 1540 | destroy_async_on_interface(ps, ifnum: setintf.interface); | 
|---|
| 1541 |  | 
|---|
| 1542 | return usb_set_interface(dev: ps->dev, ifnum: setintf.interface, | 
|---|
| 1543 | alternate: 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 | /* Don't touch the device if any interfaces are claimed. | 
|---|
| 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(iface: 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 | /* SET_CONFIGURATION is often abused as a "cheap" driver reset, | 
|---|
| 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(dev: ps->dev); | 
|---|
| 1587 | else | 
|---|
| 1588 | status = usb_set_configuration(dev: ps->dev, configuration: 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(error: -EINVAL); | 
|---|
| 1608 | } else { | 
|---|
| 1609 | usbm = iter; | 
|---|
| 1610 | usbm->urb_use_count++; | 
|---|
| 1611 | } | 
|---|
| 1612 | break; | 
|---|
| 1613 | } | 
|---|
| 1614 | } | 
|---|
| 1615 | spin_unlock_irqrestore(lock: &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 | /* USBDEVFS_URB_ISO_ASAP is a special case */ | 
|---|
| 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(dev: ps->dev, ep: 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(dev: ps->dev, ep: 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(epd: &ep->desc)) | 
|---|
| 1669 | return -EINVAL; | 
|---|
| 1670 | /* min 8 byte setup packet */ | 
|---|
| 1671 | if (uurb->buffer_length < 8) | 
|---|
| 1672 | return -EINVAL; | 
|---|
| 1673 | dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL); | 
|---|
| 1674 | if (!dr) | 
|---|
| 1675 | return -ENOMEM; | 
|---|
| 1676 | if (copy_from_user(to: dr, from: uurb->buffer, n: 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, requesttype: dr->bRequestType, request: 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(epd: &ep->desc)) { | 
|---|
| 1715 | case USB_ENDPOINT_XFER_CONTROL: | 
|---|
| 1716 | case USB_ENDPOINT_XFER_ISOC: | 
|---|
| 1717 | return -EINVAL; | 
|---|
| 1718 | case USB_ENDPOINT_XFER_INT: | 
|---|
| 1719 | /* allow single-shot interrupt transfers */ | 
|---|
| 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(epd: &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 | /* arbitrary limit */ | 
|---|
| 1742 | if (uurb->number_of_packets < 1 || | 
|---|
| 1743 | uurb->number_of_packets > 128) | 
|---|
| 1744 | return -EINVAL; | 
|---|
| 1745 | if (!usb_endpoint_xfer_isoc(epd: &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(ptr: isopkt)) { | 
|---|
| 1752 | ret = PTR_ERR(ptr: 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(numisoframes: 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(ptr: as->usbm)) { | 
|---|
| 1788 | ret = PTR_ERR(ptr: as->usbm); | 
|---|
| 1789 | as->usbm = NULL; | 
|---|
| 1790 | goto error; | 
|---|
| 1791 | } | 
|---|
| 1792 |  | 
|---|
| 1793 | /* do not use SG buffers when memory mapped segments | 
|---|
| 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(amount: u); | 
|---|
| 1803 | if (ret) | 
|---|
| 1804 | goto error; | 
|---|
| 1805 | as->mem_usage = u; | 
|---|
| 1806 |  | 
|---|
| 1807 | if (num_sgs) { | 
|---|
| 1808 | as->urb->sg = kmalloc_array(num_sgs, | 
|---|
| 1809 | sizeof(struct scatterlist), | 
|---|
| 1810 | GFP_KERNEL | __GFP_NOWARN); | 
|---|
| 1811 | if (!as->urb->sg) { | 
|---|
| 1812 | ret = -ENOMEM; | 
|---|
| 1813 | goto error; | 
|---|
| 1814 | } | 
|---|
| 1815 | as->urb->num_sgs = num_sgs; | 
|---|
| 1816 | sg_init_table(as->urb->sg, as->urb->num_sgs); | 
|---|
| 1817 |  | 
|---|
| 1818 | totlen = uurb->buffer_length; | 
|---|
| 1819 | for (i = 0; i < as->urb->num_sgs; i++) { | 
|---|
| 1820 | u = (totlen > USB_SG_SIZE) ? USB_SG_SIZE : totlen; | 
|---|
| 1821 | buf = kmalloc(u, GFP_KERNEL); | 
|---|
| 1822 | if (!buf) { | 
|---|
| 1823 | ret = -ENOMEM; | 
|---|
| 1824 | goto error; | 
|---|
| 1825 | } | 
|---|
| 1826 | sg_set_buf(sg: &as->urb->sg[i], buf, buflen: u); | 
|---|
| 1827 |  | 
|---|
| 1828 | if (!is_in) { | 
|---|
| 1829 | if (copy_from_user(to: buf, from: uurb->buffer, n: u)) { | 
|---|
| 1830 | ret = -EFAULT; | 
|---|
| 1831 | goto error; | 
|---|
| 1832 | } | 
|---|
| 1833 | uurb->buffer += u; | 
|---|
| 1834 | } | 
|---|
| 1835 | totlen -= u; | 
|---|
| 1836 | } | 
|---|
| 1837 | } else if (uurb->buffer_length > 0) { | 
|---|
| 1838 | if (as->usbm) { | 
|---|
| 1839 | unsigned long uurb_start = (unsigned long)uurb->buffer; | 
|---|
| 1840 |  | 
|---|
| 1841 | as->urb->transfer_buffer = as->usbm->mem + | 
|---|
| 1842 | (uurb_start - as->usbm->vm_start); | 
|---|
| 1843 | } else { | 
|---|
| 1844 | as->urb->transfer_buffer = kmalloc(uurb->buffer_length, | 
|---|
| 1845 | GFP_KERNEL | __GFP_NOWARN); | 
|---|
| 1846 | if (!as->urb->transfer_buffer) { | 
|---|
| 1847 | ret = -ENOMEM; | 
|---|
| 1848 | goto error; | 
|---|
| 1849 | } | 
|---|
| 1850 | if (!is_in) { | 
|---|
| 1851 | if (copy_from_user(to: as->urb->transfer_buffer, | 
|---|
| 1852 | from: uurb->buffer, | 
|---|
| 1853 | n: uurb->buffer_length)) { | 
|---|
| 1854 | ret = -EFAULT; | 
|---|
| 1855 | goto error; | 
|---|
| 1856 | } | 
|---|
| 1857 | } else if (uurb->type == USBDEVFS_URB_TYPE_ISO) { | 
|---|
| 1858 | /* | 
|---|
| 1859 | * Isochronous input data may end up being | 
|---|
| 1860 | * discontiguous if some of the packets are | 
|---|
| 1861 | * short. Clear the buffer so that the gaps | 
|---|
| 1862 | * don't leak kernel data to userspace. | 
|---|
| 1863 | */ | 
|---|
| 1864 | memset(s: as->urb->transfer_buffer, c: 0, | 
|---|
| 1865 | n: uurb->buffer_length); | 
|---|
| 1866 | } | 
|---|
| 1867 | } | 
|---|
| 1868 | } | 
|---|
| 1869 | as->urb->dev = ps->dev; | 
|---|
| 1870 | as->urb->pipe = (uurb->type << 30) | | 
|---|
| 1871 | __create_pipe(dev: ps->dev, endpoint: uurb->endpoint & 0xf) | | 
|---|
| 1872 | (uurb->endpoint & USB_DIR_IN); | 
|---|
| 1873 |  | 
|---|
| 1874 | /* This tedious sequence is necessary because the URB_* flags | 
|---|
| 1875 | * are internal to the kernel and subject to change, whereas | 
|---|
| 1876 | * the USBDEVFS_URB_* flags are a user API and must not be changed. | 
|---|
| 1877 | */ | 
|---|
| 1878 | u = (is_in ? URB_DIR_IN : URB_DIR_OUT); | 
|---|
| 1879 | if (uurb->flags & USBDEVFS_URB_ISO_ASAP) | 
|---|
| 1880 | u |= URB_ISO_ASAP; | 
|---|
| 1881 | if (allow_short && uurb->flags & USBDEVFS_URB_SHORT_NOT_OK) | 
|---|
| 1882 | u |= URB_SHORT_NOT_OK; | 
|---|
| 1883 | if (allow_zero && uurb->flags & USBDEVFS_URB_ZERO_PACKET) | 
|---|
| 1884 | u |= URB_ZERO_PACKET; | 
|---|
| 1885 | if (uurb->flags & USBDEVFS_URB_NO_INTERRUPT) | 
|---|
| 1886 | u |= URB_NO_INTERRUPT; | 
|---|
| 1887 | as->urb->transfer_flags = u; | 
|---|
| 1888 |  | 
|---|
| 1889 | if (!allow_short && uurb->flags & USBDEVFS_URB_SHORT_NOT_OK) | 
|---|
| 1890 | dev_warn(&ps->dev->dev, "Requested nonsensical USBDEVFS_URB_SHORT_NOT_OK.\n"); | 
|---|
| 1891 | if (!allow_zero && uurb->flags & USBDEVFS_URB_ZERO_PACKET) | 
|---|
| 1892 | dev_warn(&ps->dev->dev, "Requested nonsensical USBDEVFS_URB_ZERO_PACKET.\n"); | 
|---|
| 1893 |  | 
|---|
| 1894 | as->urb->transfer_buffer_length = uurb->buffer_length; | 
|---|
| 1895 | as->urb->setup_packet = (unsigned char *)dr; | 
|---|
| 1896 | dr = NULL; | 
|---|
| 1897 | as->urb->start_frame = uurb->start_frame; | 
|---|
| 1898 | as->urb->number_of_packets = number_of_packets; | 
|---|
| 1899 | as->urb->stream_id = stream_id; | 
|---|
| 1900 |  | 
|---|
| 1901 | if (ep->desc.bInterval) { | 
|---|
| 1902 | if (uurb->type == USBDEVFS_URB_TYPE_ISO || | 
|---|
| 1903 | ps->dev->speed == USB_SPEED_HIGH || | 
|---|
| 1904 | ps->dev->speed >= USB_SPEED_SUPER) | 
|---|
| 1905 | as->urb->interval = 1 << | 
|---|
| 1906 | min(15, ep->desc.bInterval - 1); | 
|---|
| 1907 | else | 
|---|
| 1908 | as->urb->interval = ep->desc.bInterval; | 
|---|
| 1909 | } | 
|---|
| 1910 |  | 
|---|
| 1911 | as->urb->context = as; | 
|---|
| 1912 | as->urb->complete = async_completed; | 
|---|
| 1913 | for (totlen = u = 0; u < number_of_packets; u++) { | 
|---|
| 1914 | as->urb->iso_frame_desc[u].offset = totlen; | 
|---|
| 1915 | as->urb->iso_frame_desc[u].length = isopkt[u].length; | 
|---|
| 1916 | totlen += isopkt[u].length; | 
|---|
| 1917 | } | 
|---|
| 1918 | kfree(objp: isopkt); | 
|---|
| 1919 | isopkt = NULL; | 
|---|
| 1920 | as->ps = ps; | 
|---|
| 1921 | as->userurb = arg; | 
|---|
| 1922 | as->userurb_sigval = userurb_sigval; | 
|---|
| 1923 | if (as->usbm) { | 
|---|
| 1924 | unsigned long uurb_start = (unsigned long)uurb->buffer; | 
|---|
| 1925 |  | 
|---|
| 1926 | as->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 
|---|
| 1927 | as->urb->transfer_dma = as->usbm->dma_handle + | 
|---|
| 1928 | (uurb_start - as->usbm->vm_start); | 
|---|
| 1929 | } else if (is_in && uurb->buffer_length > 0) | 
|---|
| 1930 | as->userbuffer = uurb->buffer; | 
|---|
| 1931 | as->signr = uurb->signr; | 
|---|
| 1932 | as->ifnum = ifnum; | 
|---|
| 1933 | as->pid = get_pid(pid: task_pid(current)); | 
|---|
| 1934 | as->cred = get_current_cred(); | 
|---|
| 1935 | snoop_urb(udev: ps->dev, userurb: as->userurb, pipe: as->urb->pipe, | 
|---|
| 1936 | length: as->urb->transfer_buffer_length, timeout_or_status: 0, when: SUBMIT, | 
|---|
| 1937 | NULL, data_len: 0); | 
|---|
| 1938 | if (!is_in) | 
|---|
| 1939 | snoop_urb_data(urb: as->urb, len: as->urb->transfer_buffer_length); | 
|---|
| 1940 |  | 
|---|
| 1941 | async_newpending(as); | 
|---|
| 1942 |  | 
|---|
| 1943 | if (usb_endpoint_xfer_bulk(epd: &ep->desc)) { | 
|---|
| 1944 | spin_lock_irq(lock: &ps->lock); | 
|---|
| 1945 |  | 
|---|
| 1946 | /* Not exactly the endpoint address; the direction bit is | 
|---|
| 1947 | * shifted to the 0x10 position so that the value will be | 
|---|
| 1948 | * between 0 and 31. | 
|---|
| 1949 | */ | 
|---|
| 1950 | as->bulk_addr = usb_endpoint_num(epd: &ep->desc) | | 
|---|
| 1951 | ((ep->desc.bEndpointAddress & USB_ENDPOINT_DIR_MASK) | 
|---|
| 1952 | >> 3); | 
|---|
| 1953 |  | 
|---|
| 1954 | /* If this bulk URB is the start of a new transfer, re-enable | 
|---|
| 1955 | * the endpoint.  Otherwise mark it as a continuation URB. | 
|---|
| 1956 | */ | 
|---|
| 1957 | if (uurb->flags & USBDEVFS_URB_BULK_CONTINUATION) | 
|---|
| 1958 | as->bulk_status = AS_CONTINUATION; | 
|---|
| 1959 | else | 
|---|
| 1960 | ps->disabled_bulk_eps &= ~(1 << as->bulk_addr); | 
|---|
| 1961 |  | 
|---|
| 1962 | /* Don't accept continuation URBs if the endpoint is | 
|---|
| 1963 | * disabled because of an earlier error. | 
|---|
| 1964 | */ | 
|---|
| 1965 | if (ps->disabled_bulk_eps & (1 << as->bulk_addr)) | 
|---|
| 1966 | ret = -EREMOTEIO; | 
|---|
| 1967 | else | 
|---|
| 1968 | ret = usb_submit_urb(urb: as->urb, GFP_ATOMIC); | 
|---|
| 1969 | spin_unlock_irq(lock: &ps->lock); | 
|---|
| 1970 | } else { | 
|---|
| 1971 | ret = usb_submit_urb(urb: as->urb, GFP_KERNEL); | 
|---|
| 1972 | } | 
|---|
| 1973 |  | 
|---|
| 1974 | if (ret) { | 
|---|
| 1975 | dev_printk(KERN_DEBUG, &ps->dev->dev, | 
|---|
| 1976 | "usbfs: usb_submit_urb returned %d\n", ret); | 
|---|
| 1977 | snoop_urb(udev: ps->dev, userurb: as->userurb, pipe: as->urb->pipe, | 
|---|
| 1978 | length: 0, timeout_or_status: ret, when: COMPLETE, NULL, data_len: 0); | 
|---|
| 1979 | async_removepending(as); | 
|---|
| 1980 | goto error; | 
|---|
| 1981 | } | 
|---|
| 1982 | return 0; | 
|---|
| 1983 |  | 
|---|
| 1984 | error: | 
|---|
| 1985 | kfree(objp: isopkt); | 
|---|
| 1986 | kfree(objp: dr); | 
|---|
| 1987 | if (as) | 
|---|
| 1988 | free_async(as); | 
|---|
| 1989 | return ret; | 
|---|
| 1990 | } | 
|---|
| 1991 |  | 
|---|
| 1992 | static int proc_submiturb(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 1993 | { | 
|---|
| 1994 | struct usbdevfs_urb uurb; | 
|---|
| 1995 | sigval_t userurb_sigval; | 
|---|
| 1996 |  | 
|---|
| 1997 | if (copy_from_user(to: &uurb, from: arg, n: sizeof(uurb))) | 
|---|
| 1998 | return -EFAULT; | 
|---|
| 1999 |  | 
|---|
| 2000 | memset(s: &userurb_sigval, c: 0, n: sizeof(userurb_sigval)); | 
|---|
| 2001 | userurb_sigval.sival_ptr = arg; | 
|---|
| 2002 |  | 
|---|
| 2003 | return proc_do_submiturb(ps, uurb: &uurb, | 
|---|
| 2004 | iso_frame_desc: (((struct usbdevfs_urb __user *)arg)->iso_frame_desc), | 
|---|
| 2005 | arg, userurb_sigval); | 
|---|
| 2006 | } | 
|---|
| 2007 |  | 
|---|
| 2008 | static int proc_unlinkurb(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2009 | { | 
|---|
| 2010 | struct urb *urb; | 
|---|
| 2011 | struct async *as; | 
|---|
| 2012 | unsigned long flags; | 
|---|
| 2013 |  | 
|---|
| 2014 | spin_lock_irqsave(&ps->lock, flags); | 
|---|
| 2015 | as = async_getpending(ps, userurb: arg); | 
|---|
| 2016 | if (!as) { | 
|---|
| 2017 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 2018 | return -EINVAL; | 
|---|
| 2019 | } | 
|---|
| 2020 |  | 
|---|
| 2021 | urb = as->urb; | 
|---|
| 2022 | usb_get_urb(urb); | 
|---|
| 2023 | spin_unlock_irqrestore(lock: &ps->lock, flags); | 
|---|
| 2024 |  | 
|---|
| 2025 | usb_kill_urb(urb); | 
|---|
| 2026 | usb_put_urb(urb); | 
|---|
| 2027 |  | 
|---|
| 2028 | return 0; | 
|---|
| 2029 | } | 
|---|
| 2030 |  | 
|---|
| 2031 | static void compute_isochronous_actual_length(struct urb *urb) | 
|---|
| 2032 | { | 
|---|
| 2033 | unsigned int i; | 
|---|
| 2034 |  | 
|---|
| 2035 | if (urb->number_of_packets > 0) { | 
|---|
| 2036 | urb->actual_length = 0; | 
|---|
| 2037 | for (i = 0; i < urb->number_of_packets; i++) | 
|---|
| 2038 | urb->actual_length += | 
|---|
| 2039 | urb->iso_frame_desc[i].actual_length; | 
|---|
| 2040 | } | 
|---|
| 2041 | } | 
|---|
| 2042 |  | 
|---|
| 2043 | static int processcompl(struct async *as, void __user * __user *arg) | 
|---|
| 2044 | { | 
|---|
| 2045 | struct urb *urb = as->urb; | 
|---|
| 2046 | struct usbdevfs_urb __user *userurb = as->userurb; | 
|---|
| 2047 | void __user *addr = as->userurb; | 
|---|
| 2048 | unsigned int i; | 
|---|
| 2049 |  | 
|---|
| 2050 | compute_isochronous_actual_length(urb); | 
|---|
| 2051 | if (as->userbuffer && urb->actual_length) { | 
|---|
| 2052 | if (copy_urb_data_to_user(userbuffer: as->userbuffer, urb)) | 
|---|
| 2053 | goto err_out; | 
|---|
| 2054 | } | 
|---|
| 2055 | if (put_user(as->status, &userurb->status)) | 
|---|
| 2056 | goto err_out; | 
|---|
| 2057 | if (put_user(urb->actual_length, &userurb->actual_length)) | 
|---|
| 2058 | goto err_out; | 
|---|
| 2059 | if (put_user(urb->error_count, &userurb->error_count)) | 
|---|
| 2060 | goto err_out; | 
|---|
| 2061 |  | 
|---|
| 2062 | if (usb_endpoint_xfer_isoc(epd: &urb->ep->desc)) { | 
|---|
| 2063 | for (i = 0; i < urb->number_of_packets; i++) { | 
|---|
| 2064 | if (put_user(urb->iso_frame_desc[i].actual_length, | 
|---|
| 2065 | &userurb->iso_frame_desc[i].actual_length)) | 
|---|
| 2066 | goto err_out; | 
|---|
| 2067 | if (put_user(urb->iso_frame_desc[i].status, | 
|---|
| 2068 | &userurb->iso_frame_desc[i].status)) | 
|---|
| 2069 | goto err_out; | 
|---|
| 2070 | } | 
|---|
| 2071 | } | 
|---|
| 2072 |  | 
|---|
| 2073 | if (put_user(addr, (void __user * __user *)arg)) | 
|---|
| 2074 | return -EFAULT; | 
|---|
| 2075 | return 0; | 
|---|
| 2076 |  | 
|---|
| 2077 | err_out: | 
|---|
| 2078 | return -EFAULT; | 
|---|
| 2079 | } | 
|---|
| 2080 |  | 
|---|
| 2081 | static struct async *reap_as(struct usb_dev_state *ps) | 
|---|
| 2082 | { | 
|---|
| 2083 | DECLARE_WAITQUEUE(wait, current); | 
|---|
| 2084 | struct async *as = NULL; | 
|---|
| 2085 | struct usb_device *dev = ps->dev; | 
|---|
| 2086 |  | 
|---|
| 2087 | add_wait_queue(wq_head: &ps->wait, wq_entry: &wait); | 
|---|
| 2088 | for (;;) { | 
|---|
| 2089 | __set_current_state(TASK_INTERRUPTIBLE); | 
|---|
| 2090 | as = async_getcompleted(ps); | 
|---|
| 2091 | if (as || !connected(ps)) | 
|---|
| 2092 | break; | 
|---|
| 2093 | if (signal_pending(current)) | 
|---|
| 2094 | break; | 
|---|
| 2095 | usb_unlock_device(dev); | 
|---|
| 2096 | schedule(); | 
|---|
| 2097 | usb_lock_device(dev); | 
|---|
| 2098 | } | 
|---|
| 2099 | remove_wait_queue(wq_head: &ps->wait, wq_entry: &wait); | 
|---|
| 2100 | set_current_state(TASK_RUNNING); | 
|---|
| 2101 | return as; | 
|---|
| 2102 | } | 
|---|
| 2103 |  | 
|---|
| 2104 | static int proc_reapurb(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2105 | { | 
|---|
| 2106 | struct async *as = reap_as(ps); | 
|---|
| 2107 |  | 
|---|
| 2108 | if (as) { | 
|---|
| 2109 | int retval; | 
|---|
| 2110 |  | 
|---|
| 2111 | snoop(&ps->dev->dev, "reap %px\n", as->userurb); | 
|---|
| 2112 | retval = processcompl(as, arg: (void __user * __user *)arg); | 
|---|
| 2113 | free_async(as); | 
|---|
| 2114 | return retval; | 
|---|
| 2115 | } | 
|---|
| 2116 | if (signal_pending(current)) | 
|---|
| 2117 | return -EINTR; | 
|---|
| 2118 | return -ENODEV; | 
|---|
| 2119 | } | 
|---|
| 2120 |  | 
|---|
| 2121 | static int proc_reapurbnonblock(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2122 | { | 
|---|
| 2123 | int retval; | 
|---|
| 2124 | struct async *as; | 
|---|
| 2125 |  | 
|---|
| 2126 | as = async_getcompleted(ps); | 
|---|
| 2127 | if (as) { | 
|---|
| 2128 | snoop(&ps->dev->dev, "reap %px\n", as->userurb); | 
|---|
| 2129 | retval = processcompl(as, arg: (void __user * __user *)arg); | 
|---|
| 2130 | free_async(as); | 
|---|
| 2131 | } else { | 
|---|
| 2132 | retval = (connected(ps) ? -EAGAIN : -ENODEV); | 
|---|
| 2133 | } | 
|---|
| 2134 | return retval; | 
|---|
| 2135 | } | 
|---|
| 2136 |  | 
|---|
| 2137 | #ifdef CONFIG_COMPAT | 
|---|
| 2138 | static int proc_control_compat(struct usb_dev_state *ps, | 
|---|
| 2139 | struct usbdevfs_ctrltransfer32 __user *p32) | 
|---|
| 2140 | { | 
|---|
| 2141 | struct usbdevfs_ctrltransfer ctrl; | 
|---|
| 2142 | u32 udata; | 
|---|
| 2143 |  | 
|---|
| 2144 | if (copy_from_user(to: &ctrl, from: p32, n: sizeof(*p32) - sizeof(compat_caddr_t)) || | 
|---|
| 2145 | get_user(udata, &p32->data)) | 
|---|
| 2146 | return -EFAULT; | 
|---|
| 2147 | ctrl.data = compat_ptr(uptr: udata); | 
|---|
| 2148 | return do_proc_control(ps, ctrl: &ctrl); | 
|---|
| 2149 | } | 
|---|
| 2150 |  | 
|---|
| 2151 | static int proc_bulk_compat(struct usb_dev_state *ps, | 
|---|
| 2152 | struct usbdevfs_bulktransfer32 __user *p32) | 
|---|
| 2153 | { | 
|---|
| 2154 | struct usbdevfs_bulktransfer bulk; | 
|---|
| 2155 | compat_caddr_t addr; | 
|---|
| 2156 |  | 
|---|
| 2157 | if (get_user(bulk.ep, &p32->ep) || | 
|---|
| 2158 | get_user(bulk.len, &p32->len) || | 
|---|
| 2159 | get_user(bulk.timeout, &p32->timeout) || | 
|---|
| 2160 | get_user(addr, &p32->data)) | 
|---|
| 2161 | return -EFAULT; | 
|---|
| 2162 | bulk.data = compat_ptr(uptr: addr); | 
|---|
| 2163 | return do_proc_bulk(ps, bulk: &bulk); | 
|---|
| 2164 | } | 
|---|
| 2165 |  | 
|---|
| 2166 | static int proc_disconnectsignal_compat(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2167 | { | 
|---|
| 2168 | struct usbdevfs_disconnectsignal32 ds; | 
|---|
| 2169 |  | 
|---|
| 2170 | if (copy_from_user(to: &ds, from: arg, n: sizeof(ds))) | 
|---|
| 2171 | return -EFAULT; | 
|---|
| 2172 | ps->discsignr = ds.signr; | 
|---|
| 2173 | ps->disccontext.sival_int = ds.context; | 
|---|
| 2174 | return 0; | 
|---|
| 2175 | } | 
|---|
| 2176 |  | 
|---|
| 2177 | static int get_urb32(struct usbdevfs_urb *kurb, | 
|---|
| 2178 | struct usbdevfs_urb32 __user *uurb) | 
|---|
| 2179 | { | 
|---|
| 2180 | struct usbdevfs_urb32 urb32; | 
|---|
| 2181 | if (copy_from_user(to: &urb32, from: uurb, n: sizeof(*uurb))) | 
|---|
| 2182 | return -EFAULT; | 
|---|
| 2183 | kurb->type = urb32.type; | 
|---|
| 2184 | kurb->endpoint = urb32.endpoint; | 
|---|
| 2185 | kurb->status = urb32.status; | 
|---|
| 2186 | kurb->flags = urb32.flags; | 
|---|
| 2187 | kurb->buffer = compat_ptr(uptr: urb32.buffer); | 
|---|
| 2188 | kurb->buffer_length = urb32.buffer_length; | 
|---|
| 2189 | kurb->actual_length = urb32.actual_length; | 
|---|
| 2190 | kurb->start_frame = urb32.start_frame; | 
|---|
| 2191 | kurb->number_of_packets = urb32.number_of_packets; | 
|---|
| 2192 | kurb->error_count = urb32.error_count; | 
|---|
| 2193 | kurb->signr = urb32.signr; | 
|---|
| 2194 | kurb->usercontext = compat_ptr(uptr: urb32.usercontext); | 
|---|
| 2195 | return 0; | 
|---|
| 2196 | } | 
|---|
| 2197 |  | 
|---|
| 2198 | static int proc_submiturb_compat(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2199 | { | 
|---|
| 2200 | struct usbdevfs_urb uurb; | 
|---|
| 2201 | sigval_t userurb_sigval; | 
|---|
| 2202 |  | 
|---|
| 2203 | if (get_urb32(kurb: &uurb, uurb: (struct usbdevfs_urb32 __user *)arg)) | 
|---|
| 2204 | return -EFAULT; | 
|---|
| 2205 |  | 
|---|
| 2206 | memset(s: &userurb_sigval, c: 0, n: sizeof(userurb_sigval)); | 
|---|
| 2207 | userurb_sigval.sival_int = ptr_to_compat(uptr: arg); | 
|---|
| 2208 |  | 
|---|
| 2209 | return proc_do_submiturb(ps, uurb: &uurb, | 
|---|
| 2210 | iso_frame_desc: ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc, | 
|---|
| 2211 | arg, userurb_sigval); | 
|---|
| 2212 | } | 
|---|
| 2213 |  | 
|---|
| 2214 | static int processcompl_compat(struct async *as, void __user * __user *arg) | 
|---|
| 2215 | { | 
|---|
| 2216 | struct urb *urb = as->urb; | 
|---|
| 2217 | struct usbdevfs_urb32 __user *userurb = as->userurb; | 
|---|
| 2218 | void __user *addr = as->userurb; | 
|---|
| 2219 | unsigned int i; | 
|---|
| 2220 |  | 
|---|
| 2221 | compute_isochronous_actual_length(urb); | 
|---|
| 2222 | if (as->userbuffer && urb->actual_length) { | 
|---|
| 2223 | if (copy_urb_data_to_user(userbuffer: as->userbuffer, urb)) | 
|---|
| 2224 | return -EFAULT; | 
|---|
| 2225 | } | 
|---|
| 2226 | if (put_user(as->status, &userurb->status)) | 
|---|
| 2227 | return -EFAULT; | 
|---|
| 2228 | if (put_user(urb->actual_length, &userurb->actual_length)) | 
|---|
| 2229 | return -EFAULT; | 
|---|
| 2230 | if (put_user(urb->error_count, &userurb->error_count)) | 
|---|
| 2231 | return -EFAULT; | 
|---|
| 2232 |  | 
|---|
| 2233 | if (usb_endpoint_xfer_isoc(epd: &urb->ep->desc)) { | 
|---|
| 2234 | for (i = 0; i < urb->number_of_packets; i++) { | 
|---|
| 2235 | if (put_user(urb->iso_frame_desc[i].actual_length, | 
|---|
| 2236 | &userurb->iso_frame_desc[i].actual_length)) | 
|---|
| 2237 | return -EFAULT; | 
|---|
| 2238 | if (put_user(urb->iso_frame_desc[i].status, | 
|---|
| 2239 | &userurb->iso_frame_desc[i].status)) | 
|---|
| 2240 | return -EFAULT; | 
|---|
| 2241 | } | 
|---|
| 2242 | } | 
|---|
| 2243 |  | 
|---|
| 2244 | if (put_user(ptr_to_compat(addr), (u32 __user *)arg)) | 
|---|
| 2245 | return -EFAULT; | 
|---|
| 2246 | return 0; | 
|---|
| 2247 | } | 
|---|
| 2248 |  | 
|---|
| 2249 | static int proc_reapurb_compat(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2250 | { | 
|---|
| 2251 | struct async *as = reap_as(ps); | 
|---|
| 2252 |  | 
|---|
| 2253 | if (as) { | 
|---|
| 2254 | int retval; | 
|---|
| 2255 |  | 
|---|
| 2256 | snoop(&ps->dev->dev, "reap %px\n", as->userurb); | 
|---|
| 2257 | retval = processcompl_compat(as, arg: (void __user * __user *)arg); | 
|---|
| 2258 | free_async(as); | 
|---|
| 2259 | return retval; | 
|---|
| 2260 | } | 
|---|
| 2261 | if (signal_pending(current)) | 
|---|
| 2262 | return -EINTR; | 
|---|
| 2263 | return -ENODEV; | 
|---|
| 2264 | } | 
|---|
| 2265 |  | 
|---|
| 2266 | static int proc_reapurbnonblock_compat(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2267 | { | 
|---|
| 2268 | int retval; | 
|---|
| 2269 | struct async *as; | 
|---|
| 2270 |  | 
|---|
| 2271 | as = async_getcompleted(ps); | 
|---|
| 2272 | if (as) { | 
|---|
| 2273 | snoop(&ps->dev->dev, "reap %px\n", as->userurb); | 
|---|
| 2274 | retval = processcompl_compat(as, arg: (void __user * __user *)arg); | 
|---|
| 2275 | free_async(as); | 
|---|
| 2276 | } else { | 
|---|
| 2277 | retval = (connected(ps) ? -EAGAIN : -ENODEV); | 
|---|
| 2278 | } | 
|---|
| 2279 | return retval; | 
|---|
| 2280 | } | 
|---|
| 2281 |  | 
|---|
| 2282 |  | 
|---|
| 2283 | #endif | 
|---|
| 2284 |  | 
|---|
| 2285 | static int proc_disconnectsignal(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2286 | { | 
|---|
| 2287 | struct usbdevfs_disconnectsignal ds; | 
|---|
| 2288 |  | 
|---|
| 2289 | if (copy_from_user(to: &ds, from: arg, n: sizeof(ds))) | 
|---|
| 2290 | return -EFAULT; | 
|---|
| 2291 | ps->discsignr = ds.signr; | 
|---|
| 2292 | ps->disccontext.sival_ptr = ds.context; | 
|---|
| 2293 | return 0; | 
|---|
| 2294 | } | 
|---|
| 2295 |  | 
|---|
| 2296 | static int proc_claiminterface(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2297 | { | 
|---|
| 2298 | unsigned int ifnum; | 
|---|
| 2299 |  | 
|---|
| 2300 | if (get_user(ifnum, (unsigned int __user *)arg)) | 
|---|
| 2301 | return -EFAULT; | 
|---|
| 2302 | return claimintf(ps, ifnum); | 
|---|
| 2303 | } | 
|---|
| 2304 |  | 
|---|
| 2305 | static int proc_releaseinterface(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2306 | { | 
|---|
| 2307 | unsigned int ifnum; | 
|---|
| 2308 | int ret; | 
|---|
| 2309 |  | 
|---|
| 2310 | if (get_user(ifnum, (unsigned int __user *)arg)) | 
|---|
| 2311 | return -EFAULT; | 
|---|
| 2312 | ret = releaseintf(ps, ifnum); | 
|---|
| 2313 | if (ret < 0) | 
|---|
| 2314 | return ret; | 
|---|
| 2315 | destroy_async_on_interface(ps, ifnum); | 
|---|
| 2316 | return 0; | 
|---|
| 2317 | } | 
|---|
| 2318 |  | 
|---|
| 2319 | static int proc_ioctl(struct usb_dev_state *ps, struct usbdevfs_ioctl *ctl) | 
|---|
| 2320 | { | 
|---|
| 2321 | int			size; | 
|---|
| 2322 | void			*buf = NULL; | 
|---|
| 2323 | int			retval = 0; | 
|---|
| 2324 | struct usb_interface    *intf = NULL; | 
|---|
| 2325 | struct usb_driver       *driver = NULL; | 
|---|
| 2326 |  | 
|---|
| 2327 | if (ps->privileges_dropped) | 
|---|
| 2328 | return -EACCES; | 
|---|
| 2329 |  | 
|---|
| 2330 | if (!connected(ps)) | 
|---|
| 2331 | return -ENODEV; | 
|---|
| 2332 |  | 
|---|
| 2333 | /* alloc buffer */ | 
|---|
| 2334 | size = _IOC_SIZE(ctl->ioctl_code); | 
|---|
| 2335 | if (size > 0) { | 
|---|
| 2336 | buf = kmalloc(size, GFP_KERNEL); | 
|---|
| 2337 | if (buf == NULL) | 
|---|
| 2338 | return -ENOMEM; | 
|---|
| 2339 | if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) { | 
|---|
| 2340 | if (copy_from_user(to: buf, from: ctl->data, n: size)) { | 
|---|
| 2341 | kfree(objp: buf); | 
|---|
| 2342 | return -EFAULT; | 
|---|
| 2343 | } | 
|---|
| 2344 | } else { | 
|---|
| 2345 | memset(s: buf, c: 0, n: size); | 
|---|
| 2346 | } | 
|---|
| 2347 | } | 
|---|
| 2348 |  | 
|---|
| 2349 | if (ps->dev->state != USB_STATE_CONFIGURED) | 
|---|
| 2350 | retval = -EHOSTUNREACH; | 
|---|
| 2351 | else if (!(intf = usb_ifnum_to_if(dev: ps->dev, ifnum: ctl->ifno))) | 
|---|
| 2352 | retval = -EINVAL; | 
|---|
| 2353 | else switch (ctl->ioctl_code) { | 
|---|
| 2354 |  | 
|---|
| 2355 | /* disconnect kernel driver from interface */ | 
|---|
| 2356 | case USBDEVFS_DISCONNECT: | 
|---|
| 2357 | if (intf->dev.driver) { | 
|---|
| 2358 | driver = to_usb_driver(intf->dev.driver); | 
|---|
| 2359 | dev_dbg(&intf->dev, "disconnect by usbfs\n"); | 
|---|
| 2360 | usb_driver_release_interface(driver, iface: intf); | 
|---|
| 2361 | } else | 
|---|
| 2362 | retval = -ENODATA; | 
|---|
| 2363 | break; | 
|---|
| 2364 |  | 
|---|
| 2365 | /* let kernel drivers try to (re)bind to the interface */ | 
|---|
| 2366 | case USBDEVFS_CONNECT: | 
|---|
| 2367 | if (!intf->dev.driver) | 
|---|
| 2368 | retval = device_attach(dev: &intf->dev); | 
|---|
| 2369 | else | 
|---|
| 2370 | retval = -EBUSY; | 
|---|
| 2371 | break; | 
|---|
| 2372 |  | 
|---|
| 2373 | /* talk directly to the interface's driver */ | 
|---|
| 2374 | default: | 
|---|
| 2375 | if (intf->dev.driver) | 
|---|
| 2376 | driver = to_usb_driver(intf->dev.driver); | 
|---|
| 2377 | if (driver == NULL || driver->unlocked_ioctl == NULL) { | 
|---|
| 2378 | retval = -ENOTTY; | 
|---|
| 2379 | } else { | 
|---|
| 2380 | retval = driver->unlocked_ioctl(intf, ctl->ioctl_code, buf); | 
|---|
| 2381 | if (retval == -ENOIOCTLCMD) | 
|---|
| 2382 | retval = -ENOTTY; | 
|---|
| 2383 | } | 
|---|
| 2384 | } | 
|---|
| 2385 |  | 
|---|
| 2386 | /* cleanup and return */ | 
|---|
| 2387 | if (retval >= 0 | 
|---|
| 2388 | && (_IOC_DIR(ctl->ioctl_code) & _IOC_READ) != 0 | 
|---|
| 2389 | && size > 0 | 
|---|
| 2390 | && copy_to_user(to: ctl->data, from: buf, n: size) != 0) | 
|---|
| 2391 | retval = -EFAULT; | 
|---|
| 2392 |  | 
|---|
| 2393 | kfree(objp: buf); | 
|---|
| 2394 | return retval; | 
|---|
| 2395 | } | 
|---|
| 2396 |  | 
|---|
| 2397 | static int proc_ioctl_default(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2398 | { | 
|---|
| 2399 | struct usbdevfs_ioctl	ctrl; | 
|---|
| 2400 |  | 
|---|
| 2401 | if (copy_from_user(to: &ctrl, from: arg, n: sizeof(ctrl))) | 
|---|
| 2402 | return -EFAULT; | 
|---|
| 2403 | return proc_ioctl(ps, ctl: &ctrl); | 
|---|
| 2404 | } | 
|---|
| 2405 |  | 
|---|
| 2406 | #ifdef CONFIG_COMPAT | 
|---|
| 2407 | static int proc_ioctl_compat(struct usb_dev_state *ps, compat_uptr_t arg) | 
|---|
| 2408 | { | 
|---|
| 2409 | struct usbdevfs_ioctl32 ioc32; | 
|---|
| 2410 | struct usbdevfs_ioctl ctrl; | 
|---|
| 2411 |  | 
|---|
| 2412 | if (copy_from_user(to: &ioc32, from: compat_ptr(uptr: arg), n: sizeof(ioc32))) | 
|---|
| 2413 | return -EFAULT; | 
|---|
| 2414 | ctrl.ifno = ioc32.ifno; | 
|---|
| 2415 | ctrl.ioctl_code = ioc32.ioctl_code; | 
|---|
| 2416 | ctrl.data = compat_ptr(uptr: ioc32.data); | 
|---|
| 2417 | return proc_ioctl(ps, ctl: &ctrl); | 
|---|
| 2418 | } | 
|---|
| 2419 | #endif | 
|---|
| 2420 |  | 
|---|
| 2421 | static int proc_claim_port(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2422 | { | 
|---|
| 2423 | unsigned portnum; | 
|---|
| 2424 | int rc; | 
|---|
| 2425 |  | 
|---|
| 2426 | if (get_user(portnum, (unsigned __user *) arg)) | 
|---|
| 2427 | return -EFAULT; | 
|---|
| 2428 | rc = usb_hub_claim_port(hdev: ps->dev, port1: portnum, owner: ps); | 
|---|
| 2429 | if (rc == 0) | 
|---|
| 2430 | snoop(&ps->dev->dev, "port %d claimed by process %d: %s\n", | 
|---|
| 2431 | portnum, task_pid_nr(current), current->comm); | 
|---|
| 2432 | return rc; | 
|---|
| 2433 | } | 
|---|
| 2434 |  | 
|---|
| 2435 | static int proc_release_port(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2436 | { | 
|---|
| 2437 | unsigned portnum; | 
|---|
| 2438 |  | 
|---|
| 2439 | if (get_user(portnum, (unsigned __user *) arg)) | 
|---|
| 2440 | return -EFAULT; | 
|---|
| 2441 | return usb_hub_release_port(hdev: ps->dev, port1: portnum, owner: ps); | 
|---|
| 2442 | } | 
|---|
| 2443 |  | 
|---|
| 2444 | static int proc_get_capabilities(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2445 | { | 
|---|
| 2446 | __u32 caps; | 
|---|
| 2447 |  | 
|---|
| 2448 | caps = USBDEVFS_CAP_ZERO_PACKET | USBDEVFS_CAP_NO_PACKET_SIZE_LIM | | 
|---|
| 2449 | USBDEVFS_CAP_REAP_AFTER_DISCONNECT | USBDEVFS_CAP_MMAP | | 
|---|
| 2450 | USBDEVFS_CAP_DROP_PRIVILEGES | | 
|---|
| 2451 | USBDEVFS_CAP_CONNINFO_EX | MAYBE_CAP_SUSPEND; | 
|---|
| 2452 | if (!ps->dev->bus->no_stop_on_short) | 
|---|
| 2453 | caps |= USBDEVFS_CAP_BULK_CONTINUATION; | 
|---|
| 2454 | if (ps->dev->bus->sg_tablesize) | 
|---|
| 2455 | caps |= USBDEVFS_CAP_BULK_SCATTER_GATHER; | 
|---|
| 2456 |  | 
|---|
| 2457 | if (put_user(caps, (__u32 __user *)arg)) | 
|---|
| 2458 | return -EFAULT; | 
|---|
| 2459 |  | 
|---|
| 2460 | return 0; | 
|---|
| 2461 | } | 
|---|
| 2462 |  | 
|---|
| 2463 | static int proc_disconnect_claim(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2464 | { | 
|---|
| 2465 | struct usbdevfs_disconnect_claim dc; | 
|---|
| 2466 | struct usb_interface *intf; | 
|---|
| 2467 |  | 
|---|
| 2468 | if (copy_from_user(to: &dc, from: arg, n: sizeof(dc))) | 
|---|
| 2469 | return -EFAULT; | 
|---|
| 2470 |  | 
|---|
| 2471 | intf = usb_ifnum_to_if(dev: ps->dev, ifnum: dc.interface); | 
|---|
| 2472 | if (!intf) | 
|---|
| 2473 | return -EINVAL; | 
|---|
| 2474 |  | 
|---|
| 2475 | if (intf->dev.driver) { | 
|---|
| 2476 | struct usb_driver *driver = to_usb_driver(intf->dev.driver); | 
|---|
| 2477 |  | 
|---|
| 2478 | if (ps->privileges_dropped) | 
|---|
| 2479 | return -EACCES; | 
|---|
| 2480 |  | 
|---|
| 2481 | if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_IF_DRIVER) && | 
|---|
| 2482 | strncmp(dc.driver, intf->dev.driver->name, | 
|---|
| 2483 | sizeof(dc.driver)) != 0) | 
|---|
| 2484 | return -EBUSY; | 
|---|
| 2485 |  | 
|---|
| 2486 | if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_EXCEPT_DRIVER) && | 
|---|
| 2487 | strncmp(dc.driver, intf->dev.driver->name, | 
|---|
| 2488 | sizeof(dc.driver)) == 0) | 
|---|
| 2489 | return -EBUSY; | 
|---|
| 2490 |  | 
|---|
| 2491 | dev_dbg(&intf->dev, "disconnect by usbfs\n"); | 
|---|
| 2492 | usb_driver_release_interface(driver, iface: intf); | 
|---|
| 2493 | } | 
|---|
| 2494 |  | 
|---|
| 2495 | return claimintf(ps, ifnum: dc.interface); | 
|---|
| 2496 | } | 
|---|
| 2497 |  | 
|---|
| 2498 | static int proc_alloc_streams(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2499 | { | 
|---|
| 2500 | unsigned num_streams, num_eps; | 
|---|
| 2501 | struct usb_host_endpoint **eps; | 
|---|
| 2502 | struct usb_interface *intf; | 
|---|
| 2503 | int r; | 
|---|
| 2504 |  | 
|---|
| 2505 | r = parse_usbdevfs_streams(ps, streams: arg, num_streams_ret: &num_streams, num_eps_ret: &num_eps, | 
|---|
| 2506 | eps_ret: &eps, intf_ret: &intf); | 
|---|
| 2507 | if (r) | 
|---|
| 2508 | return r; | 
|---|
| 2509 |  | 
|---|
| 2510 | destroy_async_on_interface(ps, | 
|---|
| 2511 | ifnum: intf->altsetting[0].desc.bInterfaceNumber); | 
|---|
| 2512 |  | 
|---|
| 2513 | r = usb_alloc_streams(interface: intf, eps, num_eps, num_streams, GFP_KERNEL); | 
|---|
| 2514 | kfree(objp: eps); | 
|---|
| 2515 | return r; | 
|---|
| 2516 | } | 
|---|
| 2517 |  | 
|---|
| 2518 | static int proc_free_streams(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2519 | { | 
|---|
| 2520 | unsigned num_eps; | 
|---|
| 2521 | struct usb_host_endpoint **eps; | 
|---|
| 2522 | struct usb_interface *intf; | 
|---|
| 2523 | int r; | 
|---|
| 2524 |  | 
|---|
| 2525 | r = parse_usbdevfs_streams(ps, streams: arg, NULL, num_eps_ret: &num_eps, eps_ret: &eps, intf_ret: &intf); | 
|---|
| 2526 | if (r) | 
|---|
| 2527 | return r; | 
|---|
| 2528 |  | 
|---|
| 2529 | destroy_async_on_interface(ps, | 
|---|
| 2530 | ifnum: intf->altsetting[0].desc.bInterfaceNumber); | 
|---|
| 2531 |  | 
|---|
| 2532 | r = usb_free_streams(interface: intf, eps, num_eps, GFP_KERNEL); | 
|---|
| 2533 | kfree(objp: eps); | 
|---|
| 2534 | return r; | 
|---|
| 2535 | } | 
|---|
| 2536 |  | 
|---|
| 2537 | static int proc_drop_privileges(struct usb_dev_state *ps, void __user *arg) | 
|---|
| 2538 | { | 
|---|
| 2539 | u32 data; | 
|---|
| 2540 |  | 
|---|
| 2541 | if (copy_from_user(to: &data, from: arg, n: sizeof(data))) | 
|---|
| 2542 | return -EFAULT; | 
|---|
| 2543 |  | 
|---|
| 2544 | /* This is a one way operation. Once privileges are | 
|---|
| 2545 | * dropped, you cannot regain them. You may however reissue | 
|---|
| 2546 | * this ioctl to shrink the allowed interfaces mask. | 
|---|
| 2547 | */ | 
|---|
| 2548 | ps->interface_allowed_mask &= data; | 
|---|
| 2549 | ps->privileges_dropped = true; | 
|---|
| 2550 |  | 
|---|
| 2551 | return 0; | 
|---|
| 2552 | } | 
|---|
| 2553 |  | 
|---|
| 2554 | static int proc_forbid_suspend(struct usb_dev_state *ps) | 
|---|
| 2555 | { | 
|---|
| 2556 | int ret = 0; | 
|---|
| 2557 |  | 
|---|
| 2558 | if (ps->suspend_allowed) { | 
|---|
| 2559 | ret = usb_autoresume_device(udev: ps->dev); | 
|---|
| 2560 | if (ret == 0) | 
|---|
| 2561 | ps->suspend_allowed = false; | 
|---|
| 2562 | else if (ret != -ENODEV) | 
|---|
| 2563 | ret = -EIO; | 
|---|
| 2564 | } | 
|---|
| 2565 | return ret; | 
|---|
| 2566 | } | 
|---|
| 2567 |  | 
|---|
| 2568 | static int proc_allow_suspend(struct usb_dev_state *ps) | 
|---|
| 2569 | { | 
|---|
| 2570 | if (!connected(ps)) | 
|---|
| 2571 | return -ENODEV; | 
|---|
| 2572 |  | 
|---|
| 2573 | WRITE_ONCE(ps->not_yet_resumed, 1); | 
|---|
| 2574 | if (!ps->suspend_allowed) { | 
|---|
| 2575 | usb_autosuspend_device(udev: ps->dev); | 
|---|
| 2576 | ps->suspend_allowed = true; | 
|---|
| 2577 | } | 
|---|
| 2578 | return 0; | 
|---|
| 2579 | } | 
|---|
| 2580 |  | 
|---|
| 2581 | static int proc_wait_for_resume(struct usb_dev_state *ps) | 
|---|
| 2582 | { | 
|---|
| 2583 | int ret; | 
|---|
| 2584 |  | 
|---|
| 2585 | usb_unlock_device(ps->dev); | 
|---|
| 2586 | ret = wait_event_interruptible(ps->wait_for_resume, | 
|---|
| 2587 | READ_ONCE(ps->not_yet_resumed) == 0); | 
|---|
| 2588 | usb_lock_device(ps->dev); | 
|---|
| 2589 |  | 
|---|
| 2590 | if (ret != 0) | 
|---|
| 2591 | return -EINTR; | 
|---|
| 2592 | return proc_forbid_suspend(ps); | 
|---|
| 2593 | } | 
|---|
| 2594 |  | 
|---|
| 2595 | /* | 
|---|
| 2596 | * NOTE:  All requests here that have interface numbers as parameters | 
|---|
| 2597 | * are assuming that somehow the configuration has been prevented from | 
|---|
| 2598 | * changing.  But there's no mechanism to ensure that... | 
|---|
| 2599 | */ | 
|---|
| 2600 | static long usbdev_do_ioctl(struct file *file, unsigned int cmd, | 
|---|
| 2601 | void __user *p) | 
|---|
| 2602 | { | 
|---|
| 2603 | struct usb_dev_state *ps = file->private_data; | 
|---|
| 2604 | struct inode *inode = file_inode(f: file); | 
|---|
| 2605 | struct usb_device *dev = ps->dev; | 
|---|
| 2606 | int ret = -ENOTTY; | 
|---|
| 2607 |  | 
|---|
| 2608 | if (!(file->f_mode & FMODE_WRITE)) | 
|---|
| 2609 | return -EPERM; | 
|---|
| 2610 |  | 
|---|
| 2611 | usb_lock_device(dev); | 
|---|
| 2612 |  | 
|---|
| 2613 | /* Reap operations are allowed even after disconnection */ | 
|---|
| 2614 | switch (cmd) { | 
|---|
| 2615 | case USBDEVFS_REAPURB: | 
|---|
| 2616 | snoop(&dev->dev, "%s: REAPURB\n", __func__); | 
|---|
| 2617 | ret = proc_reapurb(ps, arg: p); | 
|---|
| 2618 | goto done; | 
|---|
| 2619 |  | 
|---|
| 2620 | case USBDEVFS_REAPURBNDELAY: | 
|---|
| 2621 | snoop(&dev->dev, "%s: REAPURBNDELAY\n", __func__); | 
|---|
| 2622 | ret = proc_reapurbnonblock(ps, arg: p); | 
|---|
| 2623 | goto done; | 
|---|
| 2624 |  | 
|---|
| 2625 | #ifdef CONFIG_COMPAT | 
|---|
| 2626 | case USBDEVFS_REAPURB32: | 
|---|
| 2627 | snoop(&dev->dev, "%s: REAPURB32\n", __func__); | 
|---|
| 2628 | ret = proc_reapurb_compat(ps, arg: p); | 
|---|
| 2629 | goto done; | 
|---|
| 2630 |  | 
|---|
| 2631 | case USBDEVFS_REAPURBNDELAY32: | 
|---|
| 2632 | snoop(&dev->dev, "%s: REAPURBNDELAY32\n", __func__); | 
|---|
| 2633 | ret = proc_reapurbnonblock_compat(ps, arg: p); | 
|---|
| 2634 | goto done; | 
|---|
| 2635 | #endif | 
|---|
| 2636 | } | 
|---|
| 2637 |  | 
|---|
| 2638 | if (!connected(ps)) { | 
|---|
| 2639 | usb_unlock_device(dev); | 
|---|
| 2640 | return -ENODEV; | 
|---|
| 2641 | } | 
|---|
| 2642 |  | 
|---|
| 2643 | switch (cmd) { | 
|---|
| 2644 | case USBDEVFS_CONTROL: | 
|---|
| 2645 | snoop(&dev->dev, "%s: CONTROL\n", __func__); | 
|---|
| 2646 | ret = proc_control(ps, arg: p); | 
|---|
| 2647 | if (ret >= 0) | 
|---|
| 2648 | inode_set_mtime_to_ts(inode, | 
|---|
| 2649 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2650 | break; | 
|---|
| 2651 |  | 
|---|
| 2652 | case USBDEVFS_BULK: | 
|---|
| 2653 | snoop(&dev->dev, "%s: BULK\n", __func__); | 
|---|
| 2654 | ret = proc_bulk(ps, arg: p); | 
|---|
| 2655 | if (ret >= 0) | 
|---|
| 2656 | inode_set_mtime_to_ts(inode, | 
|---|
| 2657 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2658 | break; | 
|---|
| 2659 |  | 
|---|
| 2660 | case USBDEVFS_RESETEP: | 
|---|
| 2661 | snoop(&dev->dev, "%s: RESETEP\n", __func__); | 
|---|
| 2662 | ret = proc_resetep(ps, arg: p); | 
|---|
| 2663 | if (ret >= 0) | 
|---|
| 2664 | inode_set_mtime_to_ts(inode, | 
|---|
| 2665 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2666 | break; | 
|---|
| 2667 |  | 
|---|
| 2668 | case USBDEVFS_RESET: | 
|---|
| 2669 | snoop(&dev->dev, "%s: RESET\n", __func__); | 
|---|
| 2670 | ret = proc_resetdevice(ps); | 
|---|
| 2671 | break; | 
|---|
| 2672 |  | 
|---|
| 2673 | case USBDEVFS_CLEAR_HALT: | 
|---|
| 2674 | snoop(&dev->dev, "%s: CLEAR_HALT\n", __func__); | 
|---|
| 2675 | ret = proc_clearhalt(ps, arg: p); | 
|---|
| 2676 | if (ret >= 0) | 
|---|
| 2677 | inode_set_mtime_to_ts(inode, | 
|---|
| 2678 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2679 | break; | 
|---|
| 2680 |  | 
|---|
| 2681 | case USBDEVFS_GETDRIVER: | 
|---|
| 2682 | snoop(&dev->dev, "%s: GETDRIVER\n", __func__); | 
|---|
| 2683 | ret = proc_getdriver(ps, arg: p); | 
|---|
| 2684 | break; | 
|---|
| 2685 |  | 
|---|
| 2686 | case USBDEVFS_CONNECTINFO: | 
|---|
| 2687 | snoop(&dev->dev, "%s: CONNECTINFO\n", __func__); | 
|---|
| 2688 | ret = proc_connectinfo(ps, arg: p); | 
|---|
| 2689 | break; | 
|---|
| 2690 |  | 
|---|
| 2691 | case USBDEVFS_SETINTERFACE: | 
|---|
| 2692 | snoop(&dev->dev, "%s: SETINTERFACE\n", __func__); | 
|---|
| 2693 | ret = proc_setintf(ps, arg: p); | 
|---|
| 2694 | break; | 
|---|
| 2695 |  | 
|---|
| 2696 | case USBDEVFS_SETCONFIGURATION: | 
|---|
| 2697 | snoop(&dev->dev, "%s: SETCONFIGURATION\n", __func__); | 
|---|
| 2698 | ret = proc_setconfig(ps, arg: p); | 
|---|
| 2699 | break; | 
|---|
| 2700 |  | 
|---|
| 2701 | case USBDEVFS_SUBMITURB: | 
|---|
| 2702 | snoop(&dev->dev, "%s: SUBMITURB\n", __func__); | 
|---|
| 2703 | ret = proc_submiturb(ps, arg: p); | 
|---|
| 2704 | if (ret >= 0) | 
|---|
| 2705 | inode_set_mtime_to_ts(inode, | 
|---|
| 2706 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2707 | break; | 
|---|
| 2708 |  | 
|---|
| 2709 | #ifdef CONFIG_COMPAT | 
|---|
| 2710 | case USBDEVFS_CONTROL32: | 
|---|
| 2711 | snoop(&dev->dev, "%s: CONTROL32\n", __func__); | 
|---|
| 2712 | ret = proc_control_compat(ps, p32: p); | 
|---|
| 2713 | if (ret >= 0) | 
|---|
| 2714 | inode_set_mtime_to_ts(inode, | 
|---|
| 2715 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2716 | break; | 
|---|
| 2717 |  | 
|---|
| 2718 | case USBDEVFS_BULK32: | 
|---|
| 2719 | snoop(&dev->dev, "%s: BULK32\n", __func__); | 
|---|
| 2720 | ret = proc_bulk_compat(ps, p32: p); | 
|---|
| 2721 | if (ret >= 0) | 
|---|
| 2722 | inode_set_mtime_to_ts(inode, | 
|---|
| 2723 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2724 | break; | 
|---|
| 2725 |  | 
|---|
| 2726 | case USBDEVFS_DISCSIGNAL32: | 
|---|
| 2727 | snoop(&dev->dev, "%s: DISCSIGNAL32\n", __func__); | 
|---|
| 2728 | ret = proc_disconnectsignal_compat(ps, arg: p); | 
|---|
| 2729 | break; | 
|---|
| 2730 |  | 
|---|
| 2731 | case USBDEVFS_SUBMITURB32: | 
|---|
| 2732 | snoop(&dev->dev, "%s: SUBMITURB32\n", __func__); | 
|---|
| 2733 | ret = proc_submiturb_compat(ps, arg: p); | 
|---|
| 2734 | if (ret >= 0) | 
|---|
| 2735 | inode_set_mtime_to_ts(inode, | 
|---|
| 2736 | ts: inode_set_ctime_current(inode)); | 
|---|
| 2737 | break; | 
|---|
| 2738 |  | 
|---|
| 2739 | case USBDEVFS_IOCTL32: | 
|---|
| 2740 | snoop(&dev->dev, "%s: IOCTL32\n", __func__); | 
|---|
| 2741 | ret = proc_ioctl_compat(ps, arg: ptr_to_compat(uptr: p)); | 
|---|
| 2742 | break; | 
|---|
| 2743 | #endif | 
|---|
| 2744 |  | 
|---|
| 2745 | case USBDEVFS_DISCARDURB: | 
|---|
| 2746 | snoop(&dev->dev, "%s: DISCARDURB %px\n", __func__, p); | 
|---|
| 2747 | ret = proc_unlinkurb(ps, arg: p); | 
|---|
| 2748 | break; | 
|---|
| 2749 |  | 
|---|
| 2750 | case USBDEVFS_DISCSIGNAL: | 
|---|
| 2751 | snoop(&dev->dev, "%s: DISCSIGNAL\n", __func__); | 
|---|
| 2752 | ret = proc_disconnectsignal(ps, arg: p); | 
|---|
| 2753 | break; | 
|---|
| 2754 |  | 
|---|
| 2755 | case USBDEVFS_CLAIMINTERFACE: | 
|---|
| 2756 | snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __func__); | 
|---|
| 2757 | ret = proc_claiminterface(ps, arg: p); | 
|---|
| 2758 | break; | 
|---|
| 2759 |  | 
|---|
| 2760 | case USBDEVFS_RELEASEINTERFACE: | 
|---|
| 2761 | snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __func__); | 
|---|
| 2762 | ret = proc_releaseinterface(ps, arg: p); | 
|---|
| 2763 | break; | 
|---|
| 2764 |  | 
|---|
| 2765 | case USBDEVFS_IOCTL: | 
|---|
| 2766 | snoop(&dev->dev, "%s: IOCTL\n", __func__); | 
|---|
| 2767 | ret = proc_ioctl_default(ps, arg: p); | 
|---|
| 2768 | break; | 
|---|
| 2769 |  | 
|---|
| 2770 | case USBDEVFS_CLAIM_PORT: | 
|---|
| 2771 | snoop(&dev->dev, "%s: CLAIM_PORT\n", __func__); | 
|---|
| 2772 | ret = proc_claim_port(ps, arg: p); | 
|---|
| 2773 | break; | 
|---|
| 2774 |  | 
|---|
| 2775 | case USBDEVFS_RELEASE_PORT: | 
|---|
| 2776 | snoop(&dev->dev, "%s: RELEASE_PORT\n", __func__); | 
|---|
| 2777 | ret = proc_release_port(ps, arg: p); | 
|---|
| 2778 | break; | 
|---|
| 2779 | case USBDEVFS_GET_CAPABILITIES: | 
|---|
| 2780 | ret = proc_get_capabilities(ps, arg: p); | 
|---|
| 2781 | break; | 
|---|
| 2782 | case USBDEVFS_DISCONNECT_CLAIM: | 
|---|
| 2783 | ret = proc_disconnect_claim(ps, arg: p); | 
|---|
| 2784 | break; | 
|---|
| 2785 | case USBDEVFS_ALLOC_STREAMS: | 
|---|
| 2786 | ret = proc_alloc_streams(ps, arg: p); | 
|---|
| 2787 | break; | 
|---|
| 2788 | case USBDEVFS_FREE_STREAMS: | 
|---|
| 2789 | ret = proc_free_streams(ps, arg: p); | 
|---|
| 2790 | break; | 
|---|
| 2791 | case USBDEVFS_DROP_PRIVILEGES: | 
|---|
| 2792 | ret = proc_drop_privileges(ps, arg: p); | 
|---|
| 2793 | break; | 
|---|
| 2794 | case USBDEVFS_GET_SPEED: | 
|---|
| 2795 | ret = ps->dev->speed; | 
|---|
| 2796 | break; | 
|---|
| 2797 | case USBDEVFS_FORBID_SUSPEND: | 
|---|
| 2798 | ret = proc_forbid_suspend(ps); | 
|---|
| 2799 | break; | 
|---|
| 2800 | case USBDEVFS_ALLOW_SUSPEND: | 
|---|
| 2801 | ret = proc_allow_suspend(ps); | 
|---|
| 2802 | break; | 
|---|
| 2803 | case USBDEVFS_WAIT_FOR_RESUME: | 
|---|
| 2804 | ret = proc_wait_for_resume(ps); | 
|---|
| 2805 | break; | 
|---|
| 2806 | } | 
|---|
| 2807 |  | 
|---|
| 2808 | /* Handle variable-length commands */ | 
|---|
| 2809 | switch (cmd & ~IOCSIZE_MASK) { | 
|---|
| 2810 | case USBDEVFS_CONNINFO_EX(0): | 
|---|
| 2811 | ret = proc_conninfo_ex(ps, arg: p, _IOC_SIZE(cmd)); | 
|---|
| 2812 | break; | 
|---|
| 2813 | } | 
|---|
| 2814 |  | 
|---|
| 2815 | done: | 
|---|
| 2816 | usb_unlock_device(dev); | 
|---|
| 2817 | if (ret >= 0) | 
|---|
| 2818 | inode_set_atime_to_ts(inode, ts: current_time(inode)); | 
|---|
| 2819 | return ret; | 
|---|
| 2820 | } | 
|---|
| 2821 |  | 
|---|
| 2822 | static long usbdev_ioctl(struct file *file, unsigned int cmd, | 
|---|
| 2823 | unsigned long arg) | 
|---|
| 2824 | { | 
|---|
| 2825 | int ret; | 
|---|
| 2826 |  | 
|---|
| 2827 | ret = usbdev_do_ioctl(file, cmd, p: (void __user *)arg); | 
|---|
| 2828 |  | 
|---|
| 2829 | return ret; | 
|---|
| 2830 | } | 
|---|
| 2831 |  | 
|---|
| 2832 | /* No kernel lock - fine */ | 
|---|
| 2833 | static __poll_t usbdev_poll(struct file *file, | 
|---|
| 2834 | struct poll_table_struct *wait) | 
|---|
| 2835 | { | 
|---|
| 2836 | struct usb_dev_state *ps = file->private_data; | 
|---|
| 2837 | __poll_t mask = 0; | 
|---|
| 2838 |  | 
|---|
| 2839 | poll_wait(filp: file, wait_address: &ps->wait, p: wait); | 
|---|
| 2840 | if (file->f_mode & FMODE_WRITE && !list_empty(head: &ps->async_completed)) | 
|---|
| 2841 | mask |= EPOLLOUT | EPOLLWRNORM; | 
|---|
| 2842 | if (!connected(ps)) | 
|---|
| 2843 | mask |= EPOLLHUP; | 
|---|
| 2844 | if (list_empty(head: &ps->list)) | 
|---|
| 2845 | mask |= EPOLLERR; | 
|---|
| 2846 | return mask; | 
|---|
| 2847 | } | 
|---|
| 2848 |  | 
|---|
| 2849 | const struct file_operations usbdev_file_operations = { | 
|---|
| 2850 | .owner =	  THIS_MODULE, | 
|---|
| 2851 | .llseek =	  no_seek_end_llseek, | 
|---|
| 2852 | .read =		  usbdev_read, | 
|---|
| 2853 | .poll =		  usbdev_poll, | 
|---|
| 2854 | .unlocked_ioctl = usbdev_ioctl, | 
|---|
| 2855 | .compat_ioctl =   compat_ptr_ioctl, | 
|---|
| 2856 | .mmap =           usbdev_mmap, | 
|---|
| 2857 | .open =		  usbdev_open, | 
|---|
| 2858 | .release =	  usbdev_release, | 
|---|
| 2859 | }; | 
|---|
| 2860 |  | 
|---|
| 2861 | static void usbdev_remove(struct usb_device *udev) | 
|---|
| 2862 | { | 
|---|
| 2863 | struct usb_dev_state *ps; | 
|---|
| 2864 |  | 
|---|
| 2865 | /* Protect against simultaneous resume */ | 
|---|
| 2866 | mutex_lock(lock: &usbfs_mutex); | 
|---|
| 2867 | while (!list_empty(head: &udev->filelist)) { | 
|---|
| 2868 | ps = list_entry(udev->filelist.next, struct usb_dev_state, list); | 
|---|
| 2869 | destroy_all_async(ps); | 
|---|
| 2870 | wake_up_all(&ps->wait); | 
|---|
| 2871 | WRITE_ONCE(ps->not_yet_resumed, 0); | 
|---|
| 2872 | wake_up_all(&ps->wait_for_resume); | 
|---|
| 2873 | list_del_init(entry: &ps->list); | 
|---|
| 2874 | if (ps->discsignr) | 
|---|
| 2875 | kill_pid_usb_asyncio(sig: ps->discsignr, EPIPE, addr: ps->disccontext, | 
|---|
| 2876 | ps->disc_pid, ps->cred); | 
|---|
| 2877 | } | 
|---|
| 2878 | mutex_unlock(lock: &usbfs_mutex); | 
|---|
| 2879 | } | 
|---|
| 2880 |  | 
|---|
| 2881 | static int usbdev_notify(struct notifier_block *self, | 
|---|
| 2882 | unsigned long action, void *dev) | 
|---|
| 2883 | { | 
|---|
| 2884 | switch (action) { | 
|---|
| 2885 | case USB_DEVICE_ADD: | 
|---|
| 2886 | break; | 
|---|
| 2887 | case USB_DEVICE_REMOVE: | 
|---|
| 2888 | usbdev_remove(udev: dev); | 
|---|
| 2889 | break; | 
|---|
| 2890 | } | 
|---|
| 2891 | return NOTIFY_OK; | 
|---|
| 2892 | } | 
|---|
| 2893 |  | 
|---|
| 2894 | static struct notifier_block usbdev_nb = { | 
|---|
| 2895 | .notifier_call =	usbdev_notify, | 
|---|
| 2896 | }; | 
|---|
| 2897 |  | 
|---|
| 2898 | static struct cdev usb_device_cdev; | 
|---|
| 2899 |  | 
|---|
| 2900 | int __init usb_devio_init(void) | 
|---|
| 2901 | { | 
|---|
| 2902 | int retval; | 
|---|
| 2903 |  | 
|---|
| 2904 | retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX, | 
|---|
| 2905 | "usb_device"); | 
|---|
| 2906 | if (retval) { | 
|---|
| 2907 | printk(KERN_ERR "Unable to register minors for usb_device\n"); | 
|---|
| 2908 | goto out; | 
|---|
| 2909 | } | 
|---|
| 2910 | cdev_init(&usb_device_cdev, &usbdev_file_operations); | 
|---|
| 2911 | retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX); | 
|---|
| 2912 | if (retval) { | 
|---|
| 2913 | printk(KERN_ERR "Unable to get usb_device major %d\n", | 
|---|
| 2914 | USB_DEVICE_MAJOR); | 
|---|
| 2915 | goto error_cdev; | 
|---|
| 2916 | } | 
|---|
| 2917 | usb_register_notify(nb: &usbdev_nb); | 
|---|
| 2918 | out: | 
|---|
| 2919 | return retval; | 
|---|
| 2920 |  | 
|---|
| 2921 | error_cdev: | 
|---|
| 2922 | unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX); | 
|---|
| 2923 | goto out; | 
|---|
| 2924 | } | 
|---|
| 2925 |  | 
|---|
| 2926 | void usb_devio_cleanup(void) | 
|---|
| 2927 | { | 
|---|
| 2928 | usb_unregister_notify(nb: &usbdev_nb); | 
|---|
| 2929 | cdev_del(&usb_device_cdev); | 
|---|
| 2930 | unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX); | 
|---|
| 2931 | } | 
|---|
| 2932 |  | 
|---|