| #include <linux/input.h> |
| #include <linux/module.h> |
| #include <linux/init.h> |
| |
| #include <linux/interrupt.h> |
| #include <asm/io.h> |
| #include <asm/delay.h> |
| #include <asm/adc.h> |
| #include <asm/hp6xx/hp6xx.h> |
| |
| #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(void *data); |
| |
| static struct input_dev *hp680_ts_dev; |
| static DECLARE_WORK(work, do_softint, 0); |
| |
| static void do_softint(void *data) |
| { |
| int absx = 0, absy = 0; |
| u8 scpdr; |
| int touched = 0; |
| |
| if (ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN) { |
| scpdr = ctrl_inb(SCPDR); |
| scpdr |= SCPDR_TS_SCAN_ENABLE; |
| scpdr &= ~SCPDR_TS_SCAN_Y; |
| ctrl_outb(scpdr, SCPDR); |
| udelay(30); |
| |
| absy = adc_single(ADC_CHANNEL_TS_Y); |
| |
| scpdr = ctrl_inb(SCPDR); |
| scpdr |= SCPDR_TS_SCAN_Y; |
| scpdr &= ~SCPDR_TS_SCAN_X; |
| ctrl_outb(scpdr, SCPDR); |
| udelay(30); |
| |
| absx = adc_single(ADC_CHANNEL_TS_X); |
| |
| scpdr = ctrl_inb(SCPDR); |
| scpdr |= SCPDR_TS_SCAN_X; |
| scpdr &= ~SCPDR_TS_SCAN_ENABLE; |
| ctrl_outb(scpdr, SCPDR); |
| udelay(100); |
| touched = ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN; |
| } |
| |
| 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); |
| } else { |
| input_report_key(hp680_ts_dev, BTN_TOUCH, 0); |
| } |
| |
| input_sync(hp680_ts_dev); |
| enable_irq(HP680_TS_IRQ); |
| } |
| |
| static irqreturn_t hp680_ts_interrupt(int irq, void *dev, struct pt_regs *regs) |
| { |
| disable_irq_nosync(irq); |
| schedule_delayed_work(&work, HZ / 20); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static int __init hp680_ts_init(void) |
| { |
| hp680_ts_dev = input_allocate_device(); |
| if (!hp680_ts_dev) |
| return -ENOMEM; |
| |
| hp680_ts_dev->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY); |
| hp680_ts_dev->absbit[0] = BIT(ABS_X) | BIT(ABS_Y); |
| hp680_ts_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
| |
| hp680_ts_dev->absmin[ABS_X] = HP680_TS_ABS_X_MIN; |
| hp680_ts_dev->absmin[ABS_Y] = HP680_TS_ABS_Y_MIN; |
| hp680_ts_dev->absmax[ABS_X] = HP680_TS_ABS_X_MAX; |
| hp680_ts_dev->absmax[ABS_Y] = HP680_TS_ABS_Y_MAX; |
| |
| hp680_ts_dev->name = "HP Jornada touchscreen"; |
| hp680_ts_dev->phys = "hp680_ts/input0"; |
| |
| input_register_device(hp680_ts_dev); |
| |
| 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); |
| input_unregister_device(hp680_ts_dev); |
| return -EBUSY; |
| } |
| |
| return 0; |
| } |
| |
| static void __exit hp680_ts_exit(void) |
| { |
| free_irq(HP680_TS_IRQ, 0); |
| cancel_delayed_work(&work); |
| flush_scheduled_work(); |
| input_unregister_device(hp680_ts_dev); |
| } |
| |
| module_init(hp680_ts_init); |
| module_exit(hp680_ts_exit); |
| |
| MODULE_AUTHOR("Andriy Skulysh, askulysh@image.kiev.ua"); |
| MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver"); |
| MODULE_LICENSE("GPL"); |