This patch makes the HP Jornada 6xx touchscreen driver work with tslib (userland touchscreen library) again. The reason for it to stop working was the deletion of tsdev, which it depended on. Changes include : * device driver -> platform_driver. * more error checking at registration time. * more declaration of ABS features. * whitespace cleanups.
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..b44d052 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/sched.h> + #include <asm/io.h> #include <asm/delay.h> #include <asm/adc.h> @@ -9,24 +18,18 @@ #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 - -static void do_softint(struct work_struct *work); +#define PHDR 0xa400012e /* PORT H DATA REGISTER */ +#define SCPDR 0xa4000136 /* PORT SC DATA REGISTER */ -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; int touched = 0; + int x,y; if (ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN) { scpdr = ctrl_inb(SCPDR); @@ -35,7 +38,7 @@ static void do_softint(struct work_struct *work) ctrl_outb(scpdr, SCPDR); udelay(30); - absy = adc_single(ADC_CHANNEL_TS_Y); + y = adc_single(ADC_CHANNEL_TS_Y); scpdr = ctrl_inb(SCPDR); scpdr |= SCPDR_TS_SCAN_Y; @@ -43,7 +46,7 @@ static void do_softint(struct work_struct *work) ctrl_outb(scpdr, SCPDR); udelay(30); - absx = adc_single(ADC_CHANNEL_TS_X); + x = adc_single(ADC_CHANNEL_TS_X); scpdr = ctrl_inb(SCPDR); scpdr |= SCPDR_TS_SCAN_X; @@ -54,76 +57,101 @@ static void do_softint(struct work_struct *work) } 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, x); + input_report_abs(dev, ABS_Y, y); + input_report_abs(dev, ABS_PRESSURE, 1); + input_report_key(dev, BTN_TOUCH, 1); + input_sync(dev); } else { - input_report_key(hp680_ts_dev, BTN_TOUCH, 0); + input_report_abs(dev, ABS_PRESSURE, 0); + input_report_key(dev, BTN_TOUCH, 0); + input_sync(dev); } - - input_sync(hp680_ts_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; + disable_irq_nosync(irq); + schedule_delayed_work(&work, HZ / 20); + return IRQ_HANDLED; } -static int __init hp680_ts_init(void) +static int __init 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); - - 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); - - hp680_ts_dev->name = "HP Jornada touchscreen"; - hp680_ts_dev->phys = "hp680_ts/input0"; - - 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 (!dev) { + printk(KERN_INFO "ts: failed to allocate device\n"); + error = -ENODEV; + return error; } - err = input_register_device(hp680_ts_dev); - if (err) - goto fail2; + 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) | BIT_MASK(ABS_PRESSURE); + 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); + + printk(KERN_INFO "ts: registering device\n"); + error = input_register_device(dev); + if (error) + goto fail2; + + error = request_irq(HP680_TS_IRQ, hp680_ts_interrupt, + IRQF_DISABLED, "HP6xx Touchscreen Driver", NULL); + + if (error) { + printk(KERN_INFO "ts: Unable to aquire irq %d\n", HP680_TS_IRQ); + error = -ENODEV; + goto fail3; + } 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; +} + +static struct platform_driver jornada680_ts_driver = { + .probe = jornada680_ts_probe, + .remove = jornada680_ts_remove, + .driver = { + .name = "jornada_ts", + }, +}; + +static int __devinit 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("Kristoffer Ericson <[EMAIL PROTECTED]>"); +MODULE_DESCRIPTION("HP Jornada 620/660/680/690 touchscreen platform driver"); MODULE_LICENSE("GPL"); -- Kristoffer Ericson <[EMAIL PROTECTED]>