Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

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