drivers/hid/hid-sony.c

   1 /*
   2  *  HID driver for some sony "special" devices
   3  *
   4  *  Copyright (c) 1999 Andreas Gal
   5  *  Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz>
   6  *  Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc
   7  *  Copyright (c) 2007 Paul Walmsley
   8  *  Copyright (c) 2008 Jiri Slaby
   9  *  Copyright (c) 2006-2008 Jiri Kosina
  10  */
  11
  12 /*
  13  * This program is free software; you can redistribute it and/or modify it
  14  * under the terms of the GNU General Public License as published by the Free
  15  * Software Foundation; either version 2 of the License, or (at your option)
  16  * any later version.
  17  */
  18
  19 #include <linux/device.h>
  20 #include <linux/hid.h>
  21 #include <linux/module.h>
  22 #include <linux/slab.h>
  23 #include <linux/usb.h>
  24
  25 #include "hid-ids.h"
  26
  27 #define VAIO_RDESC_CONSTANT     (1 << 0)
  28 #define SIXAXIS_CONTROLLER_USB  (1 << 1)
  29 #define SIXAXIS_CONTROLLER_BT   (1 << 2)
  30
  31 struct sony_sc {
  32         unsigned long quirks;
  33 };
  34
  35 /* Sony Vaio VGX has wrongly mouse pointer declared as constant */
  36 static void sony_report_fixup(struct hid_device *hdev, __u8 *rdesc,
  37                 unsigned int rsize)
  38 {
  39         struct sony_sc *sc = hid_get_drvdata(hdev);
  40
  41         if ((sc->quirks & VAIO_RDESC_CONSTANT) &&
  42                         rsize >= 56 && rdesc[54] == 0x81 && rdesc[55] == 0x07) {
  43                 dev_info(&hdev->dev, "Fixing up Sony Vaio VGX report "
  44                                 "descriptor\n");
  45                 rdesc[55] = 0x06;
  46         }
  47 }
  48
  49 /*
  50  * Sending HID_REQ_GET_REPORT changes the operation mode of the ps3 controller
  51  * to "operational".  Without this, the ps3 controller will not report any
  52  * events.
  53  */
  54 static int sixaxis_set_operational_usb(struct hid_device *hdev)
  55 {
  56         struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
  57         struct usb_device *dev = interface_to_usbdev(intf);
  58         __u16 ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
  59         int ret;
  60         char *buf = kmalloc(18, GFP_KERNEL);
  61
  62         if (!buf)
  63                 return -ENOMEM;
  64
  65         ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
  66                                  HID_REQ_GET_REPORT,
  67                                  USB_DIR_IN | USB_TYPE_CLASS |
  68                                  USB_RECIP_INTERFACE,
  69                                  (3 << 8) | 0xf2, ifnum, buf, 17,
  70                                  USB_CTRL_GET_TIMEOUT);
  71         if (ret < 0)
  72                 dev_err(&hdev->dev, "can't set operational mode\n");
  73
  74         kfree(buf);
  75
  76         return ret;
  77 }
  78
  79 static int sixaxis_set_operational_bt(struct hid_device *hdev)
  80 {
  81         unsigned char buf[] = { 0xf4,  0x42, 0x03, 0x00, 0x00 };
  82         return hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
  83 }
  84
  85 static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id)
  86 {
  87         int ret;
  88         unsigned long quirks = id->driver_data;
  89         struct sony_sc *sc;
  90
  91         sc = kzalloc(sizeof(*sc), GFP_KERNEL);
  92         if (sc == NULL) {
  93                 dev_err(&hdev->dev, "can't alloc sony descriptor\n");
  94                 return -ENOMEM;
  95         }
  96
  97         sc->quirks = quirks;
  98         hid_set_drvdata(hdev, sc);
  99
 100         ret = hid_parse(hdev);
 101         if (ret) {
 102                 dev_err(&hdev->dev, "parse failed\n");
 103                 goto err_free;
 104         }
 105
 106         ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT |
 107                         HID_CONNECT_HIDDEV_FORCE);
 108         if (ret) {
 109                 dev_err(&hdev->dev, "hw start failed\n");
 110                 goto err_free;
 111         }
 112
 113         if (sc->quirks & SIXAXIS_CONTROLLER_USB)
 114                 ret = sixaxis_set_operational_usb(hdev);
 115         else if (sc->quirks & SIXAXIS_CONTROLLER_BT)
 116                 ret = sixaxis_set_operational_bt(hdev);
 117         else
 118                 ret = 0;
 119
 120         if (ret < 0)
 121                 goto err_stop;
 122
 123         return 0;
 124 err_stop:
 125         hid_hw_stop(hdev);
 126 err_free:
 127         kfree(sc);
 128         return ret;
 129 }
 130
 131 static void sony_remove(struct hid_device *hdev)
 132 {
 133         hid_hw_stop(hdev);
 134         kfree(hid_get_drvdata(hdev));
 135 }
 136
 137 static const struct hid_device_id sony_devices[] = {
 138         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
 139                 .driver_data = SIXAXIS_CONTROLLER_USB },
 140         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
 141                 .driver_data = SIXAXIS_CONTROLLER_BT },
 142         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGX_MOUSE),
 143                 .driver_data = VAIO_RDESC_CONSTANT },
 144         { }
 145 };
 146 MODULE_DEVICE_TABLE(hid, sony_devices);
 147
 148 static struct hid_driver sony_driver = {
 149         .name = "sony",
 150         .id_table = sony_devices,
 151         .probe = sony_probe,
 152         .remove = sony_remove,
 153         .report_fixup = sony_report_fixup,
 154 };
 155
 156 static int __init sony_init(void)
 157 {
 158         return hid_register_driver(&sony_driver);
 159 }
 160
 161 static void __exit sony_exit(void)
 162 {
 163         hid_unregister_driver(&sony_driver);
 164 }
 165
 166 module_init(sony_init);
 167 module_exit(sony_exit);
 168 MODULE_LICENSE("GPL");