fedora core 6 1.2949 + vserver 2.2.0

[linux-2.6.git] / drivers / input / touchscreen / mtouch.c

diff --git a/drivers/input/touchscreen/mtouch.c b/drivers/input/touchscreen/mtouch.c
index aa8ee78..c3c2d73 100644 (file)
--- a/drivers/input/touchscreen/mtouch.c
+++ b/drivers/input/touchscreen/mtouch.c
@@ -51,26 +51,23 @@ MODULE_LICENSE("GPL");
 #define MTOUCH_GET_YC(data) (((data[4])<<7) | data[3])
 #define MTOUCH_GET_TOUCHED(data) (MTOUCH_FORMAT_TABLET_TOUCH_BIT & data[0])
 
-static char *mtouch_name = "MicroTouch Serial TouchScreen";
-
 /*
  * Per-touchscreen data.
  */
 
 struct mtouch {
-       struct input_dev dev;
+       struct input_dev *dev;
        struct serio *serio;
        int idx;
        unsigned char data[MTOUCH_MAX_LENGTH];
        char phys[32];
 };
 
-static void mtouch_process_format_tablet(struct mtouch *mtouch, struct pt_regs *regs)
+static void mtouch_process_format_tablet(struct mtouch *mtouch)
 {
-       struct input_dev *dev = &mtouch->dev;
+       struct input_dev *dev = mtouch->dev;
 
        if (MTOUCH_FORMAT_TABLET_LENGTH == ++mtouch->idx) {
-               input_regs(dev, regs);
                input_report_abs(dev, ABS_X, MTOUCH_GET_XC(mtouch->data));
                input_report_abs(dev, ABS_Y, MTOUCH_MAX_YC - MTOUCH_GET_YC(mtouch->data));
                input_report_key(dev, BTN_TOUCH, MTOUCH_GET_TOUCHED(mtouch->data));
@@ -80,7 +77,7 @@ static void mtouch_process_format_tablet(struct mtouch *mtouch, struct pt_regs *
        }
 }
 
-static void mtouch_process_response(struct mtouch *mtouch, struct pt_regs *regs)
+static void mtouch_process_response(struct mtouch *mtouch)
 {
        if (MTOUCH_RESPONSE_END_BYTE == mtouch->data[mtouch->idx++]) {
                /* FIXME - process response */
@@ -92,16 +89,16 @@ static void mtouch_process_response(struct mtouch *mtouch, struct pt_regs *regs)
 }
 
 static irqreturn_t mtouch_interrupt(struct serio *serio,
-               unsigned char data, unsigned int flags, struct pt_regs *regs)
+               unsigned char data, unsigned int flags)
 {
        struct mtouch* mtouch = serio_get_drvdata(serio);
 
        mtouch->data[mtouch->idx] = data;
 
        if (MTOUCH_FORMAT_TABLET_STATUS_BIT & mtouch->data[0])
-               mtouch_process_format_tablet(mtouch, regs);
+               mtouch_process_format_tablet(mtouch);
        else if (MTOUCH_RESPONSE_BEGIN_BYTE == mtouch->data[0])
-               mtouch_process_response(mtouch, regs);
+               mtouch_process_response(mtouch);
        else
                printk(KERN_DEBUG "mtouch.c: unknown/unsynchronized data from device, byte %x\n",mtouch->data[0]);
 
@@ -116,9 +113,11 @@ static void mtouch_disconnect(struct serio *serio)
 {
        struct mtouch* mtouch = serio_get_drvdata(serio);
 
-       input_unregister_device(&mtouch->dev);
+       input_get_device(mtouch->dev);
+       input_unregister_device(mtouch->dev);
        serio_close(serio);
        serio_set_drvdata(serio, NULL);
+       input_put_device(mtouch->dev);
        kfree(mtouch);
 }
 
@@ -131,46 +130,49 @@ static void mtouch_disconnect(struct serio *serio)
 static int mtouch_connect(struct serio *serio, struct serio_driver *drv)
 {
        struct mtouch *mtouch;
+       struct input_dev *input_dev;
        int err;
 
-       if (!(mtouch = kmalloc(sizeof(*mtouch), GFP_KERNEL)))
-               return -ENOMEM;
-
-       memset(mtouch, 0, sizeof(*mtouch));
-
-       init_input_dev(&mtouch->dev);
-       mtouch->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
-       mtouch->dev.keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH);
-
-       input_set_abs_params(&mtouch->dev, ABS_X, MTOUCH_MIN_XC, MTOUCH_MAX_XC, 0, 0);
-       input_set_abs_params(&mtouch->dev, ABS_Y, MTOUCH_MIN_YC, MTOUCH_MAX_YC, 0, 0);
+       mtouch = kzalloc(sizeof(struct mtouch), GFP_KERNEL);
+       input_dev = input_allocate_device();
+       if (!mtouch || !input_dev) {
+               err = -ENOMEM;
+               goto fail1;
+       }
 
        mtouch->serio = serio;
-
-       sprintf(mtouch->phys, "%s/input0", serio->phys);
-
-       mtouch->dev.private = mtouch;
-       mtouch->dev.name = mtouch_name;
-       mtouch->dev.phys = mtouch->phys;
-       mtouch->dev.id.bustype = BUS_RS232;
-       mtouch->dev.id.vendor = SERIO_MICROTOUCH;
-       mtouch->dev.id.product = 0;
-       mtouch->dev.id.version = 0x0100;
+       mtouch->dev = input_dev;
+       snprintf(mtouch->phys, sizeof(mtouch->phys), "%s/input0", serio->phys);
+
+       input_dev->private = mtouch;
+       input_dev->name = "MicroTouch Serial TouchScreen";
+       input_dev->phys = mtouch->phys;
+       input_dev->id.bustype = BUS_RS232;
+       input_dev->id.vendor = SERIO_MICROTOUCH;
+       input_dev->id.product = 0;
+       input_dev->id.version = 0x0100;
+       input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
+       input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH);
+       input_set_abs_params(mtouch->dev, ABS_X, MTOUCH_MIN_XC, MTOUCH_MAX_XC, 0, 0);
+       input_set_abs_params(mtouch->dev, ABS_Y, MTOUCH_MIN_YC, MTOUCH_MAX_YC, 0, 0);
 
        serio_set_drvdata(serio, mtouch);
 
        err = serio_open(serio, drv);
-       if (err) {
-               serio_set_drvdata(serio, NULL);
-               kfree(mtouch);
-               return err;
-       }
-
-       input_register_device(&mtouch->dev);
+       if (err)
+               goto fail2;
 
-       printk(KERN_INFO "input: %s on %s\n", mtouch->dev.name, serio->phys);
+       err = input_register_device(mtouch->dev);
+       if (err)
+               goto fail3;
 
        return 0;
+
+ fail3:        serio_close(serio);
+ fail2:        serio_set_drvdata(serio, NULL);
+ fail1:        input_free_device(input_dev);
+       kfree(mtouch);
+       return err;
 }
 
 /*
@@ -206,8 +208,7 @@ static struct serio_driver mtouch_drv = {
 
 static int __init mtouch_init(void)
 {
-       serio_register_driver(&mtouch_drv);
-       return 0;
+       return serio_register_driver(&mtouch_drv);
 }
 
 static void __exit mtouch_exit(void)