1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * PlayStation 2 Trance Vibrator driver 4 * 5 * Copyright (C) 2006 Sam Hocevar <sam@zoy.org> 6 */ 7 8 /* Standard include files */ 9 #include <linux/kernel.h> 10 #include <linux/errno.h> 11 #include <linux/slab.h> 12 #include <linux/module.h> 13 #include <linux/usb.h> 14 15 #define DRIVER_AUTHOR "Sam Hocevar, sam@zoy.org" 16 #define DRIVER_DESC "PlayStation 2 Trance Vibrator driver" 17 18 #define TRANCEVIBRATOR_VENDOR_ID 0x0b49 /* ASCII Corporation */ 19 #define TRANCEVIBRATOR_PRODUCT_ID 0x064f /* Trance Vibrator */ 20 21 static const struct usb_device_id id_table[] = { 22 { USB_DEVICE(TRANCEVIBRATOR_VENDOR_ID, TRANCEVIBRATOR_PRODUCT_ID) }, 23 { }, 24 }; 25 MODULE_DEVICE_TABLE (usb, id_table); 26 27 /* Driver-local specific stuff */ 28 struct trancevibrator { 29 struct usb_device *udev; 30 unsigned int speed; 31 }; 32 33 static ssize_t speed_show(struct device *dev, struct device_attribute *attr, 34 char *buf) 35 { 36 struct usb_interface *intf = to_usb_interface(dev); 37 struct trancevibrator *tv = usb_get_intfdata(intf); 38 39 return sprintf(buf, "%d\n", tv->speed); 40 } 41 42 static ssize_t speed_store(struct device *dev, struct device_attribute *attr, 43 const char *buf, size_t count) 44 { 45 struct usb_interface *intf = to_usb_interface(dev); 46 struct trancevibrator *tv = usb_get_intfdata(intf); 47 int temp, retval, old; 48 49 retval = kstrtoint(buf, 10, &temp); 50 if (retval) 51 return retval; 52 if (temp > 255) 53 temp = 255; 54 else if (temp < 0) 55 temp = 0; 56 old = tv->speed; 57 tv->speed = temp; 58 59 dev_dbg(&tv->udev->dev, "speed = %d\n", tv->speed); 60 61 /* Set speed */ 62 retval = usb_control_msg(tv->udev, usb_sndctrlpipe(tv->udev, 0), 63 0x01, /* vendor request: set speed */ 64 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_OTHER, 65 tv->speed, /* speed value */ 66 0, NULL, 0, USB_CTRL_GET_TIMEOUT); 67 if (retval) { 68 tv->speed = old; 69 dev_dbg(&tv->udev->dev, "retval = %d\n", retval); 70 return retval; 71 } 72 return count; 73 } 74 75 static DEVICE_ATTR_RW(speed); 76 77 static int tv_probe(struct usb_interface *interface, 78 const struct usb_device_id *id) 79 { 80 struct usb_device *udev = interface_to_usbdev(interface); 81 struct trancevibrator *dev; 82 int retval; 83 84 dev = kzalloc(sizeof(struct trancevibrator), GFP_KERNEL); 85 if (!dev) { 86 retval = -ENOMEM; 87 goto error; 88 } 89 90 dev->udev = usb_get_dev(udev); 91 usb_set_intfdata(interface, dev); 92 retval = device_create_file(&interface->dev, &dev_attr_speed); 93 if (retval) 94 goto error_create_file; 95 96 return 0; 97 98 error_create_file: 99 usb_put_dev(udev); 100 usb_set_intfdata(interface, NULL); 101 error: 102 kfree(dev); 103 return retval; 104 } 105 106 static void tv_disconnect(struct usb_interface *interface) 107 { 108 struct trancevibrator *dev; 109 110 dev = usb_get_intfdata (interface); 111 device_remove_file(&interface->dev, &dev_attr_speed); 112 usb_set_intfdata(interface, NULL); 113 usb_put_dev(dev->udev); 114 kfree(dev); 115 } 116 117 /* USB subsystem object */ 118 static struct usb_driver tv_driver = { 119 .name = "trancevibrator", 120 .probe = tv_probe, 121 .disconnect = tv_disconnect, 122 .id_table = id_table, 123 }; 124 125 module_usb_driver(tv_driver); 126 127 MODULE_AUTHOR(DRIVER_AUTHOR); 128 MODULE_DESCRIPTION(DRIVER_DESC); 129 MODULE_LICENSE("GPL"); 130