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