|
@@ -21,6 +21,7 @@
|
|
|
#include <linux/init.h>
|
|
|
#include <linux/input.h>
|
|
|
#include <linux/interrupt.h>
|
|
|
+#include <linux/platform_device.h>
|
|
|
|
|
|
#include <asm/irq.h>
|
|
|
#include <asm/setup.h>
|
|
@@ -34,10 +35,10 @@ MODULE_DESCRIPTION("Amiga mouse driver");
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
static int amimouse_lastx, amimouse_lasty;
|
|
|
-static struct input_dev *amimouse_dev;
|
|
|
|
|
|
-static irqreturn_t amimouse_interrupt(int irq, void *dummy)
|
|
|
+static irqreturn_t amimouse_interrupt(int irq, void *data)
|
|
|
{
|
|
|
+ struct input_dev *dev = data;
|
|
|
unsigned short joy0dat, potgor;
|
|
|
int nx, ny, dx, dy;
|
|
|
|
|
@@ -59,14 +60,14 @@ static irqreturn_t amimouse_interrupt(int irq, void *dummy)
|
|
|
|
|
|
potgor = amiga_custom.potgor;
|
|
|
|
|
|
- input_report_rel(amimouse_dev, REL_X, dx);
|
|
|
- input_report_rel(amimouse_dev, REL_Y, dy);
|
|
|
+ input_report_rel(dev, REL_X, dx);
|
|
|
+ input_report_rel(dev, REL_Y, dy);
|
|
|
|
|
|
- input_report_key(amimouse_dev, BTN_LEFT, ciaa.pra & 0x40);
|
|
|
- input_report_key(amimouse_dev, BTN_MIDDLE, potgor & 0x0100);
|
|
|
- input_report_key(amimouse_dev, BTN_RIGHT, potgor & 0x0400);
|
|
|
+ input_report_key(dev, BTN_LEFT, ciaa.pra & 0x40);
|
|
|
+ input_report_key(dev, BTN_MIDDLE, potgor & 0x0100);
|
|
|
+ input_report_key(dev, BTN_RIGHT, potgor & 0x0400);
|
|
|
|
|
|
- input_sync(amimouse_dev);
|
|
|
+ input_sync(dev);
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
@@ -74,63 +75,90 @@ static irqreturn_t amimouse_interrupt(int irq, void *dummy)
|
|
|
static int amimouse_open(struct input_dev *dev)
|
|
|
{
|
|
|
unsigned short joy0dat;
|
|
|
+ int error;
|
|
|
|
|
|
joy0dat = amiga_custom.joy0dat;
|
|
|
|
|
|
amimouse_lastx = joy0dat & 0xff;
|
|
|
amimouse_lasty = joy0dat >> 8;
|
|
|
|
|
|
- if (request_irq(IRQ_AMIGA_VERTB, amimouse_interrupt, 0, "amimouse", amimouse_interrupt)) {
|
|
|
- printk(KERN_ERR "amimouse.c: Can't allocate irq %d\n", IRQ_AMIGA_VERTB);
|
|
|
- return -EBUSY;
|
|
|
- }
|
|
|
+ error = request_irq(IRQ_AMIGA_VERTB, amimouse_interrupt, 0, "amimouse",
|
|
|
+ dev);
|
|
|
+ if (error)
|
|
|
+ dev_err(&dev->dev, "Can't allocate irq %d\n", IRQ_AMIGA_VERTB);
|
|
|
|
|
|
- return 0;
|
|
|
+ return error;
|
|
|
}
|
|
|
|
|
|
static void amimouse_close(struct input_dev *dev)
|
|
|
{
|
|
|
- free_irq(IRQ_AMIGA_VERTB, amimouse_interrupt);
|
|
|
+ free_irq(IRQ_AMIGA_VERTB, dev);
|
|
|
}
|
|
|
|
|
|
-static int __init amimouse_init(void)
|
|
|
+static int __init amimouse_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
int err;
|
|
|
+ struct input_dev *dev;
|
|
|
|
|
|
- if (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(AMI_MOUSE))
|
|
|
- return -ENODEV;
|
|
|
-
|
|
|
- amimouse_dev = input_allocate_device();
|
|
|
- if (!amimouse_dev)
|
|
|
+ dev = input_allocate_device();
|
|
|
+ if (!dev)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- amimouse_dev->name = "Amiga mouse";
|
|
|
- amimouse_dev->phys = "amimouse/input0";
|
|
|
- amimouse_dev->id.bustype = BUS_AMIGA;
|
|
|
- amimouse_dev->id.vendor = 0x0001;
|
|
|
- amimouse_dev->id.product = 0x0002;
|
|
|
- amimouse_dev->id.version = 0x0100;
|
|
|
+ dev->name = pdev->name;
|
|
|
+ dev->phys = "amimouse/input0";
|
|
|
+ dev->id.bustype = BUS_AMIGA;
|
|
|
+ dev->id.vendor = 0x0001;
|
|
|
+ dev->id.product = 0x0002;
|
|
|
+ dev->id.version = 0x0100;
|
|
|
|
|
|
- amimouse_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
|
|
|
- amimouse_dev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
|
|
|
- amimouse_dev->keybit[BIT_WORD(BTN_LEFT)] = BIT_MASK(BTN_LEFT) |
|
|
|
+ dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
|
|
|
+ dev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
|
|
|
+ dev->keybit[BIT_WORD(BTN_LEFT)] = BIT_MASK(BTN_LEFT) |
|
|
|
BIT_MASK(BTN_MIDDLE) | BIT_MASK(BTN_RIGHT);
|
|
|
- amimouse_dev->open = amimouse_open;
|
|
|
- amimouse_dev->close = amimouse_close;
|
|
|
+ dev->open = amimouse_open;
|
|
|
+ dev->close = amimouse_close;
|
|
|
+ dev->dev.parent = &pdev->dev;
|
|
|
|
|
|
- err = input_register_device(amimouse_dev);
|
|
|
+ err = input_register_device(dev);
|
|
|
if (err) {
|
|
|
- input_free_device(amimouse_dev);
|
|
|
+ input_free_device(dev);
|
|
|
return err;
|
|
|
}
|
|
|
|
|
|
+ platform_set_drvdata(pdev, dev);
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static void __exit amimouse_exit(void)
|
|
|
+static int __exit amimouse_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
- input_unregister_device(amimouse_dev);
|
|
|
+ struct input_dev *dev = platform_get_drvdata(pdev);
|
|
|
+
|
|
|
+ platform_set_drvdata(pdev, NULL);
|
|
|
+ input_unregister_device(dev);
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct platform_driver amimouse_driver = {
|
|
|
+ .remove = __exit_p(amimouse_remove),
|
|
|
+ .driver = {
|
|
|
+ .name = "amiga-mouse",
|
|
|
+ .owner = THIS_MODULE,
|
|
|
+ },
|
|
|
+};
|
|
|
+
|
|
|
+static int __init amimouse_init(void)
|
|
|
+{
|
|
|
+ return platform_driver_probe(&amimouse_driver, amimouse_probe);
|
|
|
}
|
|
|
|
|
|
module_init(amimouse_init);
|
|
|
+
|
|
|
+static void __exit amimouse_exit(void)
|
|
|
+{
|
|
|
+ platform_driver_unregister(&amimouse_driver);
|
|
|
+}
|
|
|
+
|
|
|
module_exit(amimouse_exit);
|
|
|
+
|
|
|
+MODULE_ALIAS("platform:amiga-mouse");
|