Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  * Fujitsu B-series Lifebook PS/2 TouchScreen driver
  3  *
  4  * Copyright (c) 2005 Vojtech Pavlik <vojtech@suse.cz>
  5  * Copyright (c) 2005 Kenan Esau <kenan.esau@conan.de>
  6  *
  7  * TouchScreen detection, absolute mode setting and packet layout is taken from
  8  * Harald Hoyer's description of the device.
  9  *
 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.
 13  */
 14 
 15 #include <linux/input.h>
 16 #include <linux/serio.h>
 17 #include <linux/libps2.h>
 18 #include <linux/dmi.h>
 19 
 20 #include "psmouse.h"
 21 #include "lifebook.h"
 22 
 23 struct lifebook_data {
 24         struct input_dev *dev2;         /* Relative device */
 25         char phys[32];
 26 };
 27 
 28 static const char *desired_serio_phys;
 29 
 30 static int lifebook_set_serio_phys(const struct dmi_system_id *d)
 31 {
 32         desired_serio_phys = d->driver_data;
 33         return 0;
 34 }
 35 
 36 static unsigned char lifebook_use_6byte_proto;
 37 
 38 static int lifebook_set_6byte_proto(const struct dmi_system_id *d)
 39 {
 40         lifebook_use_6byte_proto = 1;
 41         return 0;
 42 }
 43 
 44 static const struct dmi_system_id lifebook_dmi_table[] = {
 45         {
 46                 .ident = "FLORA-ie 55mi",
 47                 .matches = {
 48                         DMI_MATCH(DMI_PRODUCT_NAME, "FLORA-ie 55mi"),
 49                 },
 50         },
 51         {
 52                 .ident = "LifeBook B",
 53                 .matches = {
 54                         DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B Series"),
 55                 },
 56         },
 57         {
 58                 .ident = "Lifebook B",
 59                 .matches = {
 60                         DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK B Series"),
 61                 },
 62         },
 63         {
 64                 .ident = "Lifebook B-2130",
 65                 .matches = {
 66                         DMI_MATCH(DMI_BOARD_NAME, "ZEPHYR"),
 67                 },
 68         },
 69         {
 70                 .ident = "Lifebook B213x/B2150",
 71                 .matches = {
 72                         DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B2131/B2133/B2150"),
 73                 },
 74         },
 75         {
 76                 .ident = "Zephyr",
 77                 .matches = {
 78                         DMI_MATCH(DMI_PRODUCT_NAME, "ZEPHYR"),
 79                 },
 80         },
 81         {
 82                 .ident = "CF-18",
 83                 .matches = {
 84                         DMI_MATCH(DMI_PRODUCT_NAME, "CF-18"),
 85                 },
 86                 .callback = lifebook_set_serio_phys,
 87                 .driver_data = "isa0060/serio3",
 88         },
 89         {
 90                 .ident = "Panasonic CF-28",
 91                 .matches = {
 92                         DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
 93                         DMI_MATCH(DMI_PRODUCT_NAME, "CF-28"),
 94                 },
 95                 .callback = lifebook_set_6byte_proto,
 96         },
 97         {
 98                 .ident = "Panasonic CF-29",
 99                 .matches = {
100                         DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
101                         DMI_MATCH(DMI_PRODUCT_NAME, "CF-29"),
102                 },
103                 .callback = lifebook_set_6byte_proto,
104         },
105         {
106                 .ident = "CF-72",
107                 .matches = {
108                         DMI_MATCH(DMI_PRODUCT_NAME, "CF-72"),
109                 },
110                 .callback = lifebook_set_serio_phys,
111                 .driver_data = "isa0060/serio3",
112         },
113         {
114                 .ident = "Lifebook B142",
115                 .matches = {
116                         DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B142"),
117                 },
118         },
119         { }
120 };
121 
122 static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse)
123 {
124         struct lifebook_data *priv = psmouse->private;
125         struct input_dev *dev1 = psmouse->dev;
126         struct input_dev *dev2 = priv ? priv->dev2 : NULL;
127         unsigned char *packet = psmouse->packet;
128         int relative_packet = packet[0] & 0x08;
129 
130         if (relative_packet || !lifebook_use_6byte_proto) {
131                 if (psmouse->pktcnt != 3)
132                         return PSMOUSE_GOOD_DATA;
133         } else {
134                 switch (psmouse->pktcnt) {
135                 case 1:
136                         return (packet[0] & 0xf8) == 0x00 ?
137                                 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
138                 case 2:
139                         return PSMOUSE_GOOD_DATA;
140                 case 3:
141                         return ((packet[2] & 0x30) << 2) == (packet[2] & 0xc0) ?
142                                 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
143                 case 4:
144                         return (packet[3] & 0xf8) == 0xc0 ?
145                                 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
146                 case 5:
147                         return (packet[4] & 0xc0) == (packet[2] & 0xc0) ?
148                                 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
149                 case 6:
150                         if (((packet[5] & 0x30) << 2) != (packet[5] & 0xc0))
151                                 return PSMOUSE_BAD_DATA;
152                         if ((packet[5] & 0xc0) != (packet[1] & 0xc0))
153                                 return PSMOUSE_BAD_DATA;
154                         break; /* report data */
155                 }
156         }
157 
158         if (relative_packet) {
159                 if (!dev2)
160                         printk(KERN_WARNING "lifebook.c: got relative packet "
161                                 "but no relative device set up\n");
162         } else {
163                 if (lifebook_use_6byte_proto) {
164                         input_report_abs(dev1, ABS_X,
165                                 ((packet[1] & 0x3f) << 6) | (packet[2] & 0x3f));
166                         input_report_abs(dev1, ABS_Y,
167                                 4096 - (((packet[4] & 0x3f) << 6) | (packet[5] & 0x3f)));
168                 } else {
169                         input_report_abs(dev1, ABS_X,
170                                 (packet[1] | ((packet[0] & 0x30) << 4)));
171                         input_report_abs(dev1, ABS_Y,
172                                 1024 - (packet[2] | ((packet[0] & 0xC0) << 2)));
173                 }
174                 input_report_key(dev1, BTN_TOUCH, packet[0] & 0x04);
175                 input_sync(dev1);
176         }
177 
178         if (dev2) {
179                 if (relative_packet) {
180                         input_report_rel(dev2, REL_X,
181                                 ((packet[0] & 0x10) ? packet[1] - 256 : packet[1]));
182                         input_report_rel(dev2, REL_Y,
183                                  -(int)((packet[0] & 0x20) ? packet[2] - 256 : packet[2]));
184                 }
185                 input_report_key(dev2, BTN_LEFT, packet[0] & 0x01);
186                 input_report_key(dev2, BTN_RIGHT, packet[0] & 0x02);
187                 input_sync(dev2);
188         }
189 
190         return PSMOUSE_FULL_PACKET;
191 }
192 
193 static int lifebook_absolute_mode(struct psmouse *psmouse)
194 {
195         struct ps2dev *ps2dev = &psmouse->ps2dev;
196         unsigned char param;
197 
198         if (psmouse_reset(psmouse))
199                 return -1;
200 
201         /*
202            Enable absolute output -- ps2_command fails always but if
203            you leave this call out the touchsreen will never send
204            absolute coordinates
205         */
206         param = lifebook_use_6byte_proto ? 0x08 : 0x07;
207         ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
208 
209         return 0;
210 }
211 
212 static void lifebook_relative_mode(struct psmouse *psmouse)
213 {
214         struct ps2dev *ps2dev = &psmouse->ps2dev;
215         unsigned char param = 0x06;
216 
217         ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
218 }
219 
220 static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution)
221 {
222         static const unsigned char params[] = { 0, 1, 2, 2, 3 };
223         unsigned char p;
224 
225         if (resolution == 0 || resolution > 400)
226                 resolution = 400;
227 
228         p = params[resolution / 100];
229         ps2_command(&psmouse->ps2dev, &p, PSMOUSE_CMD_SETRES);
230         psmouse->resolution = 50 << p;
231 }
232 
233 static void lifebook_disconnect(struct psmouse *psmouse)
234 {
235         struct lifebook_data *priv = psmouse->private;
236 
237         psmouse_reset(psmouse);
238         if (priv) {
239                 input_unregister_device(priv->dev2);
240                 kfree(priv);
241         }
242         psmouse->private = NULL;
243 }
244 
245 int lifebook_detect(struct psmouse *psmouse, int set_properties)
246 {
247         if (!dmi_check_system(lifebook_dmi_table))
248                 return -1;
249 
250         if (desired_serio_phys &&
251             strcmp(psmouse->ps2dev.serio->phys, desired_serio_phys))
252                 return -1;
253 
254         if (set_properties) {
255                 psmouse->vendor = "Fujitsu";
256                 psmouse->name = "Lifebook TouchScreen";
257         }
258 
259         return 0;
260 }
261 
262 static int lifebook_create_relative_device(struct psmouse *psmouse)
263 {
264         struct input_dev *dev2;
265         struct lifebook_data *priv;
266         int error = -ENOMEM;
267 
268         priv = kzalloc(sizeof(struct lifebook_data), GFP_KERNEL);
269         dev2 = input_allocate_device();
270         if (!priv || !dev2)
271                 goto err_out;
272 
273         priv->dev2 = dev2;
274         snprintf(priv->phys, sizeof(priv->phys),
275                  "%s/input1", psmouse->ps2dev.serio->phys);
276 
277         dev2->phys = priv->phys;
278         dev2->name = "PS/2 Touchpad";
279         dev2->id.bustype = BUS_I8042;
280         dev2->id.vendor  = 0x0002;
281         dev2->id.product = PSMOUSE_LIFEBOOK;
282         dev2->id.version = 0x0000;
283         dev2->dev.parent = &psmouse->ps2dev.serio->dev;
284 
285         dev2->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
286         dev2->relbit[BIT_WORD(REL_X)] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
287         dev2->keybit[BIT_WORD(BTN_LEFT)] = BIT_MASK(BTN_LEFT) |
288                 BIT_MASK(BTN_RIGHT);
289 
290         error = input_register_device(priv->dev2);
291         if (error)
292                 goto err_out;
293 
294         psmouse->private = priv;
295         return 0;
296 
297  err_out:
298         input_free_device(dev2);
299         kfree(priv);
300         return error;
301 }
302 
303 int lifebook_init(struct psmouse *psmouse)
304 {
305         struct input_dev *dev1 = psmouse->dev;
306         int max_coord = lifebook_use_6byte_proto ? 4096 : 1024;
307 
308         if (lifebook_absolute_mode(psmouse))
309                 return -1;
310 
311         dev1->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
312         dev1->relbit[0] = 0;
313         dev1->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
314         input_set_abs_params(dev1, ABS_X, 0, max_coord, 0, 0);
315         input_set_abs_params(dev1, ABS_Y, 0, max_coord, 0, 0);
316 
317         if (!desired_serio_phys) {
318                 if (lifebook_create_relative_device(psmouse)) {
319                         lifebook_relative_mode(psmouse);
320                         return -1;
321                 }
322         }
323 
324         psmouse->protocol_handler = lifebook_process_byte;
325         psmouse->set_resolution = lifebook_set_resolution;
326         psmouse->disconnect = lifebook_disconnect;
327         psmouse->reconnect  = lifebook_absolute_mode;
328 
329         psmouse->model = lifebook_use_6byte_proto ? 6 : 3;
330 
331         /*
332          * Use packet size = 3 even when using 6-byte protocol because
333          * that's what POLL will return on Lifebooks (according to spec).
334          */
335         psmouse->pktsize = 3;
336 
337         return 0;
338 }
339 
340 
  This page was automatically generated by the LXR engine.