Commit | Line | Data |
---|---|---|
5fd54ace | 1 | // SPDX-License-Identifier: GPL-2.0+ |
5638e4d9 SH |
2 | /* |
3 | * PlayStation 2 Trance Vibrator driver | |
4 | * | |
5 | * Copyright (C) 2006 Sam Hocevar <sam@zoy.org> | |
5638e4d9 SH |
6 | */ |
7 | ||
8 | /* Standard include files */ | |
9 | #include <linux/kernel.h> | |
10 | #include <linux/errno.h> | |
5a0e3ad6 | 11 | #include <linux/slab.h> |
5638e4d9 SH |
12 | #include <linux/module.h> |
13 | #include <linux/usb.h> | |
14 | ||
5638e4d9 SH |
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 | ||
33b9e162 | 21 | static const struct usb_device_id id_table[] = { |
5638e4d9 SH |
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 | ||
ed5bd7a4 | 33 | static ssize_t speed_show(struct device *dev, struct device_attribute *attr, |
5638e4d9 SH |
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 | ||
ed5bd7a4 | 42 | static ssize_t speed_store(struct device *dev, struct device_attribute *attr, |
5638e4d9 SH |
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); | |
0cc5e2e7 | 47 | int temp, retval, old; |
5638e4d9 | 48 | |
9d20bca5 DX |
49 | retval = kstrtoint(buf, 10, &temp); |
50 | if (retval) | |
51 | return retval; | |
5638e4d9 SH |
52 | if (temp > 255) |
53 | temp = 255; | |
54 | else if (temp < 0) | |
55 | temp = 0; | |
0cc5e2e7 | 56 | old = tv->speed; |
5638e4d9 SH |
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 */ | |
746e4acf | 64 | USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_OTHER, |
5638e4d9 | 65 | tv->speed, /* speed value */ |
746e4acf | 66 | 0, NULL, 0, USB_CTRL_SET_TIMEOUT); |
5638e4d9 | 67 | if (retval) { |
0cc5e2e7 | 68 | tv->speed = old; |
5638e4d9 SH |
69 | dev_dbg(&tv->udev->dev, "retval = %d\n", retval); |
70 | return retval; | |
71 | } | |
72 | return count; | |
73 | } | |
ed5bd7a4 | 74 | static DEVICE_ATTR_RW(speed); |
5638e4d9 | 75 | |
f9bbcbef GKH |
76 | static struct attribute *tv_attrs[] = { |
77 | &dev_attr_speed.attr, | |
78 | NULL, | |
79 | }; | |
80 | ATTRIBUTE_GROUPS(tv); | |
81 | ||
5638e4d9 SH |
82 | static int tv_probe(struct usb_interface *interface, |
83 | const struct usb_device_id *id) | |
84 | { | |
85 | struct usb_device *udev = interface_to_usbdev(interface); | |
86 | struct trancevibrator *dev; | |
87 | int retval; | |
88 | ||
89 | dev = kzalloc(sizeof(struct trancevibrator), GFP_KERNEL); | |
58e61402 | 90 | if (!dev) { |
5638e4d9 SH |
91 | retval = -ENOMEM; |
92 | goto error; | |
93 | } | |
94 | ||
95 | dev->udev = usb_get_dev(udev); | |
96 | usb_set_intfdata(interface, dev); | |
5638e4d9 SH |
97 | |
98 | return 0; | |
99 | ||
5638e4d9 SH |
100 | error: |
101 | kfree(dev); | |
102 | return retval; | |
103 | } | |
104 | ||
105 | static void tv_disconnect(struct usb_interface *interface) | |
106 | { | |
107 | struct trancevibrator *dev; | |
108 | ||
109 | dev = usb_get_intfdata (interface); | |
96ca014d | 110 | usb_set_intfdata(interface, NULL); |
5638e4d9 SH |
111 | usb_put_dev(dev->udev); |
112 | kfree(dev); | |
113 | } | |
114 | ||
115 | /* USB subsystem object */ | |
116 | static struct usb_driver tv_driver = { | |
117 | .name = "trancevibrator", | |
118 | .probe = tv_probe, | |
119 | .disconnect = tv_disconnect, | |
120 | .id_table = id_table, | |
f9bbcbef | 121 | .dev_groups = tv_groups, |
5638e4d9 SH |
122 | }; |
123 | ||
65db4305 | 124 | module_usb_driver(tv_driver); |
5638e4d9 SH |
125 | |
126 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
127 | MODULE_DESCRIPTION(DRIVER_DESC); | |
128 | MODULE_LICENSE("GPL"); |