Commit | Line | Data |
---|---|---|
85f202d5 DT |
1 | /* |
2 | * Fujitsu serial touchscreen driver | |
3 | * | |
4 | * Copyright (c) Dmitry Torokhov <dtor@mail.ru> | |
5 | */ | |
6 | ||
7 | /* | |
8 | * This program is free software; you can redistribute it and/or modify it | |
9 | * under the terms of the GNU General Public License version 2 as published | |
10 | * by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/errno.h> | |
14 | #include <linux/kernel.h> | |
15 | #include <linux/module.h> | |
16 | #include <linux/slab.h> | |
17 | #include <linux/input.h> | |
18 | #include <linux/serio.h> | |
85f202d5 DT |
19 | |
20 | #define DRIVER_DESC "Fujitsu serial touchscreen driver" | |
21 | ||
22 | MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>"); | |
23 | MODULE_DESCRIPTION(DRIVER_DESC); | |
24 | MODULE_LICENSE("GPL"); | |
25 | ||
26 | #define FUJITSU_LENGTH 5 | |
27 | ||
28 | /* | |
29 | * Per-touchscreen data. | |
30 | */ | |
31 | struct fujitsu { | |
32 | struct input_dev *dev; | |
33 | struct serio *serio; | |
34 | int idx; | |
35 | unsigned char data[FUJITSU_LENGTH]; | |
36 | char phys[32]; | |
37 | }; | |
38 | ||
39 | /* | |
40 | * Decode serial data (5 bytes per packet) | |
41 | * First byte | |
42 | * 1 C 0 0 R S S S | |
43 | * Where C is 1 while in calibration mode (which we don't use) | |
44 | * R is 1 when no coordinate corection was done. | |
45 | * S are button state | |
46 | */ | |
47 | static irqreturn_t fujitsu_interrupt(struct serio *serio, | |
48 | unsigned char data, unsigned int flags) | |
49 | { | |
50 | struct fujitsu *fujitsu = serio_get_drvdata(serio); | |
51 | struct input_dev *dev = fujitsu->dev; | |
52 | ||
53 | if (fujitsu->idx == 0) { | |
54 | /* resync skip until start of frame */ | |
55 | if ((data & 0xf0) != 0x80) | |
56 | return IRQ_HANDLED; | |
57 | } else { | |
58 | /* resync skip garbage */ | |
59 | if (data & 0x80) { | |
60 | fujitsu->idx = 0; | |
61 | return IRQ_HANDLED; | |
62 | } | |
63 | } | |
64 | ||
65 | fujitsu->data[fujitsu->idx++] = data; | |
66 | if (fujitsu->idx == FUJITSU_LENGTH) { | |
67 | input_report_abs(dev, ABS_X, | |
68 | (fujitsu->data[2] << 7) | fujitsu->data[1]); | |
69 | input_report_abs(dev, ABS_Y, | |
70 | (fujitsu->data[4] << 7) | fujitsu->data[3]); | |
71 | input_report_key(dev, BTN_TOUCH, | |
72 | (fujitsu->data[0] & 0x03) != 2); | |
73 | input_sync(dev); | |
74 | fujitsu->idx = 0; | |
75 | } | |
76 | ||
77 | return IRQ_HANDLED; | |
78 | } | |
79 | ||
80 | /* | |
81 | * fujitsu_disconnect() is the opposite of fujitsu_connect() | |
82 | */ | |
83 | static void fujitsu_disconnect(struct serio *serio) | |
84 | { | |
85 | struct fujitsu *fujitsu = serio_get_drvdata(serio); | |
86 | ||
87 | input_get_device(fujitsu->dev); | |
88 | input_unregister_device(fujitsu->dev); | |
89 | serio_close(serio); | |
90 | serio_set_drvdata(serio, NULL); | |
91 | input_put_device(fujitsu->dev); | |
92 | kfree(fujitsu); | |
93 | } | |
94 | ||
95 | /* | |
96 | * fujitsu_connect() is the routine that is called when someone adds a | |
97 | * new serio device that supports the Fujitsu protocol and registers it | |
98 | * as input device. | |
99 | */ | |
100 | static int fujitsu_connect(struct serio *serio, struct serio_driver *drv) | |
101 | { | |
102 | struct fujitsu *fujitsu; | |
103 | struct input_dev *input_dev; | |
104 | int err; | |
105 | ||
106 | fujitsu = kzalloc(sizeof(struct fujitsu), GFP_KERNEL); | |
107 | input_dev = input_allocate_device(); | |
108 | if (!fujitsu || !input_dev) { | |
109 | err = -ENOMEM; | |
110 | goto fail1; | |
111 | } | |
112 | ||
113 | fujitsu->serio = serio; | |
114 | fujitsu->dev = input_dev; | |
115 | snprintf(fujitsu->phys, sizeof(fujitsu->phys), | |
116 | "%s/input0", serio->phys); | |
117 | ||
118 | input_dev->name = "Fujitsu Serial Touchscreen"; | |
119 | input_dev->phys = fujitsu->phys; | |
120 | input_dev->id.bustype = BUS_RS232; | |
121 | input_dev->id.vendor = SERIO_FUJITSU; | |
122 | input_dev->id.product = 0; | |
123 | input_dev->id.version = 0x0100; | |
7b19ada2 JS |
124 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
125 | input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); | |
85f202d5 DT |
126 | |
127 | input_set_abs_params(input_dev, ABS_X, 0, 4096, 0, 0); | |
128 | input_set_abs_params(input_dev, ABS_Y, 0, 4096, 0, 0); | |
129 | serio_set_drvdata(serio, fujitsu); | |
130 | ||
131 | err = serio_open(serio, drv); | |
132 | if (err) | |
133 | goto fail2; | |
134 | ||
135 | err = input_register_device(fujitsu->dev); | |
136 | if (err) | |
137 | goto fail3; | |
138 | ||
139 | return 0; | |
140 | ||
141 | fail3: | |
142 | serio_close(serio); | |
143 | fail2: | |
144 | serio_set_drvdata(serio, NULL); | |
145 | fail1: | |
146 | input_free_device(input_dev); | |
147 | kfree(fujitsu); | |
148 | return err; | |
149 | } | |
150 | ||
151 | /* | |
152 | * The serio driver structure. | |
153 | */ | |
154 | static struct serio_device_id fujitsu_serio_ids[] = { | |
155 | { | |
156 | .type = SERIO_RS232, | |
157 | .proto = SERIO_FUJITSU, | |
158 | .id = SERIO_ANY, | |
159 | .extra = SERIO_ANY, | |
160 | }, | |
161 | { 0 } | |
162 | }; | |
163 | ||
164 | MODULE_DEVICE_TABLE(serio, fujitsu_serio_ids); | |
165 | ||
166 | static struct serio_driver fujitsu_drv = { | |
167 | .driver = { | |
168 | .name = "fujitsu_ts", | |
169 | }, | |
170 | .description = DRIVER_DESC, | |
171 | .id_table = fujitsu_serio_ids, | |
172 | .interrupt = fujitsu_interrupt, | |
173 | .connect = fujitsu_connect, | |
174 | .disconnect = fujitsu_disconnect, | |
175 | }; | |
176 | ||
65ac9f7a | 177 | module_serio_driver(fujitsu_drv); |