Commit | Line | Data |
---|---|---|
5638e4d9 SH |
1 | /* |
2 | * PlayStation 2 Trance Vibrator driver | |
3 | * | |
4 | * Copyright (C) 2006 Sam Hocevar <sam@zoy.org> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
19 | */ | |
20 | ||
21 | /* Standard include files */ | |
22 | #include <linux/kernel.h> | |
23 | #include <linux/errno.h> | |
24 | #include <linux/init.h> | |
25 | #include <linux/module.h> | |
26 | #include <linux/usb.h> | |
27 | ||
28 | /* Version Information */ | |
29 | #define DRIVER_VERSION "v1.1" | |
30 | #define DRIVER_AUTHOR "Sam Hocevar, sam@zoy.org" | |
31 | #define DRIVER_DESC "PlayStation 2 Trance Vibrator driver" | |
32 | ||
33 | #define TRANCEVIBRATOR_VENDOR_ID 0x0b49 /* ASCII Corporation */ | |
34 | #define TRANCEVIBRATOR_PRODUCT_ID 0x064f /* Trance Vibrator */ | |
35 | ||
36 | static struct usb_device_id id_table [] = { | |
37 | { USB_DEVICE(TRANCEVIBRATOR_VENDOR_ID, TRANCEVIBRATOR_PRODUCT_ID) }, | |
38 | { }, | |
39 | }; | |
40 | MODULE_DEVICE_TABLE (usb, id_table); | |
41 | ||
42 | /* Driver-local specific stuff */ | |
43 | struct trancevibrator { | |
44 | struct usb_device *udev; | |
45 | unsigned int speed; | |
46 | }; | |
47 | ||
48 | static ssize_t show_speed(struct device *dev, struct device_attribute *attr, | |
49 | char *buf) | |
50 | { | |
51 | struct usb_interface *intf = to_usb_interface(dev); | |
52 | struct trancevibrator *tv = usb_get_intfdata(intf); | |
53 | ||
54 | return sprintf(buf, "%d\n", tv->speed); | |
55 | } | |
56 | ||
57 | static ssize_t set_speed(struct device *dev, struct device_attribute *attr, | |
58 | const char *buf, size_t count) | |
59 | { | |
60 | struct usb_interface *intf = to_usb_interface(dev); | |
61 | struct trancevibrator *tv = usb_get_intfdata(intf); | |
0cc5e2e7 | 62 | int temp, retval, old; |
5638e4d9 SH |
63 | |
64 | temp = simple_strtoul(buf, NULL, 10); | |
65 | if (temp > 255) | |
66 | temp = 255; | |
67 | else if (temp < 0) | |
68 | temp = 0; | |
0cc5e2e7 | 69 | old = tv->speed; |
5638e4d9 SH |
70 | tv->speed = temp; |
71 | ||
72 | dev_dbg(&tv->udev->dev, "speed = %d\n", tv->speed); | |
73 | ||
74 | /* Set speed */ | |
75 | retval = usb_control_msg(tv->udev, usb_sndctrlpipe(tv->udev, 0), | |
76 | 0x01, /* vendor request: set speed */ | |
77 | USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_OTHER, | |
78 | tv->speed, /* speed value */ | |
79 | 0, NULL, 0, USB_CTRL_GET_TIMEOUT); | |
80 | if (retval) { | |
0cc5e2e7 | 81 | tv->speed = old; |
5638e4d9 SH |
82 | dev_dbg(&tv->udev->dev, "retval = %d\n", retval); |
83 | return retval; | |
84 | } | |
85 | return count; | |
86 | } | |
87 | ||
88 | static DEVICE_ATTR(speed, S_IWUGO | S_IRUGO, show_speed, set_speed); | |
89 | ||
90 | static int tv_probe(struct usb_interface *interface, | |
91 | const struct usb_device_id *id) | |
92 | { | |
93 | struct usb_device *udev = interface_to_usbdev(interface); | |
94 | struct trancevibrator *dev; | |
95 | int retval; | |
96 | ||
97 | dev = kzalloc(sizeof(struct trancevibrator), GFP_KERNEL); | |
98 | if (dev == NULL) { | |
99 | dev_err(&interface->dev, "Out of memory\n"); | |
100 | retval = -ENOMEM; | |
101 | goto error; | |
102 | } | |
103 | ||
104 | dev->udev = usb_get_dev(udev); | |
105 | usb_set_intfdata(interface, dev); | |
106 | retval = device_create_file(&interface->dev, &dev_attr_speed); | |
107 | if (retval) | |
108 | goto error_create_file; | |
109 | ||
110 | return 0; | |
111 | ||
112 | error_create_file: | |
113 | usb_put_dev(udev); | |
114 | usb_set_intfdata(interface, NULL); | |
115 | error: | |
116 | kfree(dev); | |
117 | return retval; | |
118 | } | |
119 | ||
120 | static void tv_disconnect(struct usb_interface *interface) | |
121 | { | |
122 | struct trancevibrator *dev; | |
123 | ||
124 | dev = usb_get_intfdata (interface); | |
5638e4d9 | 125 | device_remove_file(&interface->dev, &dev_attr_speed); |
96ca014d | 126 | usb_set_intfdata(interface, NULL); |
5638e4d9 SH |
127 | usb_put_dev(dev->udev); |
128 | kfree(dev); | |
129 | } | |
130 | ||
131 | /* USB subsystem object */ | |
132 | static struct usb_driver tv_driver = { | |
133 | .name = "trancevibrator", | |
134 | .probe = tv_probe, | |
135 | .disconnect = tv_disconnect, | |
136 | .id_table = id_table, | |
137 | }; | |
138 | ||
139 | static int __init tv_init(void) | |
140 | { | |
141 | int retval = usb_register(&tv_driver); | |
142 | if (retval) { | |
143 | err("usb_register failed. Error number %d", retval); | |
144 | return retval; | |
145 | } | |
146 | ||
1b29a375 GKH |
147 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" |
148 | DRIVER_DESC "\n"); | |
5638e4d9 SH |
149 | return 0; |
150 | } | |
151 | ||
152 | static void __exit tv_exit(void) | |
153 | { | |
154 | usb_deregister(&tv_driver); | |
155 | } | |
156 | ||
157 | module_init (tv_init); | |
158 | module_exit (tv_exit); | |
159 | ||
160 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
161 | MODULE_DESCRIPTION(DRIVER_DESC); | |
162 | MODULE_LICENSE("GPL"); |