1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * Dynapro serial touchscreen driver |
4 | * |
5 | * Copyright (c) 2009 Tias Guns |
6 | * Based on the inexio driver (c) Vojtech Pavlik and Dan Streetman and |
7 | * Richard Lemon |
8 | */ |
9 | |
10 | |
11 | /* |
12 | * 2009/09/19 Tias Guns <tias@ulyssis.org> |
13 | * Copied inexio.c and edited for Dynapro protocol (from retired Xorg module) |
14 | */ |
15 | |
16 | #include <linux/errno.h> |
17 | #include <linux/kernel.h> |
18 | #include <linux/module.h> |
19 | #include <linux/slab.h> |
20 | #include <linux/input.h> |
21 | #include <linux/serio.h> |
22 | |
23 | #define DRIVER_DESC "Dynapro serial touchscreen driver" |
24 | |
25 | MODULE_AUTHOR("Tias Guns <tias@ulyssis.org>" ); |
26 | MODULE_DESCRIPTION(DRIVER_DESC); |
27 | MODULE_LICENSE("GPL" ); |
28 | |
29 | /* |
30 | * Definitions & global arrays. |
31 | */ |
32 | |
33 | #define DYNAPRO_FORMAT_TOUCH_BIT 0x40 |
34 | #define DYNAPRO_FORMAT_LENGTH 3 |
35 | #define DYNAPRO_RESPONSE_BEGIN_BYTE 0x80 |
36 | |
37 | #define DYNAPRO_MIN_XC 0 |
38 | #define DYNAPRO_MAX_XC 0x3ff |
39 | #define DYNAPRO_MIN_YC 0 |
40 | #define DYNAPRO_MAX_YC 0x3ff |
41 | |
42 | #define DYNAPRO_GET_XC(data) (data[1] | ((data[0] & 0x38) << 4)) |
43 | #define DYNAPRO_GET_YC(data) (data[2] | ((data[0] & 0x07) << 7)) |
44 | #define DYNAPRO_GET_TOUCHED(data) (DYNAPRO_FORMAT_TOUCH_BIT & data[0]) |
45 | |
46 | /* |
47 | * Per-touchscreen data. |
48 | */ |
49 | |
50 | struct dynapro { |
51 | struct input_dev *dev; |
52 | struct serio *serio; |
53 | int idx; |
54 | unsigned char data[DYNAPRO_FORMAT_LENGTH]; |
55 | char phys[32]; |
56 | }; |
57 | |
58 | static void dynapro_process_data(struct dynapro *pdynapro) |
59 | { |
60 | struct input_dev *dev = pdynapro->dev; |
61 | |
62 | if (DYNAPRO_FORMAT_LENGTH == ++pdynapro->idx) { |
63 | input_report_abs(dev, ABS_X, DYNAPRO_GET_XC(pdynapro->data)); |
64 | input_report_abs(dev, ABS_Y, DYNAPRO_GET_YC(pdynapro->data)); |
65 | input_report_key(dev, BTN_TOUCH, |
66 | DYNAPRO_GET_TOUCHED(pdynapro->data)); |
67 | input_sync(dev); |
68 | |
69 | pdynapro->idx = 0; |
70 | } |
71 | } |
72 | |
73 | static irqreturn_t dynapro_interrupt(struct serio *serio, |
74 | unsigned char data, unsigned int flags) |
75 | { |
76 | struct dynapro *pdynapro = serio_get_drvdata(serio); |
77 | |
78 | pdynapro->data[pdynapro->idx] = data; |
79 | |
80 | if (DYNAPRO_RESPONSE_BEGIN_BYTE & pdynapro->data[0]) |
81 | dynapro_process_data(pdynapro); |
82 | else |
83 | dev_dbg(&serio->dev, "unknown/unsynchronized data: %x\n" , |
84 | pdynapro->data[0]); |
85 | |
86 | return IRQ_HANDLED; |
87 | } |
88 | |
89 | static void dynapro_disconnect(struct serio *serio) |
90 | { |
91 | struct dynapro *pdynapro = serio_get_drvdata(serio); |
92 | |
93 | input_get_device(dev: pdynapro->dev); |
94 | input_unregister_device(pdynapro->dev); |
95 | serio_close(serio); |
96 | serio_set_drvdata(serio, NULL); |
97 | input_put_device(dev: pdynapro->dev); |
98 | kfree(objp: pdynapro); |
99 | } |
100 | |
101 | /* |
102 | * dynapro_connect() is the routine that is called when someone adds a |
103 | * new serio device that supports dynapro protocol and registers it as |
104 | * an input device. This is usually accomplished using inputattach. |
105 | */ |
106 | |
107 | static int dynapro_connect(struct serio *serio, struct serio_driver *drv) |
108 | { |
109 | struct dynapro *pdynapro; |
110 | struct input_dev *input_dev; |
111 | int err; |
112 | |
113 | pdynapro = kzalloc(size: sizeof(struct dynapro), GFP_KERNEL); |
114 | input_dev = input_allocate_device(); |
115 | if (!pdynapro || !input_dev) { |
116 | err = -ENOMEM; |
117 | goto fail1; |
118 | } |
119 | |
120 | pdynapro->serio = serio; |
121 | pdynapro->dev = input_dev; |
122 | snprintf(buf: pdynapro->phys, size: sizeof(pdynapro->phys), |
123 | fmt: "%s/input0" , serio->phys); |
124 | |
125 | input_dev->name = "Dynapro Serial TouchScreen" ; |
126 | input_dev->phys = pdynapro->phys; |
127 | input_dev->id.bustype = BUS_RS232; |
128 | input_dev->id.vendor = SERIO_DYNAPRO; |
129 | input_dev->id.product = 0; |
130 | input_dev->id.version = 0x0001; |
131 | input_dev->dev.parent = &serio->dev; |
132 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
133 | input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); |
134 | input_set_abs_params(dev: pdynapro->dev, ABS_X, |
135 | DYNAPRO_MIN_XC, DYNAPRO_MAX_XC, fuzz: 0, flat: 0); |
136 | input_set_abs_params(dev: pdynapro->dev, ABS_Y, |
137 | DYNAPRO_MIN_YC, DYNAPRO_MAX_YC, fuzz: 0, flat: 0); |
138 | |
139 | serio_set_drvdata(serio, data: pdynapro); |
140 | |
141 | err = serio_open(serio, drv); |
142 | if (err) |
143 | goto fail2; |
144 | |
145 | err = input_register_device(pdynapro->dev); |
146 | if (err) |
147 | goto fail3; |
148 | |
149 | return 0; |
150 | |
151 | fail3: serio_close(serio); |
152 | fail2: serio_set_drvdata(serio, NULL); |
153 | fail1: input_free_device(dev: input_dev); |
154 | kfree(objp: pdynapro); |
155 | return err; |
156 | } |
157 | |
158 | /* |
159 | * The serio driver structure. |
160 | */ |
161 | |
162 | static const struct serio_device_id dynapro_serio_ids[] = { |
163 | { |
164 | .type = SERIO_RS232, |
165 | .proto = SERIO_DYNAPRO, |
166 | .id = SERIO_ANY, |
167 | .extra = SERIO_ANY, |
168 | }, |
169 | { 0 } |
170 | }; |
171 | |
172 | MODULE_DEVICE_TABLE(serio, dynapro_serio_ids); |
173 | |
174 | static struct serio_driver dynapro_drv = { |
175 | .driver = { |
176 | .name = "dynapro" , |
177 | }, |
178 | .description = DRIVER_DESC, |
179 | .id_table = dynapro_serio_ids, |
180 | .interrupt = dynapro_interrupt, |
181 | .connect = dynapro_connect, |
182 | .disconnect = dynapro_disconnect, |
183 | }; |
184 | |
185 | module_serio_driver(dynapro_drv); |
186 | |