maplecontrol.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * SEGA Dreamcast controller driver
  4. * Based on drivers/usb/iforce.c
  5. *
  6. * Copyright Yaegashi Takeshi, 2001
  7. * Adrian McMenamin, 2008 - 2009
  8. */
  9. #include <linux/kernel.h>
  10. #include <linux/slab.h>
  11. #include <linux/input.h>
  12. #include <linux/module.h>
  13. #include <linux/init.h>
  14. #include <linux/timer.h>
  15. #include <linux/maple.h>
  16. MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk>");
  17. MODULE_DESCRIPTION("SEGA Dreamcast controller driver");
  18. MODULE_LICENSE("GPL");
  19. struct dc_pad {
  20. struct input_dev *dev;
  21. struct maple_device *mdev;
  22. };
  23. static void dc_pad_callback(struct mapleq *mq)
  24. {
  25. unsigned short buttons;
  26. struct maple_device *mapledev = mq->dev;
  27. struct dc_pad *pad = maple_get_drvdata(mapledev);
  28. struct input_dev *dev = pad->dev;
  29. unsigned char *res = mq->recvbuf->buf;
  30. buttons = ~le16_to_cpup((__le16 *)(res + 8));
  31. input_report_abs(dev, ABS_HAT0Y,
  32. (buttons & 0x0010 ? -1 : 0) + (buttons & 0x0020 ? 1 : 0));
  33. input_report_abs(dev, ABS_HAT0X,
  34. (buttons & 0x0040 ? -1 : 0) + (buttons & 0x0080 ? 1 : 0));
  35. input_report_abs(dev, ABS_HAT1Y,
  36. (buttons & 0x1000 ? -1 : 0) + (buttons & 0x2000 ? 1 : 0));
  37. input_report_abs(dev, ABS_HAT1X,
  38. (buttons & 0x4000 ? -1 : 0) + (buttons & 0x8000 ? 1 : 0));
  39. input_report_key(dev, BTN_C, buttons & 0x0001);
  40. input_report_key(dev, BTN_B, buttons & 0x0002);
  41. input_report_key(dev, BTN_A, buttons & 0x0004);
  42. input_report_key(dev, BTN_START, buttons & 0x0008);
  43. input_report_key(dev, BTN_Z, buttons & 0x0100);
  44. input_report_key(dev, BTN_Y, buttons & 0x0200);
  45. input_report_key(dev, BTN_X, buttons & 0x0400);
  46. input_report_key(dev, BTN_SELECT, buttons & 0x0800);
  47. input_report_abs(dev, ABS_GAS, res[10]);
  48. input_report_abs(dev, ABS_BRAKE, res[11]);
  49. input_report_abs(dev, ABS_X, res[12]);
  50. input_report_abs(dev, ABS_Y, res[13]);
  51. input_report_abs(dev, ABS_RX, res[14]);
  52. input_report_abs(dev, ABS_RY, res[15]);
  53. }
  54. static int dc_pad_open(struct input_dev *dev)
  55. {
  56. struct dc_pad *pad = dev_get_platdata(&dev->dev);
  57. maple_getcond_callback(pad->mdev, dc_pad_callback, HZ/20,
  58. MAPLE_FUNC_CONTROLLER);
  59. return 0;
  60. }
  61. static void dc_pad_close(struct input_dev *dev)
  62. {
  63. struct dc_pad *pad = dev_get_platdata(&dev->dev);
  64. maple_getcond_callback(pad->mdev, dc_pad_callback, 0,
  65. MAPLE_FUNC_CONTROLLER);
  66. }
  67. /* allow the controller to be used */
  68. static int probe_maple_controller(struct device *dev)
  69. {
  70. static const short btn_bit[32] = {
  71. BTN_C, BTN_B, BTN_A, BTN_START, -1, -1, -1, -1,
  72. BTN_Z, BTN_Y, BTN_X, BTN_SELECT, -1, -1, -1, -1,
  73. -1, -1, -1, -1, -1, -1, -1, -1,
  74. -1, -1, -1, -1, -1, -1, -1, -1,
  75. };
  76. static const short abs_bit[32] = {
  77. -1, -1, -1, -1, ABS_HAT0Y, ABS_HAT0Y, ABS_HAT0X, ABS_HAT0X,
  78. -1, -1, -1, -1, ABS_HAT1Y, ABS_HAT1Y, ABS_HAT1X, ABS_HAT1X,
  79. ABS_GAS, ABS_BRAKE, ABS_X, ABS_Y, ABS_RX, ABS_RY, -1, -1,
  80. -1, -1, -1, -1, -1, -1, -1, -1,
  81. };
  82. struct maple_device *mdev = to_maple_dev(dev);
  83. struct maple_driver *mdrv = to_maple_driver(dev->driver);
  84. int i, error;
  85. struct dc_pad *pad;
  86. struct input_dev *idev;
  87. unsigned long data = be32_to_cpu(mdev->devinfo.function_data[0]);
  88. pad = kzalloc(sizeof(struct dc_pad), GFP_KERNEL);
  89. idev = input_allocate_device();
  90. if (!pad || !idev) {
  91. error = -ENOMEM;
  92. goto fail;
  93. }
  94. pad->dev = idev;
  95. pad->mdev = mdev;
  96. idev->open = dc_pad_open;
  97. idev->close = dc_pad_close;
  98. for (i = 0; i < 32; i++) {
  99. if (data & (1 << i)) {
  100. if (btn_bit[i] >= 0)
  101. __set_bit(btn_bit[i], idev->keybit);
  102. else if (abs_bit[i] >= 0)
  103. __set_bit(abs_bit[i], idev->absbit);
  104. }
  105. }
  106. if (idev->keybit[BIT_WORD(BTN_JOYSTICK)])
  107. idev->evbit[0] |= BIT_MASK(EV_KEY);
  108. if (idev->absbit[0])
  109. idev->evbit[0] |= BIT_MASK(EV_ABS);
  110. for (i = ABS_X; i <= ABS_BRAKE; i++)
  111. input_set_abs_params(idev, i, 0, 255, 0, 0);
  112. for (i = ABS_HAT0X; i <= ABS_HAT3Y; i++)
  113. input_set_abs_params(idev, i, 1, -1, 0, 0);
  114. idev->dev.platform_data = pad;
  115. idev->dev.parent = &mdev->dev;
  116. idev->name = mdev->product_name;
  117. idev->id.bustype = BUS_HOST;
  118. error = input_register_device(idev);
  119. if (error)
  120. goto fail;
  121. mdev->driver = mdrv;
  122. maple_set_drvdata(mdev, pad);
  123. return 0;
  124. fail:
  125. input_free_device(idev);
  126. kfree(pad);
  127. maple_set_drvdata(mdev, NULL);
  128. return error;
  129. }
  130. static int remove_maple_controller(struct device *dev)
  131. {
  132. struct maple_device *mdev = to_maple_dev(dev);
  133. struct dc_pad *pad = maple_get_drvdata(mdev);
  134. mdev->callback = NULL;
  135. input_unregister_device(pad->dev);
  136. maple_set_drvdata(mdev, NULL);
  137. kfree(pad);
  138. return 0;
  139. }
  140. static struct maple_driver dc_pad_driver = {
  141. .function = MAPLE_FUNC_CONTROLLER,
  142. .drv = {
  143. .name = "Dreamcast_controller",
  144. .probe = probe_maple_controller,
  145. .remove = remove_maple_controller,
  146. },
  147. };
  148. static int __init dc_pad_init(void)
  149. {
  150. return maple_driver_register(&dc_pad_driver);
  151. }
  152. static void __exit dc_pad_exit(void)
  153. {
  154. maple_driver_unregister(&dc_pad_driver);
  155. }
  156. module_init(dc_pad_init);
  157. module_exit(dc_pad_exit);