drivers/hid/hid-sony.c

   1 /*
   2  *  HID driver for Sony / PS2 / PS3 BD 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) 2008 Jiri Slaby
   8  *  Copyright (c) 2012 David Dillow <dave@thedillows.org>
   9  *  Copyright (c) 2006-2013 Jiri Kosina
  10  *  Copyright (c) 2013 Colin Leitner <colin.leitner@gmail.com>
  11  */
  12
  13 /*
  14  * This program is free software; you can redistribute it and/or modify it
  15  * under the terms of the GNU General Public License as published by the Free
  16  * Software Foundation; either version 2 of the License, or (at your option)
  17  * any later version.
  18  */
  19
  20 /* NOTE: in order for the Sony PS3 BD Remote Control to be found by
  21  * a Bluetooth host, the key combination Start+Enter has to be kept pressed
  22  * for about 7 seconds with the Bluetooth Host Controller in discovering mode.
  23  *
  24  * There will be no PIN request from the device.
  25  */
  26
  27 #include <linux/device.h>
  28 #include <linux/hid.h>
  29 #include <linux/module.h>
  30 #include <linux/slab.h>
  31 #include <linux/usb.h>
  32 #include <linux/leds.h>
  33
  34 #include "hid-ids.h"
  35
  36 #define VAIO_RDESC_CONSTANT     (1 << 0)
  37 #define SIXAXIS_CONTROLLER_USB  (1 << 1)
  38 #define SIXAXIS_CONTROLLER_BT   (1 << 2)
  39 #define BUZZ_CONTROLLER         (1 << 3)
  40 #define PS3REMOTE               (1 << 4)
  41
  42 static const u8 sixaxis_rdesc_fixup[] = {
  43         0x95, 0x13, 0x09, 0x01, 0x81, 0x02, 0x95, 0x0C,
  44         0x81, 0x01, 0x75, 0x10, 0x95, 0x04, 0x26, 0xFF,
  45         0x03, 0x46, 0xFF, 0x03, 0x09, 0x01, 0x81, 0x02
  46 };
  47
  48 static const u8 sixaxis_rdesc_fixup2[] = {
  49         0x05, 0x01, 0x09, 0x04, 0xa1, 0x01, 0xa1, 0x02,
  50         0x85, 0x01, 0x75, 0x08, 0x95, 0x01, 0x15, 0x00,
  51         0x26, 0xff, 0x00, 0x81, 0x03, 0x75, 0x01, 0x95,
  52         0x13, 0x15, 0x00, 0x25, 0x01, 0x35, 0x00, 0x45,
  53         0x01, 0x05, 0x09, 0x19, 0x01, 0x29, 0x13, 0x81,
  54         0x02, 0x75, 0x01, 0x95, 0x0d, 0x06, 0x00, 0xff,
  55         0x81, 0x03, 0x15, 0x00, 0x26, 0xff, 0x00, 0x05,
  56         0x01, 0x09, 0x01, 0xa1, 0x00, 0x75, 0x08, 0x95,
  57         0x04, 0x35, 0x00, 0x46, 0xff, 0x00, 0x09, 0x30,
  58         0x09, 0x31, 0x09, 0x32, 0x09, 0x35, 0x81, 0x02,
  59         0xc0, 0x05, 0x01, 0x95, 0x13, 0x09, 0x01, 0x81,
  60         0x02, 0x95, 0x0c, 0x81, 0x01, 0x75, 0x10, 0x95,
  61         0x04, 0x26, 0xff, 0x03, 0x46, 0xff, 0x03, 0x09,
  62         0x01, 0x81, 0x02, 0xc0, 0xa1, 0x02, 0x85, 0x02,
  63         0x75, 0x08, 0x95, 0x30, 0x09, 0x01, 0xb1, 0x02,
  64         0xc0, 0xa1, 0x02, 0x85, 0xee, 0x75, 0x08, 0x95,
  65         0x30, 0x09, 0x01, 0xb1, 0x02, 0xc0, 0xa1, 0x02,
  66         0x85, 0xef, 0x75, 0x08, 0x95, 0x30, 0x09, 0x01,
  67         0xb1, 0x02, 0xc0, 0xc0,
  68 };
  69
  70 static __u8 ps3remote_rdesc[] = {
  71         0x05, 0x01,          /* GUsagePage Generic Desktop */
  72         0x09, 0x05,          /* LUsage 0x05 [Game Pad] */
  73         0xA1, 0x01,          /* MCollection Application (mouse, keyboard) */
  74
  75          /* Use collection 1 for joypad buttons */
  76          0xA1, 0x02,         /* MCollection Logical (interrelated data) */
  77
  78           /* Ignore the 1st byte, maybe it is used for a controller
  79            * number but it's not needed for correct operation */
  80           0x75, 0x08,        /* GReportSize 0x08 [8] */
  81           0x95, 0x01,        /* GReportCount 0x01 [1] */
  82           0x81, 0x01,        /* MInput 0x01 (Const[0] Arr[1] Abs[2]) */
  83
  84           /* Bytes from 2nd to 4th are a bitmap for joypad buttons, for these
  85            * buttons multiple keypresses are allowed */
  86           0x05, 0x09,        /* GUsagePage Button */
  87           0x19, 0x01,        /* LUsageMinimum 0x01 [Button 1 (primary/trigger)] */
  88           0x29, 0x18,        /* LUsageMaximum 0x18 [Button 24] */
  89           0x14,              /* GLogicalMinimum [0] */
  90           0x25, 0x01,        /* GLogicalMaximum 0x01 [1] */
  91           0x75, 0x01,        /* GReportSize 0x01 [1] */
  92           0x95, 0x18,        /* GReportCount 0x18 [24] */
  93           0x81, 0x02,        /* MInput 0x02 (Data[0] Var[1] Abs[2]) */
  94
  95           0xC0,              /* MEndCollection */
  96
  97          /* Use collection 2 for remote control buttons */
  98          0xA1, 0x02,         /* MCollection Logical (interrelated data) */
  99
 100           /* 5th byte is used for remote control buttons */
 101           0x05, 0x09,        /* GUsagePage Button */
 102           0x18,              /* LUsageMinimum [No button pressed] */
 103           0x29, 0xFE,        /* LUsageMaximum 0xFE [Button 254] */
 104           0x14,              /* GLogicalMinimum [0] */
 105           0x26, 0xFE, 0x00,  /* GLogicalMaximum 0x00FE [254] */
 106           0x75, 0x08,        /* GReportSize 0x08 [8] */
 107           0x95, 0x01,        /* GReportCount 0x01 [1] */
 108           0x80,              /* MInput  */
 109
 110           /* Ignore bytes from 6th to 11th, 6th to 10th are always constant at
 111            * 0xff and 11th is for press indication */
 112           0x75, 0x08,        /* GReportSize 0x08 [8] */
 113           0x95, 0x06,        /* GReportCount 0x06 [6] */
 114           0x81, 0x01,        /* MInput 0x01 (Const[0] Arr[1] Abs[2]) */
 115
 116           /* 12th byte is for battery strength */
 117           0x05, 0x06,        /* GUsagePage Generic Device Controls */
 118           0x09, 0x20,        /* LUsage 0x20 [Battery Strength] */
 119           0x14,              /* GLogicalMinimum [0] */
 120           0x25, 0x05,        /* GLogicalMaximum 0x05 [5] */
 121           0x75, 0x08,        /* GReportSize 0x08 [8] */
 122           0x95, 0x01,        /* GReportCount 0x01 [1] */
 123           0x81, 0x02,        /* MInput 0x02 (Data[0] Var[1] Abs[2]) */
 124
 125           0xC0,              /* MEndCollection */
 126
 127          0xC0                /* MEndCollection [Game Pad] */
 128 };
 129
 130 static const unsigned int ps3remote_keymap_joypad_buttons[] = {
 131         [0x01] = KEY_SELECT,
 132         [0x02] = BTN_THUMBL,            /* L3 */
 133         [0x03] = BTN_THUMBR,            /* R3 */
 134         [0x04] = BTN_START,
 135         [0x05] = KEY_UP,
 136         [0x06] = KEY_RIGHT,
 137         [0x07] = KEY_DOWN,
 138         [0x08] = KEY_LEFT,
 139         [0x09] = BTN_TL2,               /* L2 */
 140         [0x0a] = BTN_TR2,               /* R2 */
 141         [0x0b] = BTN_TL,                /* L1 */
 142         [0x0c] = BTN_TR,                /* R1 */
 143         [0x0d] = KEY_OPTION,            /* options/triangle */
 144         [0x0e] = KEY_BACK,              /* back/circle */
 145         [0x0f] = BTN_0,                 /* cross */
 146         [0x10] = KEY_SCREEN,            /* view/square */
 147         [0x11] = KEY_HOMEPAGE,          /* PS button */
 148         [0x14] = KEY_ENTER,
 149 };
 150 static const unsigned int ps3remote_keymap_remote_buttons[] = {
 151         [0x00] = KEY_1,
 152         [0x01] = KEY_2,
 153         [0x02] = KEY_3,
 154         [0x03] = KEY_4,
 155         [0x04] = KEY_5,
 156         [0x05] = KEY_6,
 157         [0x06] = KEY_7,
 158         [0x07] = KEY_8,
 159         [0x08] = KEY_9,
 160         [0x09] = KEY_0,
 161         [0x0e] = KEY_ESC,               /* return */
 162         [0x0f] = KEY_CLEAR,
 163         [0x16] = KEY_EJECTCD,
 164         [0x1a] = KEY_MENU,              /* top menu */
 165         [0x28] = KEY_TIME,
 166         [0x30] = KEY_PREVIOUS,
 167         [0x31] = KEY_NEXT,
 168         [0x32] = KEY_PLAY,
 169         [0x33] = KEY_REWIND,            /* scan back */
 170         [0x34] = KEY_FORWARD,           /* scan forward */
 171         [0x38] = KEY_STOP,
 172         [0x39] = KEY_PAUSE,
 173         [0x40] = KEY_CONTEXT_MENU,      /* pop up/menu */
 174         [0x60] = KEY_FRAMEBACK,         /* slow/step back */
 175         [0x61] = KEY_FRAMEFORWARD,      /* slow/step forward */
 176         [0x63] = KEY_SUBTITLE,
 177         [0x64] = KEY_AUDIO,
 178         [0x65] = KEY_ANGLE,
 179         [0x70] = KEY_INFO,              /* display */
 180         [0x80] = KEY_BLUE,
 181         [0x81] = KEY_RED,
 182         [0x82] = KEY_GREEN,
 183         [0x83] = KEY_YELLOW,
 184 };
 185
 186 static const unsigned int buzz_keymap[] = {
 187         /* The controller has 4 remote buzzers, each with one LED and 5
 188          * buttons.
 189          *
 190          * We use the mapping chosen by the controller, which is:
 191          *
 192          * Key          Offset
 193          * -------------------
 194          * Buzz              1
 195          * Blue              5
 196          * Orange            4
 197          * Green             3
 198          * Yellow            2
 199          *
 200          * So, for example, the orange button on the third buzzer is mapped to
 201          * BTN_TRIGGER_HAPPY14
 202          */
 203         [ 1] = BTN_TRIGGER_HAPPY1,
 204         [ 2] = BTN_TRIGGER_HAPPY2,
 205         [ 3] = BTN_TRIGGER_HAPPY3,
 206         [ 4] = BTN_TRIGGER_HAPPY4,
 207         [ 5] = BTN_TRIGGER_HAPPY5,
 208         [ 6] = BTN_TRIGGER_HAPPY6,
 209         [ 7] = BTN_TRIGGER_HAPPY7,
 210         [ 8] = BTN_TRIGGER_HAPPY8,
 211         [ 9] = BTN_TRIGGER_HAPPY9,
 212         [10] = BTN_TRIGGER_HAPPY10,
 213         [11] = BTN_TRIGGER_HAPPY11,
 214         [12] = BTN_TRIGGER_HAPPY12,
 215         [13] = BTN_TRIGGER_HAPPY13,
 216         [14] = BTN_TRIGGER_HAPPY14,
 217         [15] = BTN_TRIGGER_HAPPY15,
 218         [16] = BTN_TRIGGER_HAPPY16,
 219         [17] = BTN_TRIGGER_HAPPY17,
 220         [18] = BTN_TRIGGER_HAPPY18,
 221         [19] = BTN_TRIGGER_HAPPY19,
 222         [20] = BTN_TRIGGER_HAPPY20,
 223 };
 224
 225 struct sony_sc {
 226         unsigned long quirks;
 227
 228 #ifdef CONFIG_SONY_FF
 229         struct work_struct rumble_worker;
 230         struct hid_device *hdev;
 231         __u8 left;
 232         __u8 right;
 233 #endif
 234
 235         void *extra;
 236 };
 237
 238 struct buzz_extra {
 239         int led_state;
 240         struct led_classdev *leds[4];
 241 };
 242
 243 static __u8 *ps3remote_fixup(struct hid_device *hdev, __u8 *rdesc,
 244                              unsigned int *rsize)
 245 {
 246         *rsize = sizeof(ps3remote_rdesc);
 247         return ps3remote_rdesc;
 248 }
 249
 250 static int ps3remote_mapping(struct hid_device *hdev, struct hid_input *hi,
 251                              struct hid_field *field, struct hid_usage *usage,
 252                              unsigned long **bit, int *max)
 253 {
 254         unsigned int key = usage->hid & HID_USAGE;
 255
 256         if ((usage->hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
 257                 return -1;
 258
 259         switch (usage->collection_index) {
 260         case 1:
 261                 if (key >= ARRAY_SIZE(ps3remote_keymap_joypad_buttons))
 262                         return -1;
 263
 264                 key = ps3remote_keymap_joypad_buttons[key];
 265                 if (!key)
 266                         return -1;
 267                 break;
 268         case 2:
 269                 if (key >= ARRAY_SIZE(ps3remote_keymap_remote_buttons))
 270                         return -1;
 271
 272                 key = ps3remote_keymap_remote_buttons[key];
 273                 if (!key)
 274                         return -1;
 275                 break;
 276         default:
 277                 return -1;
 278         }
 279
 280         hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
 281         return 1;
 282 }
 283
 284
 285 /* Sony Vaio VGX has wrongly mouse pointer declared as constant */
 286 static __u8 *sony_report_fixup(struct hid_device *hdev, __u8 *rdesc,
 287                 unsigned int *rsize)
 288 {
 289         struct sony_sc *sc = hid_get_drvdata(hdev);
 290
 291         /*
 292          * Some Sony RF receivers wrongly declare the mouse pointer as a
 293          * a constant non-data variable.
 294          */
 295         if ((sc->quirks & VAIO_RDESC_CONSTANT) && *rsize >= 56 &&
 296             /* usage page: generic desktop controls */
 297             /* rdesc[0] == 0x05 && rdesc[1] == 0x01 && */
 298             /* usage: mouse */
 299             rdesc[2] == 0x09 && rdesc[3] == 0x02 &&
 300             /* input (usage page for x,y axes): constant, variable, relative */
 301             rdesc[54] == 0x81 && rdesc[55] == 0x07) {
 302                 hid_info(hdev, "Fixing up Sony RF Receiver report descriptor\n");
 303                 /* input: data, variable, relative */
 304                 rdesc[55] = 0x06;
 305         }
 306
 307         /* The HID descriptor exposed over BT has a trailing zero byte */
 308         if ((((sc->quirks & SIXAXIS_CONTROLLER_USB) && *rsize == 148) ||
 309                         ((sc->quirks & SIXAXIS_CONTROLLER_BT) && *rsize == 149)) &&
 310                         rdesc[83] == 0x75) {
 311                 hid_info(hdev, "Fixing up Sony Sixaxis report descriptor\n");
 312                 memcpy((void *)&rdesc[83], (void *)&sixaxis_rdesc_fixup,
 313                         sizeof(sixaxis_rdesc_fixup));
 314         } else if (sc->quirks & SIXAXIS_CONTROLLER_USB &&
 315                    *rsize > sizeof(sixaxis_rdesc_fixup2)) {
 316                 hid_info(hdev, "Sony Sixaxis clone detected. Using original report descriptor (size: %d clone; %d new)\n",
 317                          *rsize, (int)sizeof(sixaxis_rdesc_fixup2));
 318                 *rsize = sizeof(sixaxis_rdesc_fixup2);
 319                 memcpy(rdesc, &sixaxis_rdesc_fixup2, *rsize);
 320         }
 321
 322         if (sc->quirks & PS3REMOTE)
 323                 return ps3remote_fixup(hdev, rdesc, rsize);
 324
 325         return rdesc;
 326 }
 327
 328 static int sony_raw_event(struct hid_device *hdev, struct hid_report *report,
 329                 __u8 *rd, int size)
 330 {
 331         struct sony_sc *sc = hid_get_drvdata(hdev);
 332
 333         /* Sixaxis HID report has acclerometers/gyro with MSByte first, this
 334          * has to be BYTE_SWAPPED before passing up to joystick interface
 335          */
 336         if ((sc->quirks & (SIXAXIS_CONTROLLER_USB | SIXAXIS_CONTROLLER_BT)) &&
 337                         rd[0] == 0x01 && size == 49) {
 338                 swap(rd[41], rd[42]);
 339                 swap(rd[43], rd[44]);
 340                 swap(rd[45], rd[46]);
 341                 swap(rd[47], rd[48]);
 342         }
 343
 344         return 0;
 345 }
 346
 347 static int sony_mapping(struct hid_device *hdev, struct hid_input *hi,
 348                         struct hid_field *field, struct hid_usage *usage,
 349                         unsigned long **bit, int *max)
 350 {
 351         struct sony_sc *sc = hid_get_drvdata(hdev);
 352
 353         if (sc->quirks & BUZZ_CONTROLLER) {
 354                 unsigned int key = usage->hid & HID_USAGE;
 355
 356                 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
 357                         return -1;
 358
 359                 switch (usage->collection_index) {
 360                 case 1:
 361                         if (key >= ARRAY_SIZE(buzz_keymap))
 362                                 return -1;
 363
 364                         key = buzz_keymap[key];
 365                         if (!key)
 366                                 return -1;
 367                         break;
 368                 default:
 369                         return -1;
 370                 }
 371
 372                 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
 373                 return 1;
 374         }
 375
 376         if (sc->quirks & PS3REMOTE)
 377                 return ps3remote_mapping(hdev, hi, field, usage, bit, max);
 378
 379         /* Let hid-core decide for the others */
 380         return 0;
 381 }
 382
 383 /*
 384  * The Sony Sixaxis does not handle HID Output Reports on the Interrupt EP
 385  * like it should according to usbhid/hid-core.c::usbhid_output_raw_report()
 386  * so we need to override that forcing HID Output Reports on the Control EP.
 387  *
 388  * There is also another issue about HID Output Reports via USB, the Sixaxis
 389  * does not want the report_id as part of the data packet, so we have to
 390  * discard buf[0] when sending the actual control message, even for numbered
 391  * reports, humpf!
 392  */
 393 static int sixaxis_usb_output_raw_report(struct hid_device *hid, __u8 *buf,
 394                 size_t count, unsigned char report_type)
 395 {
 396         struct usb_interface *intf = to_usb_interface(hid->dev.parent);
 397         struct usb_device *dev = interface_to_usbdev(intf);
 398         struct usb_host_interface *interface = intf->cur_altsetting;
 399         int report_id = buf[0];
 400         int ret;
 401
 402         if (report_type == HID_OUTPUT_REPORT) {
 403                 /* Don't send the Report ID */
 404                 buf++;
 405                 count--;
 406         }
 407
 408         ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
 409                 HID_REQ_SET_REPORT,
 410                 USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
 411                 ((report_type + 1) << 8) | report_id,
 412                 interface->desc.bInterfaceNumber, buf, count,
 413                 USB_CTRL_SET_TIMEOUT);
 414
 415         /* Count also the Report ID, in case of an Output report. */
 416         if (ret > 0 && report_type == HID_OUTPUT_REPORT)
 417                 ret++;
 418
 419         return ret;
 420 }
 421
 422 /*
 423  * Sending HID_REQ_GET_REPORT changes the operation mode of the ps3 controller
 424  * to "operational".  Without this, the ps3 controller will not report any
 425  * events.
 426  */
 427 static int sixaxis_set_operational_usb(struct hid_device *hdev)
 428 {
 429         int ret;
 430         char *buf = kmalloc(18, GFP_KERNEL);
 431
 432         if (!buf)
 433                 return -ENOMEM;
 434
 435         ret = hdev->hid_get_raw_report(hdev, 0xf2, buf, 17, HID_FEATURE_REPORT);
 436
 437         if (ret < 0)
 438                 hid_err(hdev, "can't set operational mode\n");
 439
 440         kfree(buf);
 441
 442         return ret;
 443 }
 444
 445 static int sixaxis_set_operational_bt(struct hid_device *hdev)
 446 {
 447         unsigned char buf[] = { 0xf4,  0x42, 0x03, 0x00, 0x00 };
 448         return hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
 449 }
 450
 451 static void buzz_set_leds(struct hid_device *hdev, int leds)
 452 {
 453         struct list_head *report_list =
 454                 &hdev->report_enum[HID_OUTPUT_REPORT].report_list;
 455         struct hid_report *report = list_entry(report_list->next,
 456                 struct hid_report, list);
 457         __s32 *value = report->field[0]->value;
 458
 459         value[0] = 0x00;
 460         value[1] = (leds & 1) ? 0xff : 0x00;
 461         value[2] = (leds & 2) ? 0xff : 0x00;
 462         value[3] = (leds & 4) ? 0xff : 0x00;
 463         value[4] = (leds & 8) ? 0xff : 0x00;
 464         value[5] = 0x00;
 465         value[6] = 0x00;
 466         hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
 467 }
 468
 469 static void buzz_led_set_brightness(struct led_classdev *led,
 470                                     enum led_brightness value)
 471 {
 472         struct device *dev = led->dev->parent;
 473         struct hid_device *hdev = container_of(dev, struct hid_device, dev);
 474         struct sony_sc *drv_data;
 475         struct buzz_extra *buzz;
 476
 477         int n;
 478
 479         drv_data = hid_get_drvdata(hdev);
 480         if (!drv_data || !drv_data->extra) {
 481                 hid_err(hdev, "No device data\n");
 482                 return;
 483         }
 484         buzz = drv_data->extra;
 485
 486         for (n = 0; n < 4; n++) {
 487                 if (led == buzz->leds[n]) {
 488                         int on = !! (buzz->led_state & (1 << n));
 489                         if (value == LED_OFF && on) {
 490                                 buzz->led_state &= ~(1 << n);
 491                                 buzz_set_leds(hdev, buzz->led_state);
 492                         } else if (value != LED_OFF && !on) {
 493                                 buzz->led_state |= (1 << n);
 494                                 buzz_set_leds(hdev, buzz->led_state);
 495                         }
 496                         break;
 497                 }
 498         }
 499 }
 500
 501 static enum led_brightness buzz_led_get_brightness(struct led_classdev *led)
 502 {
 503         struct device *dev = led->dev->parent;
 504         struct hid_device *hdev = container_of(dev, struct hid_device, dev);
 505         struct sony_sc *drv_data;
 506         struct buzz_extra *buzz;
 507
 508         int n;
 509         int on = 0;
 510
 511         drv_data = hid_get_drvdata(hdev);
 512         if (!drv_data || !drv_data->extra) {
 513                 hid_err(hdev, "No device data\n");
 514                 return LED_OFF;
 515         }
 516         buzz = drv_data->extra;
 517
 518         for (n = 0; n < 4; n++) {
 519                 if (led == buzz->leds[n]) {
 520                         on = !! (buzz->led_state & (1 << n));
 521                         break;
 522                 }
 523         }
 524
 525         return on ? LED_FULL : LED_OFF;
 526 }
 527
 528 static int buzz_init(struct hid_device *hdev)
 529 {
 530         struct sony_sc *drv_data;
 531         struct buzz_extra *buzz;
 532         int n, ret = 0;
 533         struct led_classdev *led;
 534         size_t name_sz;
 535         char *name;
 536
 537         drv_data = hid_get_drvdata(hdev);
 538         BUG_ON(!(drv_data->quirks & BUZZ_CONTROLLER));
 539
 540         /* Validate expected report characteristics. */
 541         if (!hid_validate_values(hdev, HID_OUTPUT_REPORT, 0, 0, 7))
 542                 return -ENODEV;
 543
 544         buzz = kzalloc(sizeof(*buzz), GFP_KERNEL);
 545         if (!buzz) {
 546                 hid_err(hdev, "Insufficient memory, cannot allocate driver data\n");
 547                 return -ENOMEM;
 548         }
 549         drv_data->extra = buzz;
 550
 551         /* Clear LEDs as we have no way of reading their initial state. This is
 552          * only relevant if the driver is loaded after somebody actively set the
 553          * LEDs to on */
 554         buzz_set_leds(hdev, 0x00);
 555
 556         name_sz = strlen(dev_name(&hdev->dev)) + strlen("::buzz#") + 1;
 557
 558         for (n = 0; n < 4; n++) {
 559                 led = kzalloc(sizeof(struct led_classdev) + name_sz, GFP_KERNEL);
 560                 if (!led) {
 561                         hid_err(hdev, "Couldn't allocate memory for LED %d\n", n);
 562                         goto error_leds;
 563                 }
 564
 565                 name = (void *)(&led[1]);
 566                 snprintf(name, name_sz, "%s::buzz%d", dev_name(&hdev->dev), n + 1);
 567                 led->name = name;
 568                 led->brightness = 0;
 569                 led->max_brightness = 1;
 570                 led->brightness_get = buzz_led_get_brightness;
 571                 led->brightness_set = buzz_led_set_brightness;
 572
 573                 if (led_classdev_register(&hdev->dev, led)) {
 574                         hid_err(hdev, "Failed to register LED %d\n", n);
 575                         kfree(led);
 576                         goto error_leds;
 577                 }
 578
 579                 buzz->leds[n] = led;
 580         }
 581
 582         return ret;
 583
 584 error_leds:
 585         for (n = 0; n < 4; n++) {
 586                 led = buzz->leds[n];
 587                 buzz->leds[n] = NULL;
 588                 if (!led)
 589                         continue;
 590                 led_classdev_unregister(led);
 591                 kfree(led);
 592         }
 593
 594         kfree(drv_data->extra);
 595         drv_data->extra = NULL;
 596         return ret;
 597 }
 598
 599 static void buzz_remove(struct hid_device *hdev)
 600 {
 601         struct sony_sc *drv_data;
 602         struct buzz_extra *buzz;
 603         struct led_classdev *led;
 604         int n;
 605
 606         drv_data = hid_get_drvdata(hdev);
 607         BUG_ON(!(drv_data->quirks & BUZZ_CONTROLLER));
 608
 609         buzz = drv_data->extra;
 610
 611         for (n = 0; n < 4; n++) {
 612                 led = buzz->leds[n];
 613                 buzz->leds[n] = NULL;
 614                 if (!led)
 615                         continue;
 616                 led_classdev_unregister(led);
 617                 kfree(led);
 618         }
 619
 620         kfree(drv_data->extra);
 621         drv_data->extra = NULL;
 622 }
 623
 624 #ifdef CONFIG_SONY_FF
 625 static void sony_rumble_worker(struct work_struct *work)
 626 {
 627         struct sony_sc *sc = container_of(work, struct sony_sc, rumble_worker);
 628         unsigned char buf[] = {
 629                 0x01,
 630                 0x00, 0xff, 0x00, 0xff, 0x00,
 631                 0x00, 0x00, 0x00, 0x00, 0x03,
 632                 0xff, 0x27, 0x10, 0x00, 0x32,
 633                 0xff, 0x27, 0x10, 0x00, 0x32,
 634                 0xff, 0x27, 0x10, 0x00, 0x32,
 635                 0xff, 0x27, 0x10, 0x00, 0x32,
 636                 0x00, 0x00, 0x00, 0x00, 0x00
 637         };
 638
 639         buf[3] = sc->right;
 640         buf[5] = sc->left;
 641
 642         sc->hdev->hid_output_raw_report(sc->hdev, buf, sizeof(buf),
 643                                         HID_OUTPUT_REPORT);
 644 }
 645
 646 static int sony_play_effect(struct input_dev *dev, void *data,
 647                             struct ff_effect *effect)
 648 {
 649         struct hid_device *hid = input_get_drvdata(dev);
 650         struct sony_sc *sc = hid_get_drvdata(hid);
 651
 652         if (effect->type != FF_RUMBLE)
 653                 return 0;
 654
 655         sc->left = effect->u.rumble.strong_magnitude / 256;
 656         sc->right = effect->u.rumble.weak_magnitude ? 1 : 0;
 657
 658         schedule_work(&sc->rumble_worker);
 659         return 0;
 660 }
 661
 662 static int sony_init_ff(struct hid_device *hdev)
 663 {
 664         struct hid_input *hidinput = list_entry(hdev->inputs.next,
 665                                                 struct hid_input, list);
 666         struct input_dev *input_dev = hidinput->input;
 667         struct sony_sc *sc = hid_get_drvdata(hdev);
 668
 669         sc->hdev = hdev;
 670         INIT_WORK(&sc->rumble_worker, sony_rumble_worker);
 671
 672         input_set_capability(input_dev, EV_FF, FF_RUMBLE);
 673         return input_ff_create_memless(input_dev, NULL, sony_play_effect);
 674 }
 675
 676 static void sony_destroy_ff(struct hid_device *hdev)
 677 {
 678         struct sony_sc *sc = hid_get_drvdata(hdev);
 679
 680         cancel_work_sync(&sc->rumble_worker);
 681 }
 682
 683 #else
 684 static int sony_init_ff(struct hid_device *hdev)
 685 {
 686         return 0;
 687 }
 688
 689 static void sony_destroy_ff(struct hid_device *hdev)
 690 {
 691 }
 692 #endif
 693
 694 static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id)
 695 {
 696         int ret;
 697         unsigned long quirks = id->driver_data;
 698         struct sony_sc *sc;
 699         unsigned int connect_mask = HID_CONNECT_DEFAULT;
 700
 701         sc = devm_kzalloc(&hdev->dev, sizeof(*sc), GFP_KERNEL);
 702         if (sc == NULL) {
 703                 hid_err(hdev, "can't alloc sony descriptor\n");
 704                 return -ENOMEM;
 705         }
 706
 707         sc->quirks = quirks;
 708         hid_set_drvdata(hdev, sc);
 709
 710         ret = hid_parse(hdev);
 711         if (ret) {
 712                 hid_err(hdev, "parse failed\n");
 713                 return ret;
 714         }
 715
 716         if (sc->quirks & VAIO_RDESC_CONSTANT)
 717                 connect_mask |= HID_CONNECT_HIDDEV_FORCE;
 718         else if (sc->quirks & SIXAXIS_CONTROLLER_USB)
 719                 connect_mask |= HID_CONNECT_HIDDEV_FORCE;
 720         else if (sc->quirks & SIXAXIS_CONTROLLER_BT)
 721                 connect_mask |= HID_CONNECT_HIDDEV_FORCE;
 722
 723         ret = hid_hw_start(hdev, connect_mask);
 724         if (ret) {
 725                 hid_err(hdev, "hw start failed\n");
 726                 return ret;
 727         }
 728
 729         if (sc->quirks & SIXAXIS_CONTROLLER_USB) {
 730                 hdev->hid_output_raw_report = sixaxis_usb_output_raw_report;
 731                 ret = sixaxis_set_operational_usb(hdev);
 732         }
 733         else if (sc->quirks & SIXAXIS_CONTROLLER_BT)
 734                 ret = sixaxis_set_operational_bt(hdev);
 735         else if (sc->quirks & BUZZ_CONTROLLER)
 736                 ret = buzz_init(hdev);
 737         else
 738                 ret = 0;
 739
 740         if (ret < 0)
 741                 goto err_stop;
 742
 743         ret = sony_init_ff(hdev);
 744         if (ret < 0)
 745                 goto err_stop;
 746
 747         return 0;
 748 err_stop:
 749         hid_hw_stop(hdev);
 750         return ret;
 751 }
 752
 753 static void sony_remove(struct hid_device *hdev)
 754 {
 755         struct sony_sc *sc = hid_get_drvdata(hdev);
 756
 757         if (sc->quirks & BUZZ_CONTROLLER)
 758                 buzz_remove(hdev);
 759
 760         sony_destroy_ff(hdev);
 761
 762         hid_hw_stop(hdev);
 763 }
 764
 765 static const struct hid_device_id sony_devices[] = {
 766         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
 767                 .driver_data = SIXAXIS_CONTROLLER_USB },
 768         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_NAVIGATION_CONTROLLER),
 769                 .driver_data = SIXAXIS_CONTROLLER_USB },
 770         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
 771                 .driver_data = SIXAXIS_CONTROLLER_BT },
 772         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGX_MOUSE),
 773                 .driver_data = VAIO_RDESC_CONSTANT },
 774         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGP_MOUSE),
 775                 .driver_data = VAIO_RDESC_CONSTANT },
 776         /* Wired Buzz Controller. Reported as Sony Hub from its USB ID and as
 777          * Logitech joystick from the device descriptor. */
 778         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_BUZZ_CONTROLLER),
 779                 .driver_data = BUZZ_CONTROLLER },
 780         { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_WIRELESS_BUZZ_CONTROLLER),
 781                 .driver_data = BUZZ_CONTROLLER },
 782         /* PS3 BD Remote Control */
 783         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_BDREMOTE),
 784                 .driver_data = PS3REMOTE },
 785         /* Logitech Harmony Adapter for PS3 */
 786         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_HARMONY_PS3),
 787                 .driver_data = PS3REMOTE },
 788         { }
 789 };
 790 MODULE_DEVICE_TABLE(hid, sony_devices);
 791
 792 static struct hid_driver sony_driver = {
 793         .name          = "sony",
 794         .id_table      = sony_devices,
 795         .input_mapping = sony_mapping,
 796         .probe         = sony_probe,
 797         .remove        = sony_remove,
 798         .report_fixup  = sony_report_fixup,
 799         .raw_event     = sony_raw_event
 800 };
 801 module_hid_driver(sony_driver);
 802
 803 MODULE_LICENSE("GPL");