]>
Commit | Line | Data |
---|---|---|
1a59d1b8 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 | 2 | /* |
1da177e4 LT |
3 | * Copyright (c) 1999-2001 Vojtech Pavlik |
4 | */ | |
5 | ||
6 | /* | |
7 | * XT keyboard driver for Linux | |
8 | */ | |
9 | ||
10 | /* | |
1da177e4 LT |
11 | */ |
12 | ||
13 | #include <linux/slab.h> | |
14 | #include <linux/module.h> | |
15 | #include <linux/input.h> | |
1da177e4 LT |
16 | #include <linux/serio.h> |
17 | ||
18 | #define DRIVER_DESC "XT keyboard driver" | |
19 | ||
20 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
21 | MODULE_DESCRIPTION(DRIVER_DESC); | |
22 | MODULE_LICENSE("GPL"); | |
23 | ||
24 | #define XTKBD_EMUL0 0xe0 | |
25 | #define XTKBD_EMUL1 0xe1 | |
26 | #define XTKBD_KEY 0x7f | |
27 | #define XTKBD_RELEASE 0x80 | |
28 | ||
29 | static unsigned char xtkbd_keycode[256] = { | |
30 | 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, | |
31 | 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, | |
32 | 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, | |
33 | 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, | |
34 | 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, | |
35 | 80, 81, 82, 83, 0, 0, 0, 87, 88, 0, 0, 0, 0, 0, 0, 0, | |
36 | 0, 0, 0, 0, 0, 87, 88, 0, 0, 0, 0,110,111,103,108,105, | |
37 | 106 | |
38 | }; | |
39 | ||
1da177e4 LT |
40 | struct xtkbd { |
41 | unsigned char keycode[256]; | |
3c42f0c3 | 42 | struct input_dev *dev; |
1da177e4 LT |
43 | struct serio *serio; |
44 | char phys[32]; | |
45 | }; | |
46 | ||
47 | static irqreturn_t xtkbd_interrupt(struct serio *serio, | |
7d12e780 | 48 | unsigned char data, unsigned int flags) |
1da177e4 LT |
49 | { |
50 | struct xtkbd *xtkbd = serio_get_drvdata(serio); | |
51 | ||
52 | switch (data) { | |
53 | case XTKBD_EMUL0: | |
54 | case XTKBD_EMUL1: | |
55 | break; | |
56 | default: | |
57 | ||
58 | if (xtkbd->keycode[data & XTKBD_KEY]) { | |
3c42f0c3 DT |
59 | input_report_key(xtkbd->dev, xtkbd->keycode[data & XTKBD_KEY], !(data & XTKBD_RELEASE)); |
60 | input_sync(xtkbd->dev); | |
1da177e4 LT |
61 | } else { |
62 | printk(KERN_WARNING "xtkbd.c: Unknown key (scancode %#x) %s.\n", | |
63 | data & XTKBD_KEY, data & XTKBD_RELEASE ? "released" : "pressed"); | |
64 | } | |
65 | } | |
66 | return IRQ_HANDLED; | |
67 | } | |
68 | ||
69 | static int xtkbd_connect(struct serio *serio, struct serio_driver *drv) | |
70 | { | |
71 | struct xtkbd *xtkbd; | |
3c42f0c3 DT |
72 | struct input_dev *input_dev; |
73 | int err = -ENOMEM; | |
1da177e4 | 74 | int i; |
1da177e4 | 75 | |
3c42f0c3 DT |
76 | xtkbd = kmalloc(sizeof(struct xtkbd), GFP_KERNEL); |
77 | input_dev = input_allocate_device(); | |
78 | if (!xtkbd || !input_dev) | |
2b03b60e | 79 | goto fail1; |
1da177e4 LT |
80 | |
81 | xtkbd->serio = serio; | |
3c42f0c3 | 82 | xtkbd->dev = input_dev; |
ea08c6fa | 83 | snprintf(xtkbd->phys, sizeof(xtkbd->phys), "%s/input0", serio->phys); |
3c42f0c3 | 84 | memcpy(xtkbd->keycode, xtkbd_keycode, sizeof(xtkbd->keycode)); |
1da177e4 | 85 | |
3c42f0c3 DT |
86 | input_dev->name = "XT Keyboard"; |
87 | input_dev->phys = xtkbd->phys; | |
88 | input_dev->id.bustype = BUS_XTKBD; | |
89 | input_dev->id.vendor = 0x0001; | |
90 | input_dev->id.product = 0x0001; | |
91 | input_dev->id.version = 0x0100; | |
469ba4df | 92 | input_dev->dev.parent = &serio->dev; |
1da177e4 | 93 | |
7b19ada2 | 94 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP); |
3c42f0c3 DT |
95 | input_dev->keycode = xtkbd->keycode; |
96 | input_dev->keycodesize = sizeof(unsigned char); | |
97 | input_dev->keycodemax = ARRAY_SIZE(xtkbd_keycode); | |
1da177e4 | 98 | |
1da177e4 | 99 | for (i = 0; i < 255; i++) |
3c42f0c3 DT |
100 | set_bit(xtkbd->keycode[i], input_dev->keybit); |
101 | clear_bit(0, input_dev->keybit); | |
1da177e4 | 102 | |
3c42f0c3 | 103 | serio_set_drvdata(serio, xtkbd); |
1da177e4 | 104 | |
3c42f0c3 DT |
105 | err = serio_open(serio, drv); |
106 | if (err) | |
2b03b60e DT |
107 | goto fail2; |
108 | ||
109 | err = input_register_device(xtkbd->dev); | |
110 | if (err) | |
111 | goto fail3; | |
1da177e4 LT |
112 | |
113 | return 0; | |
3c42f0c3 | 114 | |
2b03b60e DT |
115 | fail3: serio_close(serio); |
116 | fail2: serio_set_drvdata(serio, NULL); | |
117 | fail1: input_free_device(input_dev); | |
3c42f0c3 DT |
118 | kfree(xtkbd); |
119 | return err; | |
1da177e4 LT |
120 | } |
121 | ||
122 | static void xtkbd_disconnect(struct serio *serio) | |
123 | { | |
124 | struct xtkbd *xtkbd = serio_get_drvdata(serio); | |
125 | ||
1da177e4 LT |
126 | serio_close(serio); |
127 | serio_set_drvdata(serio, NULL); | |
3c42f0c3 | 128 | input_unregister_device(xtkbd->dev); |
1da177e4 LT |
129 | kfree(xtkbd); |
130 | } | |
131 | ||
e527a87c | 132 | static const struct serio_device_id xtkbd_serio_ids[] = { |
1da177e4 LT |
133 | { |
134 | .type = SERIO_XT, | |
135 | .proto = SERIO_ANY, | |
136 | .id = SERIO_ANY, | |
137 | .extra = SERIO_ANY, | |
138 | }, | |
139 | { 0 } | |
140 | }; | |
141 | ||
142 | MODULE_DEVICE_TABLE(serio, xtkbd_serio_ids); | |
143 | ||
144 | static struct serio_driver xtkbd_drv = { | |
145 | .driver = { | |
146 | .name = "xtkbd", | |
147 | }, | |
148 | .description = DRIVER_DESC, | |
149 | .id_table = xtkbd_serio_ids, | |
150 | .interrupt = xtkbd_interrupt, | |
151 | .connect = xtkbd_connect, | |
152 | .disconnect = xtkbd_disconnect, | |
153 | }; | |
154 | ||
65ac9f7a | 155 | module_serio_driver(xtkbd_drv); |