16bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama/* 26bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * Driver for Meywa-Denki & KAYAC YUREX 36bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * 46bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * Copyright (C) 2010 Tomoki Sekiyama (tomoki.sekiyama@gmail.com) 56bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * 66bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * This program is free software; you can redistribute it and/or 76bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * modify it under the terms of the GNU General Public License as 86bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * published by the Free Software Foundation, version 2. 96bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * 106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama */ 116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/kernel.h> 136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/errno.h> 146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/init.h> 156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/slab.h> 166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/module.h> 176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/kref.h> 186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/mutex.h> 196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/uaccess.h> 206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/usb.h> 216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#include <linux/hid.h> 226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define DRIVER_AUTHOR "Tomoki Sekiyama" 246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define DRIVER_DESC "Driver for Meywa-Denki & KAYAC YUREX" 256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define YUREX_VENDOR_ID 0x0c45 276bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define YUREX_PRODUCT_ID 0x1010 286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_ACK '!' 306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_ANIMATE 'A' 316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_COUNT 'C' 326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_LED 'L' 336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_READ 'R' 346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_SET 'S' 356bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_VERSION 'V' 366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_EOF 0x0d 376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define CMD_PADDING 0xff 386bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define YUREX_BUF_SIZE 8 40e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama#define YUREX_WRITE_TIMEOUT (HZ*2) 416bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 426bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama/* table of devices that work with this driver */ 436bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic struct usb_device_id yurex_table[] = { 446bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama { USB_DEVICE(YUREX_VENDOR_ID, YUREX_PRODUCT_ID) }, 456bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama { } /* Terminating entry */ 466bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama}; 476bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki SekiyamaMODULE_DEVICE_TABLE(usb, yurex_table); 486bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 496bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#ifdef CONFIG_USB_DYNAMIC_MINORS 501b62d2583963d5974974aa923214bada7aa7b5d1Greg Kroah-Hartman#define YUREX_MINOR_BASE 0 516bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#else 521b62d2583963d5974974aa923214bada7aa7b5d1Greg Kroah-Hartman#define YUREX_MINOR_BASE 192 536bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#endif 546bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 556bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama/* Structure to hold all of our device specific stuff */ 566bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastruct usb_yurex { 576bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_device *udev; 586bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_interface *interface; 596bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama __u8 int_in_endpointAddr; 606bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct urb *urb; /* URB for interrupt in */ 616bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned char *int_buffer; /* buffer for intterupt in */ 626bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct urb *cntl_urb; /* URB for control msg */ 636bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_ctrlrequest *cntl_req; /* req for control msg */ 646bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned char *cntl_buffer; /* buffer for control msg */ 656bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 666bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct kref kref; 676bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct mutex io_mutex; 686bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct fasync_struct *async_queue; 696bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama wait_queue_head_t waitq; 706bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 716bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spinlock_t lock; 726bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama __s64 bbu; /* BBU from device */ 736bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama}; 746bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama#define to_yurex_dev(d) container_of(d, struct usb_yurex, kref) 756bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 766bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic struct usb_driver yurex_driver; 776bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic const struct file_operations yurex_fops; 786bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 796bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 806bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic void yurex_control_callback(struct urb *urb) 816bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 826bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev = urb->context; 836bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int status = urb->status; 846bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 856bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (status) { 86e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama err("%s - control failed: %d\n", __func__, status); 876bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama wake_up_interruptible(&dev->waitq); 886bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return; 896bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 906bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* on success, sender woken up by CMD_ACK int in, or timeout */ 916bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 926bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 936bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic void yurex_delete(struct kref *kref) 946bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 956bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev = to_yurex_dev(kref); 966bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 976bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dbg("yurex_delete"); 986bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 996bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_put_dev(dev->udev); 100e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama if (dev->cntl_urb) { 101e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama usb_kill_urb(dev->cntl_urb); 102523fc5c14f6cad283e5a266eba0e343aed6e73d5Tomoki Sekiyama kfree(dev->cntl_req); 103e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama if (dev->cntl_buffer) 104e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama usb_free_coherent(dev->udev, YUREX_BUF_SIZE, 105e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama dev->cntl_buffer, dev->cntl_urb->transfer_dma); 106e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama usb_free_urb(dev->cntl_urb); 107e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama } 1086bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (dev->urb) { 1096bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_kill_urb(dev->urb); 1106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (dev->int_buffer) 1116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_free_coherent(dev->udev, YUREX_BUF_SIZE, 1126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->int_buffer, dev->urb->transfer_dma); 1136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_free_urb(dev->urb); 1146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kfree(dev); 1166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 1176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama/* 1196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * usb class driver info in order to get a minor number from the usb core, 1206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama * and to have the device registered with the driver core 1216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama */ 1226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic struct usb_class_driver yurex_class = { 1236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .name = "yurex%d", 1246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .fops = &yurex_fops, 1256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .minor_base = YUREX_MINOR_BASE, 1266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama}; 1276bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic void yurex_interrupt(struct urb *urb) 1296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 1306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev = urb->context; 1316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned char *buf = dev->int_buffer; 1326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int status = urb->status; 1336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned long flags; 1346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int retval, i; 1356bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama switch (status) { 1376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case 0: /*success*/ 1386bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 1396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case -EOVERFLOW: 1406bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("%s - overflow with length %d, actual length is %d", 1416bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama __func__, YUREX_BUF_SIZE, dev->urb->actual_length); 1426bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case -ECONNRESET: 1436bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case -ENOENT: 1446bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case -ESHUTDOWN: 1456bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case -EILSEQ: 1466bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* The device is terminated, clean up */ 1476bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return; 1486bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama default: 1496bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("%s - unknown status received: %d", __func__, status); 1506bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto exit; 1516bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1526bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1536bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* handle received message */ 1546bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama switch (buf[0]) { 1556bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_COUNT: 1566bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_READ: 1576bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (buf[6] == CMD_EOF) { 1586bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spin_lock_irqsave(&dev->lock, flags); 1596bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->bbu = 0; 1606bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama for (i = 1; i < 6; i++) { 1616bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->bbu += buf[i]; 1626bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (i != 5) 1636bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->bbu <<= 8; 1646bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1656bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dbg("%s count: %lld", __func__, dev->bbu); 1666bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spin_unlock_irqrestore(&dev->lock, flags); 1676bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1686bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kill_fasync(&dev->async_queue, SIGIO, POLL_IN); 1696bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1706bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama else 1716bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dbg("data format error - no EOF"); 1726bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 1736bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_ACK: 1746bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dbg("%s ack: %c", __func__, buf[1]); 1756bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama wake_up_interruptible(&dev->waitq); 1766bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 1776bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1786bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1796bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamaexit: 1806bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = usb_submit_urb(dev->urb, GFP_ATOMIC); 1816bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (retval) { 1826bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("%s - usb_submit_urb failed: %d", 1836bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama __func__, retval); 1846bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 1856bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 1866bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1876bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic int yurex_probe(struct usb_interface *interface, const struct usb_device_id *id) 1886bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 1896bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 1906bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_host_interface *iface_desc; 1916bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_endpoint_descriptor *endpoint; 1926bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int retval = -ENOMEM; 1936bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int i; 1946bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama DEFINE_WAIT(wait); 1956bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 1966bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate memory for our device state and initialize it */ 1976bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1986bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev) { 1996bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Out of memory"); 2006bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2016bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2026bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kref_init(&dev->kref); 2036bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_init(&dev->io_mutex); 2046bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spin_lock_init(&dev->lock); 2056bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama init_waitqueue_head(&dev->waitq); 2066bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2076bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->udev = usb_get_dev(interface_to_usbdev(interface)); 2086bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->interface = interface; 2096bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* set up the endpoint information */ 2116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama iface_desc = interface->cur_altsetting; 2126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) { 2136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama endpoint = &iface_desc->endpoint[i].desc; 2146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (usb_endpoint_is_int_in(endpoint)) { 2166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->int_in_endpointAddr = endpoint->bEndpointAddress; 2176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 2186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->int_in_endpointAddr) { 2216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -ENODEV; 2226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not find endpoints"); 2236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2276bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate control URB */ 2286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_urb = usb_alloc_urb(0, GFP_KERNEL); 2296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->cntl_urb) { 2306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not allocate control URB"); 2316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate buffer for control req */ 235523fc5c14f6cad283e5a266eba0e343aed6e73d5Tomoki Sekiyama dev->cntl_req = kmalloc(YUREX_BUF_SIZE, GFP_KERNEL); 2366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->cntl_req) { 2376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not allocate cntl_req"); 2386bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2406bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2416bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate buffer for control msg */ 2426bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer = usb_alloc_coherent(dev->udev, YUREX_BUF_SIZE, 2436bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama GFP_KERNEL, 2446bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama &dev->cntl_urb->transfer_dma); 2456bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->cntl_buffer) { 2466bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not allocate cntl_buffer"); 2476bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2486bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2496bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2506bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* configure control URB */ 2516bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_req->bRequestType = USB_DIR_OUT | USB_TYPE_CLASS | 2526bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama USB_RECIP_INTERFACE; 2536bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_req->bRequest = HID_REQ_SET_REPORT; 2546bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_req->wValue = cpu_to_le16((HID_OUTPUT_REPORT + 1) << 8); 2556bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_req->wIndex = cpu_to_le16(iface_desc->desc.bInterfaceNumber); 2566bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_req->wLength = cpu_to_le16(YUREX_BUF_SIZE); 2576bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2586bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_fill_control_urb(dev->cntl_urb, dev->udev, 2596bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_sndctrlpipe(dev->udev, 0), 2606bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama (void *)dev->cntl_req, dev->cntl_buffer, 2616bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama YUREX_BUF_SIZE, yurex_control_callback, dev); 262e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama dev->cntl_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 2636bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2646bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2656bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate interrupt URB */ 2666bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->urb = usb_alloc_urb(0, GFP_KERNEL); 2676bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->urb) { 2686bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not allocate URB"); 2696bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2706bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2716bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2726bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* allocate buffer for interrupt in */ 2736bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->int_buffer = usb_alloc_coherent(dev->udev, YUREX_BUF_SIZE, 2746bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama GFP_KERNEL, &dev->urb->transfer_dma); 2756bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->int_buffer) { 2766bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not allocate int_buffer"); 2776bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2786bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2796bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2806bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* configure interrupt URB */ 2816bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_fill_int_urb(dev->urb, dev->udev, 2826bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_rcvintpipe(dev->udev, dev->int_in_endpointAddr), 2836bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->int_buffer, YUREX_BUF_SIZE, yurex_interrupt, 2846bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev, 1); 285532f17b5d59bf0deb6f1ff9bc1fb27d5b5011c09Tomoki Sekiyama dev->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 2866bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (usb_submit_urb(dev->urb, GFP_KERNEL)) { 2876bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -EIO; 2886bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Could not submitting URB"); 2896bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 2906bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 2916bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2926bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* save our data pointer in this interface device */ 2936bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_set_intfdata(interface, dev); 2946bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 2956bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* we can register the device now, as it is ready */ 2966bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = usb_register_dev(interface, &yurex_class); 2976bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (retval) { 2986bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("Not able to get a minor for this device."); 2996bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_set_intfdata(interface, NULL); 3006bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 3016bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 3026bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3036bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->bbu = -1; 3046bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3056bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev_info(&interface->dev, 306e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama "USB YUREX device now attached to Yurex #%d\n", 3076bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama interface->minor); 3086bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3096bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return 0; 3106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamaerror: 3126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (dev) 3136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* this frees allocated memory */ 3146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kref_put(&dev->kref, yurex_delete); 3156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return retval; 3166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 3176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic void yurex_disconnect(struct usb_interface *interface) 3196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 3206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 3216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int minor = interface->minor; 3226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = usb_get_intfdata(interface); 3246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_set_intfdata(interface, NULL); 3256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* give back our minor */ 3276bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama usb_deregister_dev(interface, &yurex_class); 3286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* prevent more I/O from starting */ 3306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_lock(&dev->io_mutex); 3316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->interface = NULL; 3326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 3336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* wakeup waiters */ 3356bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kill_fasync(&dev->async_queue, SIGIO, POLL_IN); 3366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama wake_up_interruptible(&dev->waitq); 3376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3386bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* decrement our usage count */ 3396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kref_put(&dev->kref, yurex_delete); 3406bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 341e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama dev_info(&interface->dev, "USB YUREX #%d now disconnected\n", minor); 3426bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 3436bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3446bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic struct usb_driver yurex_driver = { 3456bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .name = "yurex", 3466bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .probe = yurex_probe, 3476bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .disconnect = yurex_disconnect, 3486bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .id_table = yurex_table, 3496bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama}; 3506bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3516bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3526bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic int yurex_fasync(int fd, struct file *file, int on) 3536bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 3546bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 3556bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3566bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = (struct usb_yurex *)file->private_data; 3576bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return fasync_helper(fd, file, on, &dev->async_queue); 3586bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 3596bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3606bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic int yurex_open(struct inode *inode, struct file *file) 3616bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 3626bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 3636bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_interface *interface; 3646bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int subminor; 3656bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int retval = 0; 3666bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3676bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama subminor = iminor(inode); 3686bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3696bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama interface = usb_find_interface(&yurex_driver, subminor); 3706bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!interface) { 3716bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("%s - error, can't find device for minor %d", 3726bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama __func__, subminor); 3736bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -ENODEV; 3746bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto exit; 3756bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 3766bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3776bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = usb_get_intfdata(interface); 3786bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev) { 3796bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -ENODEV; 3806bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto exit; 3816bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 3826bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3836bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* increment our usage count for the device */ 3846bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kref_get(&dev->kref); 3856bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3866bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* save our object in the file's private structure */ 3876bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_lock(&dev->io_mutex); 3886bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama file->private_data = dev; 3896bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 3906bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3916bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamaexit: 3926bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return retval; 3936bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 3946bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3956bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic int yurex_release(struct inode *inode, struct file *file) 3966bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 3976bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 3986bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 3996bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = (struct usb_yurex *)file->private_data; 4006bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (dev == NULL) 4016bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return -ENODEV; 4026bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4036bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama yurex_fasync(-1, file, 0); 4046bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4056bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* decrement the count on our device */ 4066bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama kref_put(&dev->kref, yurex_delete); 4076bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return 0; 4086bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 4096bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic ssize_t yurex_read(struct file *file, char *buffer, size_t count, loff_t *ppos) 4116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 4126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 4136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int retval = 0; 4146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int bytes_read = 0; 4156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama char in_buffer[20]; 4166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned long flags; 4176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = (struct usb_yurex *)file->private_data; 4196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_lock(&dev->io_mutex); 4216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->interface) { /* already disconnected */ 4226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -ENODEV; 4236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto exit; 4246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spin_lock_irqsave(&dev->lock, flags); 427e06ea97fa47611992a5a61058729cf8e83bf6fdaTomoki Sekiyama bytes_read = snprintf(in_buffer, 20, "%lld\n", dev->bbu); 4286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama spin_unlock_irqrestore(&dev->lock, flags); 4296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (*ppos < bytes_read) { 4316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (copy_to_user(buffer, in_buffer + *ppos, bytes_read - *ppos)) 4326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -EFAULT; 4336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama else { 4346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = bytes_read - *ppos; 4356bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama *ppos += bytes_read; 4366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4386bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamaexit: 4406bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 4416bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return retval; 4426bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 4436bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4446bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic ssize_t yurex_write(struct file *file, const char *user_buffer, size_t count, loff_t *ppos) 4456bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama{ 4466bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama struct usb_yurex *dev; 4476bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama int i, set = 0, retval = 0; 4486bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama char buffer[16]; 4496bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama char *data = buffer; 4506bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama unsigned long long c, c2 = 0; 4516bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama signed long timeout = 0; 4526bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama DEFINE_WAIT(wait); 4536bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4546bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama count = min(sizeof(buffer), count); 4556bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev = (struct usb_yurex *)file->private_data; 4566bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4576bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* verify that we actually have some data to write */ 4586bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (count == 0) 4596bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 4606bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4616bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_lock(&dev->io_mutex); 4626bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (!dev->interface) { /* alreaday disconnected */ 4636bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 4646bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -ENODEV; 4656bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 4666bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4676bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4686bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (copy_from_user(buffer, user_buffer, count)) { 4696bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 4706bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = -EFAULT; 4716bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 4726bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4736bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama memset(dev->cntl_buffer, CMD_PADDING, YUREX_BUF_SIZE); 4746bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 4756bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama switch (buffer[0]) { 4766bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_ANIMATE: 4776bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_LED: 4786bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[0] = buffer[0]; 4796bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[1] = buffer[1]; 4806bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[2] = CMD_EOF; 4816bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 4826bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_READ: 4836bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_VERSION: 4846bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[0] = buffer[0]; 4856bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[1] = 0x00; 4866bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[2] = CMD_EOF; 4876bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 4886bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case CMD_SET: 4896bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama data++; 4906bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* FALL THROUGH */ 4916bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama case '0' ... '9': 4926bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama set = 1; 4936bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama c = c2 = simple_strtoull(data, NULL, 0); 4946bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[0] = CMD_SET; 4956bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama for (i = 1; i < 6; i++) { 4966bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->cntl_buffer[i] = (c>>32) & 0xff; 4976bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama c <<= 8; 4986bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 4996bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama buffer[6] = CMD_EOF; 5006bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama break; 5016bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama default: 5026bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 5036bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return -EINVAL; 5046bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 5056bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5066bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama /* send the data as the control msg */ 5076bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama prepare_to_wait(&dev->waitq, &wait, TASK_INTERRUPTIBLE); 5086bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dbg("%s - submit %c", __func__, dev->cntl_buffer[0]); 5096bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama retval = usb_submit_urb(dev->cntl_urb, GFP_KERNEL); 5106bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (retval >= 0) 5116bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama timeout = schedule_timeout(YUREX_WRITE_TIMEOUT); 5126bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama finish_wait(&dev->waitq, &wait); 5136bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5146bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama mutex_unlock(&dev->io_mutex); 5156bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5166bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (retval < 0) { 5176bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama err("%s - failed to send bulk msg, error %d", __func__, retval); 5186bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama goto error; 5196bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama } 5206bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama if (set && timeout) 5216bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama dev->bbu = c2; 5226bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return timeout ? count : -EIO; 5236bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5246bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamaerror: 5256bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama return retval; 5266bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama} 5276bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5286bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyamastatic const struct file_operations yurex_fops = { 5296bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .owner = THIS_MODULE, 5306bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .read = yurex_read, 5316bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .write = yurex_write, 5326bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .open = yurex_open, 5336bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .release = yurex_release, 5346bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama .fasync = yurex_fasync, 53527f485b5b27926878ffc8f528bdefeb25e6bd3d3Tomoki Sekiyama .llseek = default_llseek, 5366bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama}; 5376bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 53865db43054065790a75291b0834657445fea2cf56Greg Kroah-Hartmanmodule_usb_driver(yurex_driver); 5396bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki Sekiyama 5406bc235a2e24a5ef677daee3fd4f74f6cd643e23cTomoki SekiyamaMODULE_LICENSE("GPL"); 541