This patch updates the hp jornada 6xx touchscreen driver to work properly,
essentially this brings the driver more inline with other drivers.

The changes include :
* change to platform driver
* proper ABS_X/ABS_Y values now that tsdev has been removed
* additional error reporting
* fix broken work queue handling
* random tidying

Signed-off-by: Kristoffer Ericson <[EMAIL PROTECTED]>

diff --git a/drivers/input/touchscreen/hp680_ts_input.c 
b/drivers/input/touchscreen/hp680_ts_input.c
index c38d4e0..2fb53c0 100644
--- a/drivers/input/touchscreen/hp680_ts_input.c
+++ b/drivers/input/touchscreen/hp680_ts_input.c
@@ -1,7 +1,16 @@
+/*
+ * Platform driver for the HP Jornada 620/660/680/690 Touchscreen.
+ *
+ * Copyright 2008 Kristoffer Ericson <[EMAIL PROTECTED]>
+ *  Copyright ...-2007 Andriy Skulysh <[EMAIL PROTECTED]>
+ */
 #include <linux/input.h>
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/interrupt.h>
+#include <linux/platform_device.h>
+#include <linux/workqueue.h>
+
 #include <asm/io.h>
 #include <asm/delay.h>
 #include <asm/adc.h>
@@ -9,20 +18,14 @@
 
 #define MODNAME "hp680_ts_input"
 
-#define HP680_TS_ABS_X_MIN     40
-#define HP680_TS_ABS_X_MAX     950
-#define HP680_TS_ABS_Y_MIN     80
-#define HP680_TS_ABS_Y_MAX     910
-
-#define        PHDR    0xa400012e
-#define SCPDR  0xa4000136
+#define        PHDR    0xa400012e      /* PORT H  DATA REGISTER */
+#define SCPDR  0xa4000136      /* PORT SC DATA REGISTER */
 
-static void do_softint(struct work_struct *work);
-
-static struct input_dev *hp680_ts_dev;
+struct input_dev *dev;
+static void do_softint(struct delayed_work *work);
 static DECLARE_DELAYED_WORK(work, do_softint);
 
-static void do_softint(struct work_struct *work)
+static void do_softint(struct delayed_work *work)
 {
        int absx = 0, absy = 0;
        u8 scpdr;
@@ -53,77 +56,104 @@ static void do_softint(struct work_struct *work)
                touched = ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN;
        }
 
+
+       /* note, tslib currently expects ABS_PRESSURE also */
        if (touched) {
-               input_report_key(hp680_ts_dev, BTN_TOUCH, 1);
-               input_report_abs(hp680_ts_dev, ABS_X, absx);
-               input_report_abs(hp680_ts_dev, ABS_Y, absy);
+               input_report_abs(dev, ABS_X, absx);
+               input_report_abs(dev, ABS_Y, absy);
+               input_report_key(dev, BTN_TOUCH, 1);
        } else {
-               input_report_key(hp680_ts_dev, BTN_TOUCH, 0);
+               input_report_key(dev, BTN_TOUCH, 0);
        }
-
-       input_sync(hp680_ts_dev);
+       input_sync(dev);
        enable_irq(HP680_TS_IRQ);
 }
 
-static irqreturn_t hp680_ts_interrupt(int irq, void *dev)
+static irqreturn_t hp680_ts_interrupt(int irq, void *pdev)
 {
        disable_irq_nosync(irq);
        schedule_delayed_work(&work, HZ / 20);
-
        return IRQ_HANDLED;
 }
 
-static int __init hp680_ts_init(void)
+static int __devinit jornada680_ts_probe(struct platform_device *pdev)
 {
-       int err;
+       int error;
 
-       hp680_ts_dev = input_allocate_device();
-       if (!hp680_ts_dev)
-               return -ENOMEM;
+       dev = input_allocate_device();
 
-       hp680_ts_dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
-       hp680_ts_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
+       if (!dev) {
+               printk(KERN_INFO "ts: failed to allocate device\n");
+               error = -ENODEV;
+               return error;
+       }
 
-       input_set_abs_params(hp680_ts_dev, ABS_X,
-               HP680_TS_ABS_X_MIN, HP680_TS_ABS_X_MAX, 0, 0);
-       input_set_abs_params(hp680_ts_dev, ABS_Y,
-               HP680_TS_ABS_Y_MIN, HP680_TS_ABS_Y_MAX, 0, 0);
+       dev->name = "HP Jornada 6xx Touchscreen";
+       dev->phys = "jornadats/input0";
+       dev->id.bustype = BUS_HOST;
+       dev->dev.parent = &pdev->dev;
+       dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
+       dev->absbit[0] = BIT_MASK(ABS_X) | BIT_MASK(ABS_Y);
+       dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
+       input_set_abs_params(dev, ABS_X, 40, 950, 0, 0);
+       input_set_abs_params(dev, ABS_Y, 80, 910, 0, 0);
+
+       error = input_register_device(dev);
+       if (error) {
+               printk(KERN_ERR "ts: failed to register device\n");
+               goto fail2;
+       }
 
-       hp680_ts_dev->name = "HP Jornada touchscreen";
-       hp680_ts_dev->phys = "hp680_ts/input0";
+       error = request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
+                       IRQF_DISABLED, "HP6xx Touchscreen driver", NULL);
 
-       if (request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
-                       IRQF_DISABLED, MODNAME, 0) < 0) {
-               printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
-                      HP680_TS_IRQ);
-               err = -EBUSY;
-               goto fail1;
+       if (error) {
+               printk(KERN_INFO "ts: unable to aquire irq\n");
+               goto fail3;
        }
 
-       err = input_register_device(hp680_ts_dev);
-       if (err)
-               goto fail2;
-
        return 0;
 
- fail2:        free_irq(HP680_TS_IRQ, NULL);
-       cancel_delayed_work(&work);
-       flush_scheduled_work();
- fail1:        input_free_device(hp680_ts_dev);
-       return err;
+fail3:
+               input_unregister_device(dev);
+fail2:
+               input_free_device(dev);
+       return error;
 }
 
-static void __exit hp680_ts_exit(void)
+static int __devexit jornada680_ts_remove(struct platform_device *pdev)
 {
-       free_irq(HP680_TS_IRQ, NULL);
        cancel_delayed_work(&work);
        flush_scheduled_work();
-       input_unregister_device(hp680_ts_dev);
+       free_irq(HP680_TS_IRQ, pdev);
+       input_unregister_device(dev);
+       return 0;
+}
+
+/* work with hotplug and coldplug */
+MODULE_ALIAS("platform:jornada_ts");
+
+static struct platform_driver jornada680_ts_driver = {
+       .probe  = jornada680_ts_probe,
+       .remove = jornada680_ts_remove,
+       .driver = {
+               .name = "jornada_ts",
+               .owner= THIS_MODULE,
+       },
+};
+
+static int __init hp680_ts_init(void)
+{
+       return platform_driver_register(&jornada680_ts_driver);
 }
 
+static void __exit hp680_ts_exit(void)
+{
+       platform_driver_unregister(&jornada680_ts_driver);
+}
 module_init(hp680_ts_init);
 module_exit(hp680_ts_exit);
 
-MODULE_AUTHOR("Andriy Skulysh, [EMAIL PROTECTED]");
-MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver");
+MODULE_AUTHOR("Andriy Skulysh <[EMAIL PROTECTED]>, Kristoffer Ericson <[EMAIL 
PROTECTED]>");
+MODULE_DESCRIPTION("HP Jornada 6xx touchscreen driver");
 MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/hp680_ts_input.c 
b/drivers/input/touchscreen/hp680_ts_input.c
index c38d4e0..92a4a08 100644
--- a/drivers/input/touchscreen/hp680_ts_input.c
+++ b/drivers/input/touchscreen/hp680_ts_input.c
@@ -1,7 +1,16 @@
+/*
+ * Platform driver for the HP Jornada 620/660/680/690 Touchscreen.
+ *
+ * Copyright 2008 Kristoffer Ericson <[EMAIL PROTECTED]>
+ *  Copyright ...-2007 Andriy Skulysh <[EMAIL PROTECTED]>
+ */
 #include <linux/input.h>
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/interrupt.h>
+#include <linux/platform_device.h>
+#include <linux/workqueue.h>
+
 #include <asm/io.h>
 #include <asm/delay.h>
 #include <asm/adc.h>
@@ -9,20 +18,14 @@
 
 #define MODNAME "hp680_ts_input"
 
-#define HP680_TS_ABS_X_MIN     40
-#define HP680_TS_ABS_X_MAX     950
-#define HP680_TS_ABS_Y_MIN     80
-#define HP680_TS_ABS_Y_MAX     910
-
-#define        PHDR    0xa400012e
-#define SCPDR  0xa4000136
+#define        PHDR    0xa400012e      /* PORT H  DATA REGISTER */
+#define SCPDR  0xa4000136      /* PORT SC DATA REGISTER */
 
-static void do_softint(struct work_struct *work);
-
-static struct input_dev *hp680_ts_dev;
+struct input_dev *dev;
+static void do_softint(struct delayed_work *work);
 static DECLARE_DELAYED_WORK(work, do_softint);
 
-static void do_softint(struct work_struct *work)
+static void do_softint(struct delayed_work *work)
 {
        int absx = 0, absy = 0;
        u8 scpdr;
@@ -53,77 +56,104 @@ static void do_softint(struct work_struct *work)
                touched = ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN;
        }
 
+
+       /* note, tslib currently expects ABS_PRESSURE also */
        if (touched) {
-               input_report_key(hp680_ts_dev, BTN_TOUCH, 1);
-               input_report_abs(hp680_ts_dev, ABS_X, absx);
-               input_report_abs(hp680_ts_dev, ABS_Y, absy);
+               input_report_abs(dev, ABS_X, absx);
+               input_report_abs(dev, ABS_Y, absy);
+               input_report_key(dev, BTN_TOUCH, 1);
        } else {
-               input_report_key(hp680_ts_dev, BTN_TOUCH, 0);
+               input_report_key(dev, BTN_TOUCH, 0);
        }
-
-       input_sync(hp680_ts_dev);
+       input_sync(dev);
        enable_irq(HP680_TS_IRQ);
 }
 
-static irqreturn_t hp680_ts_interrupt(int irq, void *dev)
+static irqreturn_t hp680_ts_interrupt(int irq, void *pdev)
 {
        disable_irq_nosync(irq);
        schedule_delayed_work(&work, HZ / 20);
-
        return IRQ_HANDLED;
 }
 
-static int __init hp680_ts_init(void)
+static int __devinit jornada680_ts_probe(struct platform_device *pdev)
 {
-       int err;
+       int error;
 
-       hp680_ts_dev = input_allocate_device();
-       if (!hp680_ts_dev)
-               return -ENOMEM;
+       dev = input_allocate_device();
 
-       hp680_ts_dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
-       hp680_ts_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
+       if (!dev) {
+               printk(KERN_ERR "ts: failed to allocate device\n");
+               error = -ENODEV;
+               return error;
+       }
 
-       input_set_abs_params(hp680_ts_dev, ABS_X,
-               HP680_TS_ABS_X_MIN, HP680_TS_ABS_X_MAX, 0, 0);
-       input_set_abs_params(hp680_ts_dev, ABS_Y,
-               HP680_TS_ABS_Y_MIN, HP680_TS_ABS_Y_MAX, 0, 0);
+       dev->name = "HP Jornada 6xx Touchscreen";
+       dev->phys = "jornadats/input0";
+       dev->id.bustype = BUS_HOST;
+       dev->dev.parent = &pdev->dev;
+       dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
+       dev->absbit[0] = BIT_MASK(ABS_X) | BIT_MASK(ABS_Y);
+       dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
+       input_set_abs_params(dev, ABS_X, 40, 950, 0, 0);
+       input_set_abs_params(dev, ABS_Y, 80, 910, 0, 0);
+
+       error = input_register_device(dev);
+       if (error) {
+               printk(KERN_ERR "ts: failed to register device\n");
+               goto fail2;
+       }
 
-       hp680_ts_dev->name = "HP Jornada touchscreen";
-       hp680_ts_dev->phys = "hp680_ts/input0";
+       error = request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
+                       IRQF_DISABLED, "HP6xx Touchscreen driver", NULL);
 
-       if (request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
-                       IRQF_DISABLED, MODNAME, 0) < 0) {
-               printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
-                      HP680_TS_IRQ);
-               err = -EBUSY;
-               goto fail1;
+       if (error) {
+               printk(KERN_ERR "ts: unable to aquire irq\n");
+               goto fail3;
        }
 
-       err = input_register_device(hp680_ts_dev);
-       if (err)
-               goto fail2;
-
        return 0;
 
- fail2:        free_irq(HP680_TS_IRQ, NULL);
-       cancel_delayed_work(&work);
-       flush_scheduled_work();
- fail1:        input_free_device(hp680_ts_dev);
-       return err;
+fail3:
+               input_unregister_device(dev);
+fail2:
+               input_free_device(dev);
+       return error;
 }
 
-static void __exit hp680_ts_exit(void)
+static int __devexit jornada680_ts_remove(struct platform_device *pdev)
 {
-       free_irq(HP680_TS_IRQ, NULL);
        cancel_delayed_work(&work);
        flush_scheduled_work();
-       input_unregister_device(hp680_ts_dev);
+       free_irq(HP680_TS_IRQ, pdev);
+       input_unregister_device(dev);
+       return 0;
+}
+
+/* work with hotplug and coldplug */
+MODULE_ALIAS("platform:jornada_ts");
+
+static struct platform_driver jornada680_ts_driver = {
+       .probe  = jornada680_ts_probe,
+       .remove = jornada680_ts_remove,
+       .driver = {
+               .name = "jornada_ts",
+               .owner= THIS_MODULE,
+       },
+};
+
+static int __init hp680_ts_init(void)
+{
+       return platform_driver_register(&jornada680_ts_driver);
 }
 
+static void __exit hp680_ts_exit(void)
+{
+       platform_driver_unregister(&jornada680_ts_driver);
+}
 module_init(hp680_ts_init);
 module_exit(hp680_ts_exit);
 
-MODULE_AUTHOR("Andriy Skulysh, [EMAIL PROTECTED]");
-MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver");
+MODULE_AUTHOR("Andriy Skulysh <[EMAIL PROTECTED]>, Kristoffer Ericson <[EMAIL 
PROTECTED]>");
+MODULE_DESCRIPTION("HP Jornada 6xx touchscreen driver");
 MODULE_LICENSE("GPL");

Reply via email to