rt2x00: Simplify rt2x00_check_rev
[linux/fpc-iii.git] / drivers / input / mouse / lifebook.c
blobdf81b0aaa9f88911fa335d506f284161c5e24d70
1 /*
2 * Fujitsu B-series Lifebook PS/2 TouchScreen driver
4 * Copyright (c) 2005 Vojtech Pavlik <vojtech@suse.cz>
5 * Copyright (c) 2005 Kenan Esau <kenan.esau@conan.de>
7 * TouchScreen detection, absolute mode setting and packet layout is taken from
8 * Harald Hoyer's description of the device.
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published by
12 * the Free Software Foundation.
15 #include <linux/input.h>
16 #include <linux/serio.h>
17 #include <linux/libps2.h>
18 #include <linux/dmi.h>
20 #include "psmouse.h"
21 #include "lifebook.h"
23 struct lifebook_data {
24 struct input_dev *dev2; /* Relative device */
25 char phys[32];
28 static const char *desired_serio_phys;
30 static int lifebook_set_serio_phys(const struct dmi_system_id *d)
32 desired_serio_phys = d->driver_data;
33 return 0;
36 static unsigned char lifebook_use_6byte_proto;
38 static int lifebook_set_6byte_proto(const struct dmi_system_id *d)
40 lifebook_use_6byte_proto = 1;
41 return 0;
44 static const struct dmi_system_id lifebook_dmi_table[] = {
46 .ident = "FLORA-ie 55mi",
47 .matches = {
48 DMI_MATCH(DMI_PRODUCT_NAME, "FLORA-ie 55mi"),
52 .ident = "LifeBook B",
53 .matches = {
54 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B Series"),
58 .ident = "Lifebook B",
59 .matches = {
60 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK B Series"),
64 .ident = "Lifebook B213x/B2150",
65 .matches = {
66 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B2131/B2133/B2150"),
70 .ident = "Zephyr",
71 .matches = {
72 DMI_MATCH(DMI_PRODUCT_NAME, "ZEPHYR"),
76 .ident = "CF-18",
77 .matches = {
78 DMI_MATCH(DMI_PRODUCT_NAME, "CF-18"),
80 .callback = lifebook_set_serio_phys,
81 .driver_data = "isa0060/serio3",
84 .ident = "Panasonic CF-28",
85 .matches = {
86 DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
87 DMI_MATCH(DMI_PRODUCT_NAME, "CF-28"),
89 .callback = lifebook_set_6byte_proto,
92 .ident = "Panasonic CF-29",
93 .matches = {
94 DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
95 DMI_MATCH(DMI_PRODUCT_NAME, "CF-29"),
97 .callback = lifebook_set_6byte_proto,
100 .ident = "CF-72",
101 .matches = {
102 DMI_MATCH(DMI_PRODUCT_NAME, "CF-72"),
104 .callback = lifebook_set_serio_phys,
105 .driver_data = "isa0060/serio3",
108 .ident = "Lifebook B142",
109 .matches = {
110 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B142"),
116 static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse)
118 struct lifebook_data *priv = psmouse->private;
119 struct input_dev *dev1 = psmouse->dev;
120 struct input_dev *dev2 = priv ? priv->dev2 : NULL;
121 unsigned char *packet = psmouse->packet;
122 int relative_packet = packet[0] & 0x08;
124 if (relative_packet || !lifebook_use_6byte_proto) {
125 if (psmouse->pktcnt != 3)
126 return PSMOUSE_GOOD_DATA;
127 } else {
128 switch (psmouse->pktcnt) {
129 case 1:
130 return (packet[0] & 0xf8) == 0x00 ?
131 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
132 case 2:
133 return PSMOUSE_GOOD_DATA;
134 case 3:
135 return ((packet[2] & 0x30) << 2) == (packet[2] & 0xc0) ?
136 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
137 case 4:
138 return (packet[3] & 0xf8) == 0xc0 ?
139 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
140 case 5:
141 return (packet[4] & 0xc0) == (packet[2] & 0xc0) ?
142 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
143 case 6:
144 if (((packet[5] & 0x30) << 2) != (packet[5] & 0xc0))
145 return PSMOUSE_BAD_DATA;
146 if ((packet[5] & 0xc0) != (packet[1] & 0xc0))
147 return PSMOUSE_BAD_DATA;
148 break; /* report data */
152 if (relative_packet) {
153 if (!dev2)
154 printk(KERN_WARNING "lifebook.c: got relative packet "
155 "but no relative device set up\n");
156 } else if (lifebook_use_6byte_proto) {
157 input_report_abs(dev1, ABS_X,
158 ((packet[1] & 0x3f) << 6) | (packet[2] & 0x3f));
159 input_report_abs(dev1, ABS_Y,
160 4096 - (((packet[4] & 0x3f) << 6) | (packet[5] & 0x3f)));
161 } else {
162 input_report_abs(dev1, ABS_X,
163 (packet[1] | ((packet[0] & 0x30) << 4)));
164 input_report_abs(dev1, ABS_Y,
165 1024 - (packet[2] | ((packet[0] & 0xC0) << 2)));
168 input_report_key(dev1, BTN_TOUCH, packet[0] & 0x04);
169 input_sync(dev1);
171 if (dev2) {
172 if (relative_packet) {
173 input_report_rel(dev2, REL_X,
174 ((packet[0] & 0x10) ? packet[1] - 256 : packet[1]));
175 input_report_rel(dev2, REL_Y,
176 -(int)((packet[0] & 0x20) ? packet[2] - 256 : packet[2]));
178 input_report_key(dev2, BTN_LEFT, packet[0] & 0x01);
179 input_report_key(dev2, BTN_RIGHT, packet[0] & 0x02);
180 input_sync(dev2);
183 return PSMOUSE_FULL_PACKET;
186 static int lifebook_absolute_mode(struct psmouse *psmouse)
188 struct ps2dev *ps2dev = &psmouse->ps2dev;
189 unsigned char param;
191 if (psmouse_reset(psmouse))
192 return -1;
195 Enable absolute output -- ps2_command fails always but if
196 you leave this call out the touchsreen will never send
197 absolute coordinates
199 param = lifebook_use_6byte_proto ? 0x08 : 0x07;
200 ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
202 return 0;
205 static void lifebook_relative_mode(struct psmouse *psmouse)
207 struct ps2dev *ps2dev = &psmouse->ps2dev;
208 unsigned char param = 0x06;
210 ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
213 static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution)
215 static const unsigned char params[] = { 0, 1, 2, 2, 3 };
216 unsigned char p;
218 if (resolution == 0 || resolution > 400)
219 resolution = 400;
221 p = params[resolution / 100];
222 ps2_command(&psmouse->ps2dev, &p, PSMOUSE_CMD_SETRES);
223 psmouse->resolution = 50 << p;
226 static void lifebook_disconnect(struct psmouse *psmouse)
228 struct lifebook_data *priv = psmouse->private;
230 psmouse_reset(psmouse);
231 if (priv) {
232 input_unregister_device(priv->dev2);
233 kfree(priv);
235 psmouse->private = NULL;
238 int lifebook_detect(struct psmouse *psmouse, int set_properties)
240 if (!dmi_check_system(lifebook_dmi_table))
241 return -1;
243 if (desired_serio_phys &&
244 strcmp(psmouse->ps2dev.serio->phys, desired_serio_phys))
245 return -1;
247 if (set_properties) {
248 psmouse->vendor = "Fujitsu";
249 psmouse->name = "Lifebook TouchScreen";
252 return 0;
255 static int lifebook_create_relative_device(struct psmouse *psmouse)
257 struct input_dev *dev2;
258 struct lifebook_data *priv;
259 int error = -ENOMEM;
261 priv = kzalloc(sizeof(struct lifebook_data), GFP_KERNEL);
262 dev2 = input_allocate_device();
263 if (!priv || !dev2)
264 goto err_out;
266 priv->dev2 = dev2;
267 snprintf(priv->phys, sizeof(priv->phys),
268 "%s/input1", psmouse->ps2dev.serio->phys);
270 dev2->phys = priv->phys;
271 dev2->name = "PS/2 Touchpad";
272 dev2->id.bustype = BUS_I8042;
273 dev2->id.vendor = 0x0002;
274 dev2->id.product = PSMOUSE_LIFEBOOK;
275 dev2->id.version = 0x0000;
276 dev2->dev.parent = &psmouse->ps2dev.serio->dev;
278 dev2->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
279 dev2->relbit[BIT_WORD(REL_X)] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
280 dev2->keybit[BIT_WORD(BTN_LEFT)] = BIT_MASK(BTN_LEFT) |
281 BIT_MASK(BTN_RIGHT);
283 error = input_register_device(priv->dev2);
284 if (error)
285 goto err_out;
287 psmouse->private = priv;
288 return 0;
290 err_out:
291 input_free_device(dev2);
292 kfree(priv);
293 return error;
296 int lifebook_init(struct psmouse *psmouse)
298 struct input_dev *dev1 = psmouse->dev;
299 int max_coord = lifebook_use_6byte_proto ? 4096 : 1024;
301 if (lifebook_absolute_mode(psmouse))
302 return -1;
304 dev1->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
305 dev1->relbit[0] = 0;
306 dev1->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
307 input_set_abs_params(dev1, ABS_X, 0, max_coord, 0, 0);
308 input_set_abs_params(dev1, ABS_Y, 0, max_coord, 0, 0);
310 if (!desired_serio_phys) {
311 if (lifebook_create_relative_device(psmouse)) {
312 lifebook_relative_mode(psmouse);
313 return -1;
317 psmouse->protocol_handler = lifebook_process_byte;
318 psmouse->set_resolution = lifebook_set_resolution;
319 psmouse->disconnect = lifebook_disconnect;
320 psmouse->reconnect = lifebook_absolute_mode;
322 psmouse->model = lifebook_use_6byte_proto ? 6 : 3;
325 * Use packet size = 3 even when using 6-byte protocol because
326 * that's what POLL will return on Lifebooks (according to spec).
328 psmouse->pktsize = 3;
330 return 0;