xref: /OK3568_Linux_fs/kernel/drivers/input/touchscreen/elo.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Elo serial touchscreen driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (c) 2004 Vojtech Pavlik
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun /*
10*4882a593Smuzhiyun  * This driver can handle serial Elo touchscreens using either the Elo standard
11*4882a593Smuzhiyun  * 'E271-2210' 10-byte protocol, Elo legacy 'E281A-4002' 6-byte protocol, Elo
12*4882a593Smuzhiyun  * legacy 'E271-140' 4-byte protocol and Elo legacy 'E261-280' 3-byte protocol.
13*4882a593Smuzhiyun  */
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include <linux/errno.h>
16*4882a593Smuzhiyun #include <linux/kernel.h>
17*4882a593Smuzhiyun #include <linux/module.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun #include <linux/input.h>
20*4882a593Smuzhiyun #include <linux/serio.h>
21*4882a593Smuzhiyun #include <linux/ctype.h>
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #define DRIVER_DESC	"Elo serial touchscreen driver"
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
26*4882a593Smuzhiyun MODULE_DESCRIPTION(DRIVER_DESC);
27*4882a593Smuzhiyun MODULE_LICENSE("GPL");
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun /*
30*4882a593Smuzhiyun  * Definitions & global arrays.
31*4882a593Smuzhiyun  */
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun #define ELO_MAX_LENGTH		10
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun #define ELO10_PACKET_LEN	8
36*4882a593Smuzhiyun #define ELO10_TOUCH		0x03
37*4882a593Smuzhiyun #define ELO10_PRESSURE		0x80
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun #define ELO10_LEAD_BYTE		'U'
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun #define ELO10_ID_CMD		'i'
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun #define ELO10_TOUCH_PACKET	'T'
44*4882a593Smuzhiyun #define ELO10_ACK_PACKET	'A'
45*4882a593Smuzhiyun #define ELI10_ID_PACKET		'I'
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun /*
48*4882a593Smuzhiyun  * Per-touchscreen data.
49*4882a593Smuzhiyun  */
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun struct elo {
52*4882a593Smuzhiyun 	struct input_dev *dev;
53*4882a593Smuzhiyun 	struct serio *serio;
54*4882a593Smuzhiyun 	struct mutex cmd_mutex;
55*4882a593Smuzhiyun 	struct completion cmd_done;
56*4882a593Smuzhiyun 	int id;
57*4882a593Smuzhiyun 	int idx;
58*4882a593Smuzhiyun 	unsigned char expected_packet;
59*4882a593Smuzhiyun 	unsigned char csum;
60*4882a593Smuzhiyun 	unsigned char data[ELO_MAX_LENGTH];
61*4882a593Smuzhiyun 	unsigned char response[ELO10_PACKET_LEN];
62*4882a593Smuzhiyun 	char phys[32];
63*4882a593Smuzhiyun };
64*4882a593Smuzhiyun 
elo_process_data_10(struct elo * elo,unsigned char data)65*4882a593Smuzhiyun static void elo_process_data_10(struct elo *elo, unsigned char data)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun 	struct input_dev *dev = elo->dev;
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	elo->data[elo->idx] = data;
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 	switch (elo->idx++) {
72*4882a593Smuzhiyun 	case 0:
73*4882a593Smuzhiyun 		elo->csum = 0xaa;
74*4882a593Smuzhiyun 		if (data != ELO10_LEAD_BYTE) {
75*4882a593Smuzhiyun 			dev_dbg(&elo->serio->dev,
76*4882a593Smuzhiyun 				"unsynchronized data: 0x%02x\n", data);
77*4882a593Smuzhiyun 			elo->idx = 0;
78*4882a593Smuzhiyun 		}
79*4882a593Smuzhiyun 		break;
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun 	case 9:
82*4882a593Smuzhiyun 		elo->idx = 0;
83*4882a593Smuzhiyun 		if (data != elo->csum) {
84*4882a593Smuzhiyun 			dev_dbg(&elo->serio->dev,
85*4882a593Smuzhiyun 				"bad checksum: 0x%02x, expected 0x%02x\n",
86*4882a593Smuzhiyun 				 data, elo->csum);
87*4882a593Smuzhiyun 			break;
88*4882a593Smuzhiyun 		}
89*4882a593Smuzhiyun 		if (elo->data[1] != elo->expected_packet) {
90*4882a593Smuzhiyun 			if (elo->data[1] != ELO10_TOUCH_PACKET)
91*4882a593Smuzhiyun 				dev_dbg(&elo->serio->dev,
92*4882a593Smuzhiyun 					"unexpected packet: 0x%02x\n",
93*4882a593Smuzhiyun 					 elo->data[1]);
94*4882a593Smuzhiyun 			break;
95*4882a593Smuzhiyun 		}
96*4882a593Smuzhiyun 		if (likely(elo->data[1] == ELO10_TOUCH_PACKET)) {
97*4882a593Smuzhiyun 			input_report_abs(dev, ABS_X, (elo->data[4] << 8) | elo->data[3]);
98*4882a593Smuzhiyun 			input_report_abs(dev, ABS_Y, (elo->data[6] << 8) | elo->data[5]);
99*4882a593Smuzhiyun 			if (elo->data[2] & ELO10_PRESSURE)
100*4882a593Smuzhiyun 				input_report_abs(dev, ABS_PRESSURE,
101*4882a593Smuzhiyun 						(elo->data[8] << 8) | elo->data[7]);
102*4882a593Smuzhiyun 			input_report_key(dev, BTN_TOUCH, elo->data[2] & ELO10_TOUCH);
103*4882a593Smuzhiyun 			input_sync(dev);
104*4882a593Smuzhiyun 		} else if (elo->data[1] == ELO10_ACK_PACKET) {
105*4882a593Smuzhiyun 			if (elo->data[2] == '0')
106*4882a593Smuzhiyun 				elo->expected_packet = ELO10_TOUCH_PACKET;
107*4882a593Smuzhiyun 			complete(&elo->cmd_done);
108*4882a593Smuzhiyun 		} else {
109*4882a593Smuzhiyun 			memcpy(elo->response, &elo->data[1], ELO10_PACKET_LEN);
110*4882a593Smuzhiyun 			elo->expected_packet = ELO10_ACK_PACKET;
111*4882a593Smuzhiyun 		}
112*4882a593Smuzhiyun 		break;
113*4882a593Smuzhiyun 	}
114*4882a593Smuzhiyun 	elo->csum += data;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
elo_process_data_6(struct elo * elo,unsigned char data)117*4882a593Smuzhiyun static void elo_process_data_6(struct elo *elo, unsigned char data)
118*4882a593Smuzhiyun {
119*4882a593Smuzhiyun 	struct input_dev *dev = elo->dev;
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun 	elo->data[elo->idx] = data;
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun 	switch (elo->idx++) {
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun 	case 0:
126*4882a593Smuzhiyun 		if ((data & 0xc0) != 0xc0)
127*4882a593Smuzhiyun 			elo->idx = 0;
128*4882a593Smuzhiyun 		break;
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun 	case 1:
131*4882a593Smuzhiyun 		if ((data & 0xc0) != 0x80)
132*4882a593Smuzhiyun 			elo->idx = 0;
133*4882a593Smuzhiyun 		break;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	case 2:
136*4882a593Smuzhiyun 		if ((data & 0xc0) != 0x40)
137*4882a593Smuzhiyun 			elo->idx = 0;
138*4882a593Smuzhiyun 		break;
139*4882a593Smuzhiyun 
140*4882a593Smuzhiyun 	case 3:
141*4882a593Smuzhiyun 		if (data & 0xc0) {
142*4882a593Smuzhiyun 			elo->idx = 0;
143*4882a593Smuzhiyun 			break;
144*4882a593Smuzhiyun 		}
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 		input_report_abs(dev, ABS_X, ((elo->data[0] & 0x3f) << 6) | (elo->data[1] & 0x3f));
147*4882a593Smuzhiyun 		input_report_abs(dev, ABS_Y, ((elo->data[2] & 0x3f) << 6) | (elo->data[3] & 0x3f));
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 		if (elo->id == 2) {
150*4882a593Smuzhiyun 			input_report_key(dev, BTN_TOUCH, 1);
151*4882a593Smuzhiyun 			input_sync(dev);
152*4882a593Smuzhiyun 			elo->idx = 0;
153*4882a593Smuzhiyun 		}
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 		break;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	case 4:
158*4882a593Smuzhiyun 		if (data) {
159*4882a593Smuzhiyun 			input_sync(dev);
160*4882a593Smuzhiyun 			elo->idx = 0;
161*4882a593Smuzhiyun 		}
162*4882a593Smuzhiyun 		break;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	case 5:
165*4882a593Smuzhiyun 		if ((data & 0xf0) == 0) {
166*4882a593Smuzhiyun 			input_report_abs(dev, ABS_PRESSURE, elo->data[5]);
167*4882a593Smuzhiyun 			input_report_key(dev, BTN_TOUCH, !!elo->data[5]);
168*4882a593Smuzhiyun 		}
169*4882a593Smuzhiyun 		input_sync(dev);
170*4882a593Smuzhiyun 		elo->idx = 0;
171*4882a593Smuzhiyun 		break;
172*4882a593Smuzhiyun 	}
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun 
elo_process_data_3(struct elo * elo,unsigned char data)175*4882a593Smuzhiyun static void elo_process_data_3(struct elo *elo, unsigned char data)
176*4882a593Smuzhiyun {
177*4882a593Smuzhiyun 	struct input_dev *dev = elo->dev;
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	elo->data[elo->idx] = data;
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	switch (elo->idx++) {
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	case 0:
184*4882a593Smuzhiyun 		if ((data & 0x7f) != 0x01)
185*4882a593Smuzhiyun 			elo->idx = 0;
186*4882a593Smuzhiyun 		break;
187*4882a593Smuzhiyun 	case 2:
188*4882a593Smuzhiyun 		input_report_key(dev, BTN_TOUCH, !(elo->data[1] & 0x80));
189*4882a593Smuzhiyun 		input_report_abs(dev, ABS_X, elo->data[1]);
190*4882a593Smuzhiyun 		input_report_abs(dev, ABS_Y, elo->data[2]);
191*4882a593Smuzhiyun 		input_sync(dev);
192*4882a593Smuzhiyun 		elo->idx = 0;
193*4882a593Smuzhiyun 		break;
194*4882a593Smuzhiyun 	}
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun 
elo_interrupt(struct serio * serio,unsigned char data,unsigned int flags)197*4882a593Smuzhiyun static irqreturn_t elo_interrupt(struct serio *serio,
198*4882a593Smuzhiyun 		unsigned char data, unsigned int flags)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun 	struct elo *elo = serio_get_drvdata(serio);
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	switch (elo->id) {
203*4882a593Smuzhiyun 	case 0:
204*4882a593Smuzhiyun 		elo_process_data_10(elo, data);
205*4882a593Smuzhiyun 		break;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	case 1:
208*4882a593Smuzhiyun 	case 2:
209*4882a593Smuzhiyun 		elo_process_data_6(elo, data);
210*4882a593Smuzhiyun 		break;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	case 3:
213*4882a593Smuzhiyun 		elo_process_data_3(elo, data);
214*4882a593Smuzhiyun 		break;
215*4882a593Smuzhiyun 	}
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	return IRQ_HANDLED;
218*4882a593Smuzhiyun }
219*4882a593Smuzhiyun 
elo_command_10(struct elo * elo,unsigned char * packet)220*4882a593Smuzhiyun static int elo_command_10(struct elo *elo, unsigned char *packet)
221*4882a593Smuzhiyun {
222*4882a593Smuzhiyun 	int rc = -1;
223*4882a593Smuzhiyun 	int i;
224*4882a593Smuzhiyun 	unsigned char csum = 0xaa + ELO10_LEAD_BYTE;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	mutex_lock(&elo->cmd_mutex);
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	serio_pause_rx(elo->serio);
229*4882a593Smuzhiyun 	elo->expected_packet = toupper(packet[0]);
230*4882a593Smuzhiyun 	init_completion(&elo->cmd_done);
231*4882a593Smuzhiyun 	serio_continue_rx(elo->serio);
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	if (serio_write(elo->serio, ELO10_LEAD_BYTE))
234*4882a593Smuzhiyun 		goto out;
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	for (i = 0; i < ELO10_PACKET_LEN; i++) {
237*4882a593Smuzhiyun 		csum += packet[i];
238*4882a593Smuzhiyun 		if (serio_write(elo->serio, packet[i]))
239*4882a593Smuzhiyun 			goto out;
240*4882a593Smuzhiyun 	}
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	if (serio_write(elo->serio, csum))
243*4882a593Smuzhiyun 		goto out;
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 	wait_for_completion_timeout(&elo->cmd_done, HZ);
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	if (elo->expected_packet == ELO10_TOUCH_PACKET) {
248*4882a593Smuzhiyun 		/* We are back in reporting mode, the command was ACKed */
249*4882a593Smuzhiyun 		memcpy(packet, elo->response, ELO10_PACKET_LEN);
250*4882a593Smuzhiyun 		rc = 0;
251*4882a593Smuzhiyun 	}
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun  out:
254*4882a593Smuzhiyun 	mutex_unlock(&elo->cmd_mutex);
255*4882a593Smuzhiyun 	return rc;
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun 
elo_setup_10(struct elo * elo)258*4882a593Smuzhiyun static int elo_setup_10(struct elo *elo)
259*4882a593Smuzhiyun {
260*4882a593Smuzhiyun 	static const char *elo_types[] = { "Accu", "Dura", "Intelli", "Carroll" };
261*4882a593Smuzhiyun 	struct input_dev *dev = elo->dev;
262*4882a593Smuzhiyun 	unsigned char packet[ELO10_PACKET_LEN] = { ELO10_ID_CMD };
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	if (elo_command_10(elo, packet))
265*4882a593Smuzhiyun 		return -1;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	dev->id.version = (packet[5] << 8) | packet[4];
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	input_set_abs_params(dev, ABS_X, 96, 4000, 0, 0);
270*4882a593Smuzhiyun 	input_set_abs_params(dev, ABS_Y, 96, 4000, 0, 0);
271*4882a593Smuzhiyun 	if (packet[3] & ELO10_PRESSURE)
272*4882a593Smuzhiyun 		input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	dev_info(&elo->serio->dev,
275*4882a593Smuzhiyun 		 "%sTouch touchscreen, fw: %02x.%02x, features: 0x%02x, controller: 0x%02x\n",
276*4882a593Smuzhiyun 		 elo_types[(packet[1] -'0') & 0x03],
277*4882a593Smuzhiyun 		 packet[5], packet[4], packet[3], packet[7]);
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	return 0;
280*4882a593Smuzhiyun }
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun /*
283*4882a593Smuzhiyun  * elo_disconnect() is the opposite of elo_connect()
284*4882a593Smuzhiyun  */
285*4882a593Smuzhiyun 
elo_disconnect(struct serio * serio)286*4882a593Smuzhiyun static void elo_disconnect(struct serio *serio)
287*4882a593Smuzhiyun {
288*4882a593Smuzhiyun 	struct elo *elo = serio_get_drvdata(serio);
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	input_get_device(elo->dev);
291*4882a593Smuzhiyun 	input_unregister_device(elo->dev);
292*4882a593Smuzhiyun 	serio_close(serio);
293*4882a593Smuzhiyun 	serio_set_drvdata(serio, NULL);
294*4882a593Smuzhiyun 	input_put_device(elo->dev);
295*4882a593Smuzhiyun 	kfree(elo);
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun /*
299*4882a593Smuzhiyun  * elo_connect() is the routine that is called when someone adds a
300*4882a593Smuzhiyun  * new serio device that supports Gunze protocol and registers it as
301*4882a593Smuzhiyun  * an input device.
302*4882a593Smuzhiyun  */
303*4882a593Smuzhiyun 
elo_connect(struct serio * serio,struct serio_driver * drv)304*4882a593Smuzhiyun static int elo_connect(struct serio *serio, struct serio_driver *drv)
305*4882a593Smuzhiyun {
306*4882a593Smuzhiyun 	struct elo *elo;
307*4882a593Smuzhiyun 	struct input_dev *input_dev;
308*4882a593Smuzhiyun 	int err;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	elo = kzalloc(sizeof(struct elo), GFP_KERNEL);
311*4882a593Smuzhiyun 	input_dev = input_allocate_device();
312*4882a593Smuzhiyun 	if (!elo || !input_dev) {
313*4882a593Smuzhiyun 		err = -ENOMEM;
314*4882a593Smuzhiyun 		goto fail1;
315*4882a593Smuzhiyun 	}
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	elo->serio = serio;
318*4882a593Smuzhiyun 	elo->id = serio->id.id;
319*4882a593Smuzhiyun 	elo->dev = input_dev;
320*4882a593Smuzhiyun 	elo->expected_packet = ELO10_TOUCH_PACKET;
321*4882a593Smuzhiyun 	mutex_init(&elo->cmd_mutex);
322*4882a593Smuzhiyun 	init_completion(&elo->cmd_done);
323*4882a593Smuzhiyun 	snprintf(elo->phys, sizeof(elo->phys), "%s/input0", serio->phys);
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	input_dev->name = "Elo Serial TouchScreen";
326*4882a593Smuzhiyun 	input_dev->phys = elo->phys;
327*4882a593Smuzhiyun 	input_dev->id.bustype = BUS_RS232;
328*4882a593Smuzhiyun 	input_dev->id.vendor = SERIO_ELO;
329*4882a593Smuzhiyun 	input_dev->id.product = elo->id;
330*4882a593Smuzhiyun 	input_dev->id.version = 0x0100;
331*4882a593Smuzhiyun 	input_dev->dev.parent = &serio->dev;
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
334*4882a593Smuzhiyun 	input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
335*4882a593Smuzhiyun 
336*4882a593Smuzhiyun 	serio_set_drvdata(serio, elo);
337*4882a593Smuzhiyun 	err = serio_open(serio, drv);
338*4882a593Smuzhiyun 	if (err)
339*4882a593Smuzhiyun 		goto fail2;
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	switch (elo->id) {
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	case 0: /* 10-byte protocol */
344*4882a593Smuzhiyun 		if (elo_setup_10(elo)) {
345*4882a593Smuzhiyun 			err = -EIO;
346*4882a593Smuzhiyun 			goto fail3;
347*4882a593Smuzhiyun 		}
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 		break;
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	case 1: /* 6-byte protocol */
352*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_PRESSURE, 0, 15, 0, 0);
353*4882a593Smuzhiyun 		fallthrough;
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	case 2: /* 4-byte protocol */
356*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_X, 96, 4000, 0, 0);
357*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_Y, 96, 4000, 0, 0);
358*4882a593Smuzhiyun 		break;
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	case 3: /* 3-byte protocol */
361*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_X, 0, 255, 0, 0);
362*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_Y, 0, 255, 0, 0);
363*4882a593Smuzhiyun 		break;
364*4882a593Smuzhiyun 	}
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	err = input_register_device(elo->dev);
367*4882a593Smuzhiyun 	if (err)
368*4882a593Smuzhiyun 		goto fail3;
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	return 0;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun  fail3: serio_close(serio);
373*4882a593Smuzhiyun  fail2:	serio_set_drvdata(serio, NULL);
374*4882a593Smuzhiyun  fail1:	input_free_device(input_dev);
375*4882a593Smuzhiyun 	kfree(elo);
376*4882a593Smuzhiyun 	return err;
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun /*
380*4882a593Smuzhiyun  * The serio driver structure.
381*4882a593Smuzhiyun  */
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun static const struct serio_device_id elo_serio_ids[] = {
384*4882a593Smuzhiyun 	{
385*4882a593Smuzhiyun 		.type	= SERIO_RS232,
386*4882a593Smuzhiyun 		.proto	= SERIO_ELO,
387*4882a593Smuzhiyun 		.id	= SERIO_ANY,
388*4882a593Smuzhiyun 		.extra	= SERIO_ANY,
389*4882a593Smuzhiyun 	},
390*4882a593Smuzhiyun 	{ 0 }
391*4882a593Smuzhiyun };
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun MODULE_DEVICE_TABLE(serio, elo_serio_ids);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun static struct serio_driver elo_drv = {
396*4882a593Smuzhiyun 	.driver		= {
397*4882a593Smuzhiyun 		.name	= "elo",
398*4882a593Smuzhiyun 	},
399*4882a593Smuzhiyun 	.description	= DRIVER_DESC,
400*4882a593Smuzhiyun 	.id_table	= elo_serio_ids,
401*4882a593Smuzhiyun 	.interrupt	= elo_interrupt,
402*4882a593Smuzhiyun 	.connect	= elo_connect,
403*4882a593Smuzhiyun 	.disconnect	= elo_disconnect,
404*4882a593Smuzhiyun };
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun module_serio_driver(elo_drv);
407