![Jingoo Han](/assets/img/avatar_default.png)
Use the wrapper function for retrieving the platform data instead of accessing dev->platform_data directly. Signed-off-by: Jingoo Han <jg1.han@samsung.com> Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
194 lines
4.8 KiB
C
194 lines
4.8 KiB
C
/*
|
|
* SEGA Dreamcast controller driver
|
|
* Based on drivers/usb/iforce.c
|
|
*
|
|
* Copyright Yaegashi Takeshi, 2001
|
|
* Adrian McMenamin, 2008 - 2009
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/input.h>
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/maple.h>
|
|
|
|
MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk>");
|
|
MODULE_DESCRIPTION("SEGA Dreamcast controller driver");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
struct dc_pad {
|
|
struct input_dev *dev;
|
|
struct maple_device *mdev;
|
|
};
|
|
|
|
static void dc_pad_callback(struct mapleq *mq)
|
|
{
|
|
unsigned short buttons;
|
|
struct maple_device *mapledev = mq->dev;
|
|
struct dc_pad *pad = maple_get_drvdata(mapledev);
|
|
struct input_dev *dev = pad->dev;
|
|
unsigned char *res = mq->recvbuf->buf;
|
|
|
|
buttons = ~le16_to_cpup((__le16 *)(res + 8));
|
|
|
|
input_report_abs(dev, ABS_HAT0Y,
|
|
(buttons & 0x0010 ? -1 : 0) + (buttons & 0x0020 ? 1 : 0));
|
|
input_report_abs(dev, ABS_HAT0X,
|
|
(buttons & 0x0040 ? -1 : 0) + (buttons & 0x0080 ? 1 : 0));
|
|
input_report_abs(dev, ABS_HAT1Y,
|
|
(buttons & 0x1000 ? -1 : 0) + (buttons & 0x2000 ? 1 : 0));
|
|
input_report_abs(dev, ABS_HAT1X,
|
|
(buttons & 0x4000 ? -1 : 0) + (buttons & 0x8000 ? 1 : 0));
|
|
|
|
input_report_key(dev, BTN_C, buttons & 0x0001);
|
|
input_report_key(dev, BTN_B, buttons & 0x0002);
|
|
input_report_key(dev, BTN_A, buttons & 0x0004);
|
|
input_report_key(dev, BTN_START, buttons & 0x0008);
|
|
input_report_key(dev, BTN_Z, buttons & 0x0100);
|
|
input_report_key(dev, BTN_Y, buttons & 0x0200);
|
|
input_report_key(dev, BTN_X, buttons & 0x0400);
|
|
input_report_key(dev, BTN_SELECT, buttons & 0x0800);
|
|
|
|
input_report_abs(dev, ABS_GAS, res[10]);
|
|
input_report_abs(dev, ABS_BRAKE, res[11]);
|
|
input_report_abs(dev, ABS_X, res[12]);
|
|
input_report_abs(dev, ABS_Y, res[13]);
|
|
input_report_abs(dev, ABS_RX, res[14]);
|
|
input_report_abs(dev, ABS_RY, res[15]);
|
|
}
|
|
|
|
static int dc_pad_open(struct input_dev *dev)
|
|
{
|
|
struct dc_pad *pad = dev_get_platdata(&dev->dev);
|
|
|
|
maple_getcond_callback(pad->mdev, dc_pad_callback, HZ/20,
|
|
MAPLE_FUNC_CONTROLLER);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void dc_pad_close(struct input_dev *dev)
|
|
{
|
|
struct dc_pad *pad = dev_get_platdata(&dev->dev);
|
|
|
|
maple_getcond_callback(pad->mdev, dc_pad_callback, 0,
|
|
MAPLE_FUNC_CONTROLLER);
|
|
}
|
|
|
|
/* allow the controller to be used */
|
|
static int probe_maple_controller(struct device *dev)
|
|
{
|
|
static const short btn_bit[32] = {
|
|
BTN_C, BTN_B, BTN_A, BTN_START, -1, -1, -1, -1,
|
|
BTN_Z, BTN_Y, BTN_X, BTN_SELECT, -1, -1, -1, -1,
|
|
-1, -1, -1, -1, -1, -1, -1, -1,
|
|
-1, -1, -1, -1, -1, -1, -1, -1,
|
|
};
|
|
|
|
static const short abs_bit[32] = {
|
|
-1, -1, -1, -1, ABS_HAT0Y, ABS_HAT0Y, ABS_HAT0X, ABS_HAT0X,
|
|
-1, -1, -1, -1, ABS_HAT1Y, ABS_HAT1Y, ABS_HAT1X, ABS_HAT1X,
|
|
ABS_GAS, ABS_BRAKE, ABS_X, ABS_Y, ABS_RX, ABS_RY, -1, -1,
|
|
-1, -1, -1, -1, -1, -1, -1, -1,
|
|
};
|
|
|
|
struct maple_device *mdev = to_maple_dev(dev);
|
|
struct maple_driver *mdrv = to_maple_driver(dev->driver);
|
|
int i, error;
|
|
struct dc_pad *pad;
|
|
struct input_dev *idev;
|
|
unsigned long data = be32_to_cpu(mdev->devinfo.function_data[0]);
|
|
|
|
pad = kzalloc(sizeof(struct dc_pad), GFP_KERNEL);
|
|
idev = input_allocate_device();
|
|
if (!pad || !idev) {
|
|
error = -ENOMEM;
|
|
goto fail;
|
|
}
|
|
|
|
pad->dev = idev;
|
|
pad->mdev = mdev;
|
|
|
|
idev->open = dc_pad_open;
|
|
idev->close = dc_pad_close;
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
if (data & (1 << i)) {
|
|
if (btn_bit[i] >= 0)
|
|
__set_bit(btn_bit[i], idev->keybit);
|
|
else if (abs_bit[i] >= 0)
|
|
__set_bit(abs_bit[i], idev->absbit);
|
|
}
|
|
}
|
|
|
|
if (idev->keybit[BIT_WORD(BTN_JOYSTICK)])
|
|
idev->evbit[0] |= BIT_MASK(EV_KEY);
|
|
|
|
if (idev->absbit[0])
|
|
idev->evbit[0] |= BIT_MASK(EV_ABS);
|
|
|
|
for (i = ABS_X; i <= ABS_BRAKE; i++)
|
|
input_set_abs_params(idev, i, 0, 255, 0, 0);
|
|
|
|
for (i = ABS_HAT0X; i <= ABS_HAT3Y; i++)
|
|
input_set_abs_params(idev, i, 1, -1, 0, 0);
|
|
|
|
idev->dev.platform_data = pad;
|
|
idev->dev.parent = &mdev->dev;
|
|
idev->name = mdev->product_name;
|
|
idev->id.bustype = BUS_HOST;
|
|
input_set_drvdata(idev, pad);
|
|
|
|
error = input_register_device(idev);
|
|
if (error)
|
|
goto fail;
|
|
|
|
mdev->driver = mdrv;
|
|
maple_set_drvdata(mdev, pad);
|
|
|
|
return 0;
|
|
|
|
fail:
|
|
input_free_device(idev);
|
|
kfree(pad);
|
|
maple_set_drvdata(mdev, NULL);
|
|
return error;
|
|
}
|
|
|
|
static int remove_maple_controller(struct device *dev)
|
|
{
|
|
struct maple_device *mdev = to_maple_dev(dev);
|
|
struct dc_pad *pad = maple_get_drvdata(mdev);
|
|
|
|
mdev->callback = NULL;
|
|
input_unregister_device(pad->dev);
|
|
maple_set_drvdata(mdev, NULL);
|
|
kfree(pad);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct maple_driver dc_pad_driver = {
|
|
.function = MAPLE_FUNC_CONTROLLER,
|
|
.drv = {
|
|
.name = "Dreamcast_controller",
|
|
.probe = probe_maple_controller,
|
|
.remove = remove_maple_controller,
|
|
},
|
|
};
|
|
|
|
static int __init dc_pad_init(void)
|
|
{
|
|
return maple_driver_register(&dc_pad_driver);
|
|
}
|
|
|
|
static void __exit dc_pad_exit(void)
|
|
{
|
|
maple_driver_unregister(&dc_pad_driver);
|
|
}
|
|
|
|
module_init(dc_pad_init);
|
|
module_exit(dc_pad_exit);
|