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

// SPDX-License-Identifier: GPL-2.0-only
#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 <mach/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(struct work_struct *work);

static struct input_dev *hp680_ts_dev;
static DECLARE_DELAYED_WORK(work, do_softint);

static void do_softint(struct work_struct *work)
{
	int absx = 0, absy = 0;
	u8 scpdr;
	int touched = 0;

	if (__raw_readb(PHDR) & PHDR_TS_PEN_DOWN) {
		scpdr = __raw_readb(SCPDR);
		scpdr |= SCPDR_TS_SCAN_ENABLE;
		scpdr &= ~SCPDR_TS_SCAN_Y;
		__raw_writeb(scpdr, SCPDR);
		udelay(30);

		absy = adc_single(ADC_CHANNEL_TS_Y);

		scpdr = __raw_readb(SCPDR);
		scpdr |= SCPDR_TS_SCAN_Y;
		scpdr &= ~SCPDR_TS_SCAN_X;
		__raw_writeb(scpdr, SCPDR);
		udelay(30);

		absx = adc_single(ADC_CHANNEL_TS_X);

		scpdr = __raw_readb(SCPDR);
		scpdr |= SCPDR_TS_SCAN_X;
		scpdr &= ~SCPDR_TS_SCAN_ENABLE;
		__raw_writeb(scpdr, SCPDR);
		udelay(100);
		touched = __raw_readb(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)
{
	disable_irq_nosync(irq);
	schedule_delayed_work(&work, HZ / 20);

	return IRQ_HANDLED;
}

static int __init hp680_ts_init(void)
{
	int err;

	hp680_ts_dev = input_allocate_device();
	if (!hp680_ts_dev)
		return -ENOMEM;

	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,
			0, MODNAME, NULL) < 0) {
		printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
		       HP680_TS_IRQ);
		err = -EBUSY;
		goto fail1;
	}

	err = input_register_device(hp680_ts_dev);
	if (err)
		goto fail2;

	return 0;

 fail2:	free_irq(HP680_TS_IRQ, NULL);
	cancel_delayed_work_sync(&work);
 fail1:	input_free_device(hp680_ts_dev);
	return err;
}

static void __exit hp680_ts_exit(void)
{
	free_irq(HP680_TS_IRQ, NULL);
	cancel_delayed_work_sync(&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");
Commit	Line	Data
09c434b8	1	// SPDX-License-Identifier: GPL-2.0-only
1da177e4 LT	2	#include <linux/input.h>
	3	#include <linux/module.h>
	4	#include <linux/init.h>
1da177e4 LT	5	#include <linux/interrupt.h>
	6	#include <asm/io.h>
	7	#include <asm/delay.h>
	8	#include <asm/adc.h>
7639a454	9	#include <mach/hp6xx.h>
1da177e4 LT	10
	11	#define MODNAME "hp680_ts_input"
	12
	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
	17
1da177e4 LT	18	#define PHDR 0xa400012e
	19	#define SCPDR 0xa4000136
	20
049fa57c	21	static void do_softint(struct work_struct *work);
1da177e4	22
eca1ed19	23	static struct input_dev *hp680_ts_dev;
049fa57c	24	static DECLARE_DELAYED_WORK(work, do_softint);
1da177e4	25
049fa57c	26	static void do_softint(struct work_struct *work)
1da177e4 LT	27	{
	28	int absx = 0, absy = 0;
	29	u8 scpdr;
	30	int touched = 0;
	31
e28abafb PM	32	if (__raw_readb(PHDR) & PHDR_TS_PEN_DOWN) {
e28abafb PM	33	scpdr = __raw_readb(SCPDR);
1da177e4 LT	34	scpdr \|= SCPDR_TS_SCAN_ENABLE;
1da177e4 LT	35	scpdr &= ~SCPDR_TS_SCAN_Y;
e28abafb	36	__raw_writeb(scpdr, SCPDR);
1da177e4 LT	37	udelay(30);
	38
	39	absy = adc_single(ADC_CHANNEL_TS_Y);
	40
e28abafb	41	scpdr = __raw_readb(SCPDR);
1da177e4 LT	42	scpdr \|= SCPDR_TS_SCAN_Y;
1da177e4 LT	43	scpdr &= ~SCPDR_TS_SCAN_X;
e28abafb	44	__raw_writeb(scpdr, SCPDR);
1da177e4 LT	45	udelay(30);
	46
	47	absx = adc_single(ADC_CHANNEL_TS_X);
	48
e28abafb	49	scpdr = __raw_readb(SCPDR);
1da177e4 LT	50	scpdr \|= SCPDR_TS_SCAN_X;
1da177e4 LT	51	scpdr &= ~SCPDR_TS_SCAN_ENABLE;
e28abafb	52	__raw_writeb(scpdr, SCPDR);
1da177e4	53	udelay(100);
e28abafb	54	touched = __raw_readb(PHDR) & PHDR_TS_PEN_DOWN;
1da177e4 LT	55	}
	56
	57	if (touched) {
eca1ed19 DT	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);
1da177e4	61	} else {
eca1ed19	62	input_report_key(hp680_ts_dev, BTN_TOUCH, 0);
1da177e4 LT	63	}
1da177e4 LT	64
eca1ed19	65	input_sync(hp680_ts_dev);
1da177e4 LT	66	enable_irq(HP680_TS_IRQ);
	67	}
	68
7d12e780	69	static irqreturn_t hp680_ts_interrupt(int irq, void *dev)
1da177e4 LT	70	{
	71	disable_irq_nosync(irq);
	72	schedule_delayed_work(&work, HZ / 20);
	73
	74	return IRQ_HANDLED;
	75	}
	76
	77	static int __init hp680_ts_init(void)
	78	{
52c1f570 DT	79	int err;
52c1f570 DT	80
eca1ed19 DT	81	hp680_ts_dev = input_allocate_device();
	82	if (!hp680_ts_dev)
	83	return -ENOMEM;
1da177e4	84
7b19ada2 JS	85	hp680_ts_dev->evbit[0] = BIT_MASK(EV_ABS) \| BIT_MASK(EV_KEY);
7b19ada2 JS	86	hp680_ts_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
1da177e4	87
52c1f570 DT	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);
1da177e4	92
eca1ed19 DT	93	hp680_ts_dev->name = "HP Jornada touchscreen";
eca1ed19 DT	94	hp680_ts_dev->phys = "hp680_ts/input0";
1da177e4	95
eca1ed19	96	if (request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
b51425be	97	0, MODNAME, NULL) < 0) {
eca1ed19	98	printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
1da177e4	99	HP680_TS_IRQ);
52c1f570 DT	100	err = -EBUSY;
52c1f570 DT	101	goto fail1;
1da177e4 LT	102	}
1da177e4 LT	103
52c1f570 DT	104	err = input_register_device(hp680_ts_dev);
	105	if (err)
	106	goto fail2;
	107
1da177e4	108	return 0;
52c1f570 DT	109
52c1f570 DT	110	fail2: free_irq(HP680_TS_IRQ, NULL);
790d5c8d	111	cancel_delayed_work_sync(&work);
52c1f570 DT	112	fail1: input_free_device(hp680_ts_dev);
52c1f570 DT	113	return err;
1da177e4 LT	114	}
	115
	116	static void __exit hp680_ts_exit(void)
	117	{
52c1f570	118	free_irq(HP680_TS_IRQ, NULL);
790d5c8d	119	cancel_delayed_work_sync(&work);
eca1ed19	120	input_unregister_device(hp680_ts_dev);
1da177e4 LT	121	}
	122
	123	module_init(hp680_ts_init);
	124	module_exit(hp680_ts_exit);
	125
	126	MODULE_AUTHOR("Andriy Skulysh, askulysh@image.kiev.ua");
	127	MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver");
	128	MODULE_LICENSE("GPL");