treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / input / touchscreen / hp680_ts_input.c
blob818f2e48be5a2bf4cef13ebd19716c72a9231268
1 // SPDX-License-Identifier: GPL-2.0-only
2 #include <linux/input.h>
3 #include <linux/module.h>
4 #include <linux/init.h>
5 #include <linux/interrupt.h>
6 #include <asm/io.h>
7 #include <asm/delay.h>
8 #include <asm/adc.h>
9 #include <mach/hp6xx.h>
11 #define MODNAME "hp680_ts_input"
13 #define HP680_TS_ABS_X_MIN 40
14 #define HP680_TS_ABS_X_MAX 950
15 #define HP680_TS_ABS_Y_MIN 80
16 #define HP680_TS_ABS_Y_MAX 910
18 #define PHDR 0xa400012e
19 #define SCPDR 0xa4000136
21 static void do_softint(struct work_struct *work);
23 static struct input_dev *hp680_ts_dev;
24 static DECLARE_DELAYED_WORK(work, do_softint);
26 static void do_softint(struct work_struct *work)
28 int absx = 0, absy = 0;
29 u8 scpdr;
30 int touched = 0;
32 if (__raw_readb(PHDR) & PHDR_TS_PEN_DOWN) {
33 scpdr = __raw_readb(SCPDR);
34 scpdr |= SCPDR_TS_SCAN_ENABLE;
35 scpdr &= ~SCPDR_TS_SCAN_Y;
36 __raw_writeb(scpdr, SCPDR);
37 udelay(30);
39 absy = adc_single(ADC_CHANNEL_TS_Y);
41 scpdr = __raw_readb(SCPDR);
42 scpdr |= SCPDR_TS_SCAN_Y;
43 scpdr &= ~SCPDR_TS_SCAN_X;
44 __raw_writeb(scpdr, SCPDR);
45 udelay(30);
47 absx = adc_single(ADC_CHANNEL_TS_X);
49 scpdr = __raw_readb(SCPDR);
50 scpdr |= SCPDR_TS_SCAN_X;
51 scpdr &= ~SCPDR_TS_SCAN_ENABLE;
52 __raw_writeb(scpdr, SCPDR);
53 udelay(100);
54 touched = __raw_readb(PHDR) & PHDR_TS_PEN_DOWN;
57 if (touched) {
58 input_report_key(hp680_ts_dev, BTN_TOUCH, 1);
59 input_report_abs(hp680_ts_dev, ABS_X, absx);
60 input_report_abs(hp680_ts_dev, ABS_Y, absy);
61 } else {
62 input_report_key(hp680_ts_dev, BTN_TOUCH, 0);
65 input_sync(hp680_ts_dev);
66 enable_irq(HP680_TS_IRQ);
69 static irqreturn_t hp680_ts_interrupt(int irq, void *dev)
71 disable_irq_nosync(irq);
72 schedule_delayed_work(&work, HZ / 20);
74 return IRQ_HANDLED;
77 static int __init hp680_ts_init(void)
79 int err;
81 hp680_ts_dev = input_allocate_device();
82 if (!hp680_ts_dev)
83 return -ENOMEM;
85 hp680_ts_dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
86 hp680_ts_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
88 input_set_abs_params(hp680_ts_dev, ABS_X,
89 HP680_TS_ABS_X_MIN, HP680_TS_ABS_X_MAX, 0, 0);
90 input_set_abs_params(hp680_ts_dev, ABS_Y,
91 HP680_TS_ABS_Y_MIN, HP680_TS_ABS_Y_MAX, 0, 0);
93 hp680_ts_dev->name = "HP Jornada touchscreen";
94 hp680_ts_dev->phys = "hp680_ts/input0";
96 if (request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
97 0, MODNAME, NULL) < 0) {
98 printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
99 HP680_TS_IRQ);
100 err = -EBUSY;
101 goto fail1;
104 err = input_register_device(hp680_ts_dev);
105 if (err)
106 goto fail2;
108 return 0;
110 fail2: free_irq(HP680_TS_IRQ, NULL);
111 cancel_delayed_work_sync(&work);
112 fail1: input_free_device(hp680_ts_dev);
113 return err;
116 static void __exit hp680_ts_exit(void)
118 free_irq(HP680_TS_IRQ, NULL);
119 cancel_delayed_work_sync(&work);
120 input_unregister_device(hp680_ts_dev);
123 module_init(hp680_ts_init);
124 module_exit(hp680_ts_exit);
126 MODULE_AUTHOR("Andriy Skulysh, askulysh@image.kiev.ua");
127 MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver");
128 MODULE_LICENSE("GPL");