git://git.onelab.eu / linux-2.6.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
Fedora kernel-2.6.17-1.2142_FC4 patched with stable patch-2.6.17.4-vs2.0.2-rc26.diff
[linux-2.6.git] / drivers / input / mouse / sermouse.c
diff --git a/drivers/input/mouse/sermouse.c b/drivers/input/mouse/sermouse.c
index a69ffed..2f9a04a 100644 (file)
--- a/drivers/input/mouse/sermouse.c
+++ b/drivers/input/mouse/sermouse.c
@@ -48,7 +48,7 @@ static char *sermouse_protocols[] = { "None", "Mouse Systems Mouse", "Sun Mouse"
                                        "Logitech MZ++ Mouse"};
 
 struct sermouse {
-       struct input_dev dev;
+       struct input_dev *dev;
        signed char buf[8];
        unsigned char count;
        unsigned char type;
@@ -64,7 +64,7 @@ struct sermouse {
 
 static void sermouse_process_msc(struct sermouse *sermouse, signed char data, struct pt_regs *regs)
 {
-       struct input_dev *dev = &sermouse->dev;
+       struct input_dev *dev = sermouse->dev;
        signed char *buf = sermouse->buf;
 
        input_regs(dev, regs);
@@ -95,7 +95,7 @@ static void sermouse_process_msc(struct sermouse *sermouse, signed char data, st
 
        input_sync(dev);
 
-       if (++sermouse->count == (5 - ((sermouse->type == SERIO_SUN) << 1)))
+       if (++sermouse->count == 5)
                sermouse->count = 0;
 }
 
@@ -107,7 +107,7 @@ static void sermouse_process_msc(struct sermouse *sermouse, signed char data, st
 
 static void sermouse_process_ms(struct sermouse *sermouse, signed char data, struct pt_regs *regs)
 {
-       struct input_dev *dev = &sermouse->dev;
+       struct input_dev *dev = sermouse->dev;
        signed char *buf = sermouse->buf;
 
        if (data & 0x40) sermouse->count = 0;
@@ -209,7 +209,7 @@ static void sermouse_process_ms(struct sermouse *sermouse, signed char data, str
 static irqreturn_t sermouse_interrupt(struct serio *serio,
                unsigned char data, unsigned int flags, struct pt_regs *regs)
 {
-       struct sermouse *sermouse = serio->private;
+       struct sermouse *sermouse = serio_get_drvdata(serio);
 
        if (time_after(jiffies, sermouse->last + HZ/10)) sermouse->count = 0;
        sermouse->last = jiffies;
@@ -228,9 +228,11 @@ static irqreturn_t sermouse_interrupt(struct serio *serio,
 
 static void sermouse_disconnect(struct serio *serio)
 {
-       struct sermouse *sermouse = serio->private;
-       input_unregister_device(&sermouse->dev);
+       struct sermouse *sermouse = serio_get_drvdata(serio);
+
        serio_close(serio);
+       serio_set_drvdata(serio, NULL);
+       input_unregister_device(sermouse->dev);
        kfree(sermouse);
 }
 
@@ -239,76 +241,123 @@ static void sermouse_disconnect(struct serio *serio)
  * an unhandled serio port is found.
  */
 
-static void sermouse_connect(struct serio *serio, struct serio_driver *drv)
+static int sermouse_connect(struct serio *serio, struct serio_driver *drv)
 {
        struct sermouse *sermouse;
-       unsigned char c;
+       struct input_dev *input_dev;
+       unsigned char c = serio->id.extra;
+       int err = -ENOMEM;
 
-       if ((serio->type & SERIO_TYPE) != SERIO_RS232)
-               return;
+       sermouse = kzalloc(sizeof(struct sermouse), GFP_KERNEL);
+       input_dev = input_allocate_device();
+       if (!sermouse || !input_dev)
+               goto fail;
 
-       if (!(serio->type & SERIO_PROTO) || ((serio->type & SERIO_PROTO) > SERIO_MZPP))
-               return;
+       sermouse->dev = input_dev;
+       sprintf(sermouse->phys, "%s/input0", serio->phys);
+       sermouse->type = serio->id.proto;
 
-       if (!(sermouse = kmalloc(sizeof(struct sermouse), GFP_KERNEL)))
-               return;
+       input_dev->name = sermouse_protocols[sermouse->type];
+       input_dev->phys = sermouse->phys;
+       input_dev->id.bustype = BUS_RS232;
+       input_dev->id.vendor  = sermouse->type;
+       input_dev->id.product = c;
+       input_dev->id.version = 0x0100;
+       input_dev->cdev.dev = &serio->dev;
 
-       memset(sermouse, 0, sizeof(struct sermouse));
+       input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL);
+       input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT);
+       input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y);
+       input_dev->private = sermouse;
 
-       init_input_dev(&sermouse->dev);
-       sermouse->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_REL);
-       sermouse->dev.keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT);
-       sermouse->dev.relbit[0] = BIT(REL_X) | BIT(REL_Y);
-       sermouse->dev.private = sermouse;
+       if (c & 0x01) set_bit(BTN_MIDDLE, input_dev->keybit);
+       if (c & 0x02) set_bit(BTN_SIDE, input_dev->keybit);
+       if (c & 0x04) set_bit(BTN_EXTRA, input_dev->keybit);
+       if (c & 0x10) set_bit(REL_WHEEL, input_dev->relbit);
+       if (c & 0x20) set_bit(REL_HWHEEL, input_dev->relbit);
 
-       serio->private = sermouse;
+       serio_set_drvdata(serio, sermouse);
 
-       sermouse->type = serio->type & SERIO_PROTO;
-       c = (serio->type & SERIO_EXTRA) >> 16;
+       err = serio_open(serio, drv);
+       if (err)
+               goto fail;
 
-       if (c & 0x01) set_bit(BTN_MIDDLE, sermouse->dev.keybit);
-       if (c & 0x02) set_bit(BTN_SIDE, sermouse->dev.keybit);
-       if (c & 0x04) set_bit(BTN_EXTRA, sermouse->dev.keybit);
-       if (c & 0x10) set_bit(REL_WHEEL, sermouse->dev.relbit);
-       if (c & 0x20) set_bit(REL_HWHEEL, sermouse->dev.relbit);
+       input_register_device(sermouse->dev);
 
-       sprintf(sermouse->phys, "%s/input0", serio->phys);
+       return 0;
 
-       sermouse->dev.name = sermouse_protocols[sermouse->type];
-       sermouse->dev.phys = sermouse->phys;
-       sermouse->dev.id.bustype = BUS_RS232;
-       sermouse->dev.id.vendor = sermouse->type;
-       sermouse->dev.id.product = c;
-       sermouse->dev.id.version = 0x0100;
-       sermouse->dev.dev = &serio->dev;
-
-       if (serio_open(serio, drv)) {
-               kfree(sermouse);
-               return;
-       }
+ fail: serio_set_drvdata(serio, NULL);
+       input_free_device(input_dev);
+       kfree(sermouse);
+       return err;
+}
 
-       input_register_device(&sermouse->dev);
+static struct serio_device_id sermouse_serio_ids[] = {
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MSC,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_SUN,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MS,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MP,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MZ,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MZP,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       {
+               .type   = SERIO_RS232,
+               .proto  = SERIO_MZPP,
+               .id     = SERIO_ANY,
+               .extra  = SERIO_ANY,
+       },
+       { 0 }
+};
 
-       printk(KERN_INFO "input: %s on %s\n", sermouse_protocols[sermouse->type], serio->phys);
-}
+MODULE_DEVICE_TABLE(serio, sermouse_serio_ids);
 
 static struct serio_driver sermouse_drv = {
        .driver         = {
                .name   = "sermouse",
        },
        .description    = DRIVER_DESC,
+       .id_table       = sermouse_serio_ids,
        .interrupt      = sermouse_interrupt,
        .connect        = sermouse_connect,
        .disconnect     = sermouse_disconnect,
 };
 
-int __init sermouse_init(void)
+static int __init sermouse_init(void)
 {
        serio_register_driver(&sermouse_drv);
        return 0;
 }
 
-void __exit sermouse_exit(void)
+static void __exit sermouse_exit(void)
 {
        serio_unregister_driver(&sermouse_drv);
 }
linux-2.6