added 2.6.29.6 aldebaran kernel
[nao-ulib.git] / kernel / 2.6.29.6-aldebaran-rt / drivers / input / touchscreen / htcpen.c
blob1aff4e76d59b07ade20db765393444fe855c8ba9
1 /*
2 * HTC Shift touchscreen driver
4 * Copyright (C) 2008 Pau Oliva Fora <pof@eslack.org>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License version 2 as published
8 * by the Free Software Foundation.
9 */
11 #include <linux/errno.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/input.h>
15 #include <linux/interrupt.h>
16 #include <linux/io.h>
17 #include <linux/init.h>
18 #include <linux/irq.h>
19 #include <linux/isa.h>
20 #include <linux/ioport.h>
21 #include <linux/dmi.h>
23 MODULE_AUTHOR("Pau Oliva Fora <pau@eslack.org>");
24 MODULE_DESCRIPTION("HTC Shift touchscreen driver");
25 MODULE_LICENSE("GPL");
27 #define HTCPEN_PORT_IRQ_CLEAR 0x068
28 #define HTCPEN_PORT_INIT 0x06c
29 #define HTCPEN_PORT_INDEX 0x0250
30 #define HTCPEN_PORT_DATA 0x0251
31 #define HTCPEN_IRQ 3
33 #define DEVICE_ENABLE 0xa2
34 #define DEVICE_DISABLE 0xa3
36 #define X_INDEX 3
37 #define Y_INDEX 5
38 #define TOUCH_INDEX 0xb
39 #define LSB_XY_INDEX 0xc
40 #define X_AXIS_MAX 2040
41 #define Y_AXIS_MAX 2040
43 static int invert_x;
44 module_param(invert_x, bool, 0644);
45 MODULE_PARM_DESC(invert_x, "If set, X axis is inverted");
46 static int invert_y;
47 module_param(invert_y, bool, 0644);
48 MODULE_PARM_DESC(invert_y, "If set, Y axis is inverted");
50 static irqreturn_t htcpen_interrupt(int irq, void *handle)
52 struct input_dev *htcpen_dev = handle;
53 unsigned short x, y, xy;
55 /* 0 = press; 1 = release */
56 outb_p(TOUCH_INDEX, HTCPEN_PORT_INDEX);
58 if (inb_p(HTCPEN_PORT_DATA)) {
59 input_report_key(htcpen_dev, BTN_TOUCH, 0);
60 } else {
61 outb_p(X_INDEX, HTCPEN_PORT_INDEX);
62 x = inb_p(HTCPEN_PORT_DATA);
64 outb_p(Y_INDEX, HTCPEN_PORT_INDEX);
65 y = inb_p(HTCPEN_PORT_DATA);
67 outb_p(LSB_XY_INDEX, HTCPEN_PORT_INDEX);
68 xy = inb_p(HTCPEN_PORT_DATA);
70 /* get high resolution value of X and Y using LSB */
71 x = X_AXIS_MAX - ((x * 8) + ((xy >> 4) & 0xf));
72 y = (y * 8) + (xy & 0xf);
73 if (invert_x)
74 x = X_AXIS_MAX - x;
75 if (invert_y)
76 y = Y_AXIS_MAX - y;
78 if (x != X_AXIS_MAX && x != 0) {
79 input_report_key(htcpen_dev, BTN_TOUCH, 1);
80 input_report_abs(htcpen_dev, ABS_X, x);
81 input_report_abs(htcpen_dev, ABS_Y, y);
85 input_sync(htcpen_dev);
87 inb_p(HTCPEN_PORT_IRQ_CLEAR);
89 return IRQ_HANDLED;
92 static int htcpen_open(struct input_dev *dev)
94 outb_p(DEVICE_ENABLE, HTCPEN_PORT_INIT);
96 return 0;
99 static void htcpen_close(struct input_dev *dev)
101 outb_p(DEVICE_DISABLE, HTCPEN_PORT_INIT);
102 synchronize_irq(HTCPEN_IRQ);
105 static int __devinit htcpen_isa_probe(struct device *dev, unsigned int id)
107 struct input_dev *htcpen_dev;
108 int err = -EBUSY;
110 if (!request_region(HTCPEN_PORT_IRQ_CLEAR, 1, "htcpen")) {
111 printk(KERN_ERR "htcpen: unable to get IO region 0x%x\n",
112 HTCPEN_PORT_IRQ_CLEAR);
113 goto request_region1_failed;
116 if (!request_region(HTCPEN_PORT_INIT, 1, "htcpen")) {
117 printk(KERN_ERR "htcpen: unable to get IO region 0x%x\n",
118 HTCPEN_PORT_INIT);
119 goto request_region2_failed;
122 if (!request_region(HTCPEN_PORT_INDEX, 2, "htcpen")) {
123 printk(KERN_ERR "htcpen: unable to get IO region 0x%x\n",
124 HTCPEN_PORT_INDEX);
125 goto request_region3_failed;
128 htcpen_dev = input_allocate_device();
129 if (!htcpen_dev) {
130 printk(KERN_ERR "htcpen: can't allocate device\n");
131 err = -ENOMEM;
132 goto input_alloc_failed;
135 htcpen_dev->name = "HTC Shift EC TouchScreen";
136 htcpen_dev->id.bustype = BUS_ISA;
138 htcpen_dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
139 htcpen_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
140 input_set_abs_params(htcpen_dev, ABS_X, 0, X_AXIS_MAX, 0, 0);
141 input_set_abs_params(htcpen_dev, ABS_Y, 0, Y_AXIS_MAX, 0, 0);
143 htcpen_dev->open = htcpen_open;
144 htcpen_dev->close = htcpen_close;
146 err = request_irq(HTCPEN_IRQ, htcpen_interrupt, 0, "htcpen",
147 htcpen_dev);
148 if (err) {
149 printk(KERN_ERR "htcpen: irq busy\n");
150 goto request_irq_failed;
153 inb_p(HTCPEN_PORT_IRQ_CLEAR);
155 err = input_register_device(htcpen_dev);
156 if (err)
157 goto input_register_failed;
159 dev_set_drvdata(dev, htcpen_dev);
161 return 0;
163 input_register_failed:
164 free_irq(HTCPEN_IRQ, htcpen_dev);
165 request_irq_failed:
166 input_free_device(htcpen_dev);
167 input_alloc_failed:
168 release_region(HTCPEN_PORT_INDEX, 2);
169 request_region3_failed:
170 release_region(HTCPEN_PORT_INIT, 1);
171 request_region2_failed:
172 release_region(HTCPEN_PORT_IRQ_CLEAR, 1);
173 request_region1_failed:
174 return err;
177 static int __devexit htcpen_isa_remove(struct device *dev, unsigned int id)
179 struct input_dev *htcpen_dev = dev_get_drvdata(dev);
181 input_unregister_device(htcpen_dev);
183 free_irq(HTCPEN_IRQ, htcpen_dev);
185 release_region(HTCPEN_PORT_INDEX, 2);
186 release_region(HTCPEN_PORT_INIT, 1);
187 release_region(HTCPEN_PORT_IRQ_CLEAR, 1);
189 dev_set_drvdata(dev, NULL);
191 return 0;
194 #ifdef CONFIG_PM
195 static int htcpen_isa_suspend(struct device *dev, unsigned int n,
196 pm_message_t state)
198 outb_p(DEVICE_DISABLE, HTCPEN_PORT_INIT);
200 return 0;
203 static int htcpen_isa_resume(struct device *dev, unsigned int n)
205 outb_p(DEVICE_ENABLE, HTCPEN_PORT_INIT);
207 return 0;
209 #endif
211 static struct isa_driver htcpen_isa_driver = {
212 .probe = htcpen_isa_probe,
213 .remove = __devexit_p(htcpen_isa_remove),
214 #ifdef CONFIG_PM
215 .suspend = htcpen_isa_suspend,
216 .resume = htcpen_isa_resume,
217 #endif
218 .driver = {
219 .owner = THIS_MODULE,
220 .name = "htcpen",
224 static struct dmi_system_id __initdata htcshift_dmi_table[] = {
226 .ident = "Shift",
227 .matches = {
228 DMI_MATCH(DMI_SYS_VENDOR, "High Tech Computer Corp"),
229 DMI_MATCH(DMI_PRODUCT_NAME, "Shift"),
235 static int __init htcpen_isa_init(void)
237 if (!dmi_check_system(htcshift_dmi_table))
238 return -ENODEV;
240 return isa_register_driver(&htcpen_isa_driver, 1);
243 static void __exit htcpen_isa_exit(void)
245 isa_unregister_driver(&htcpen_isa_driver);
248 module_init(htcpen_isa_init);
249 module_exit(htcpen_isa_exit);