hid-sjoy.c 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Force feedback support for SmartJoy PLUS PS2->USB adapter
  4. *
  5. * Copyright (c) 2009 Jussi Kivilinna <jussi.kivilinna@mbnet.fi>
  6. *
  7. * Based of hid-pl.c and hid-gaff.c
  8. * Copyright (c) 2007, 2009 Anssi Hannula <anssi.hannula@gmail.com>
  9. * Copyright (c) 2008 Lukasz Lubojanski <lukasz@lubojanski.info>
  10. */
  11. /*
  12. */
  13. /* #define DEBUG */
  14. #include <linux/input.h>
  15. #include <linux/slab.h>
  16. #include <linux/hid.h>
  17. #include <linux/module.h>
  18. #include "hid-ids.h"
  19. #ifdef CONFIG_SMARTJOYPLUS_FF
  20. struct sjoyff_device {
  21. struct hid_report *report;
  22. };
  23. static int hid_sjoyff_play(struct input_dev *dev, void *data,
  24. struct ff_effect *effect)
  25. {
  26. struct hid_device *hid = input_get_drvdata(dev);
  27. struct sjoyff_device *sjoyff = data;
  28. u32 left, right;
  29. left = effect->u.rumble.strong_magnitude;
  30. right = effect->u.rumble.weak_magnitude;
  31. dev_dbg(&dev->dev, "called with 0x%08x 0x%08x\n", left, right);
  32. left = left * 0xff / 0xffff;
  33. right = (right != 0); /* on/off only */
  34. sjoyff->report->field[0]->value[1] = right;
  35. sjoyff->report->field[0]->value[2] = left;
  36. dev_dbg(&dev->dev, "running with 0x%02x 0x%02x\n", left, right);
  37. hid_hw_request(hid, sjoyff->report, HID_REQ_SET_REPORT);
  38. return 0;
  39. }
  40. static int sjoyff_init(struct hid_device *hid)
  41. {
  42. struct sjoyff_device *sjoyff;
  43. struct hid_report *report;
  44. struct hid_input *hidinput;
  45. struct list_head *report_list =
  46. &hid->report_enum[HID_OUTPUT_REPORT].report_list;
  47. struct list_head *report_ptr = report_list;
  48. struct input_dev *dev;
  49. int error;
  50. if (list_empty(report_list)) {
  51. hid_err(hid, "no output reports found\n");
  52. return -ENODEV;
  53. }
  54. list_for_each_entry(hidinput, &hid->inputs, list) {
  55. report_ptr = report_ptr->next;
  56. if (report_ptr == report_list) {
  57. hid_err(hid, "required output report is missing\n");
  58. return -ENODEV;
  59. }
  60. report = list_entry(report_ptr, struct hid_report, list);
  61. if (report->maxfield < 1) {
  62. hid_err(hid, "no fields in the report\n");
  63. return -ENODEV;
  64. }
  65. if (report->field[0]->report_count < 3) {
  66. hid_err(hid, "not enough values in the field\n");
  67. return -ENODEV;
  68. }
  69. sjoyff = kzalloc(sizeof(struct sjoyff_device), GFP_KERNEL);
  70. if (!sjoyff)
  71. return -ENOMEM;
  72. dev = hidinput->input;
  73. set_bit(FF_RUMBLE, dev->ffbit);
  74. error = input_ff_create_memless(dev, sjoyff, hid_sjoyff_play);
  75. if (error) {
  76. kfree(sjoyff);
  77. return error;
  78. }
  79. sjoyff->report = report;
  80. sjoyff->report->field[0]->value[0] = 0x01;
  81. sjoyff->report->field[0]->value[1] = 0x00;
  82. sjoyff->report->field[0]->value[2] = 0x00;
  83. hid_hw_request(hid, sjoyff->report, HID_REQ_SET_REPORT);
  84. }
  85. hid_info(hid, "Force feedback for SmartJoy PLUS PS2/USB adapter\n");
  86. return 0;
  87. }
  88. #else
  89. static inline int sjoyff_init(struct hid_device *hid)
  90. {
  91. return 0;
  92. }
  93. #endif
  94. static int sjoy_probe(struct hid_device *hdev, const struct hid_device_id *id)
  95. {
  96. int ret;
  97. hdev->quirks |= id->driver_data;
  98. ret = hid_parse(hdev);
  99. if (ret) {
  100. hid_err(hdev, "parse failed\n");
  101. goto err;
  102. }
  103. ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
  104. if (ret) {
  105. hid_err(hdev, "hw start failed\n");
  106. goto err;
  107. }
  108. sjoyff_init(hdev);
  109. return 0;
  110. err:
  111. return ret;
  112. }
  113. static const struct hid_device_id sjoy_devices[] = {
  114. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP_LTD, USB_DEVICE_ID_SUPER_JOY_BOX_3_PRO),
  115. .driver_data = HID_QUIRK_NOGET },
  116. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP_LTD, USB_DEVICE_ID_SUPER_DUAL_BOX_PRO),
  117. .driver_data = HID_QUIRK_MULTI_INPUT | HID_QUIRK_NOGET |
  118. HID_QUIRK_SKIP_OUTPUT_REPORTS },
  119. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP_LTD, USB_DEVICE_ID_SUPER_JOY_BOX_5_PRO),
  120. .driver_data = HID_QUIRK_MULTI_INPUT | HID_QUIRK_NOGET |
  121. HID_QUIRK_SKIP_OUTPUT_REPORTS },
  122. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_SMARTJOY_PLUS) },
  123. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_SUPER_JOY_BOX_3) },
  124. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_DUAL_USB_JOYPAD),
  125. .driver_data = HID_QUIRK_MULTI_INPUT |
  126. HID_QUIRK_SKIP_OUTPUT_REPORTS },
  127. { HID_USB_DEVICE(USB_VENDOR_ID_PLAYDOTCOM, USB_DEVICE_ID_PLAYDOTCOM_EMS_USBII),
  128. .driver_data = HID_QUIRK_MULTI_INPUT |
  129. HID_QUIRK_SKIP_OUTPUT_REPORTS },
  130. { }
  131. };
  132. MODULE_DEVICE_TABLE(hid, sjoy_devices);
  133. static struct hid_driver sjoy_driver = {
  134. .name = "smartjoyplus",
  135. .id_table = sjoy_devices,
  136. .probe = sjoy_probe,
  137. };
  138. module_hid_driver(sjoy_driver);
  139. MODULE_LICENSE("GPL");
  140. MODULE_AUTHOR("Jussi Kivilinna");