Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * $Id: xtkbd.c,v 1.11 2001/09/25 10:12:07 vojtech Exp $ | |
3 | * | |
4 | * Copyright (c) 1999-2001 Vojtech Pavlik | |
5 | */ | |
6 | ||
7 | /* | |
8 | * XT keyboard driver for Linux | |
9 | */ | |
10 | ||
11 | /* | |
12 | * This program is free software; you can redistribute it and/or modify | |
13 | * it under the terms of the GNU General Public License as published by | |
14 | * the Free Software Foundation; either version 2 of the License, or | |
15 | * (at your option) any later version. | |
16 | * | |
17 | * This program is distributed in the hope that it will be useful, | |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
20 | * GNU General Public License for more details. | |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with this program; if not, write to the Free Software | |
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
25 | * | |
26 | * Should you need to contact me, the author, you can do so either by | |
27 | * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: | |
28 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic | |
29 | */ | |
30 | ||
31 | #include <linux/slab.h> | |
32 | #include <linux/module.h> | |
33 | #include <linux/input.h> | |
34 | #include <linux/init.h> | |
35 | #include <linux/serio.h> | |
36 | ||
37 | #define DRIVER_DESC "XT keyboard driver" | |
38 | ||
39 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
40 | MODULE_DESCRIPTION(DRIVER_DESC); | |
41 | MODULE_LICENSE("GPL"); | |
42 | ||
43 | #define XTKBD_EMUL0 0xe0 | |
44 | #define XTKBD_EMUL1 0xe1 | |
45 | #define XTKBD_KEY 0x7f | |
46 | #define XTKBD_RELEASE 0x80 | |
47 | ||
48 | static unsigned char xtkbd_keycode[256] = { | |
49 | 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, | |
50 | 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, | |
51 | 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, | |
52 | 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, | |
53 | 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, | |
54 | 80, 81, 82, 83, 0, 0, 0, 87, 88, 0, 0, 0, 0, 0, 0, 0, | |
55 | 0, 0, 0, 0, 0, 87, 88, 0, 0, 0, 0,110,111,103,108,105, | |
56 | 106 | |
57 | }; | |
58 | ||
1da177e4 LT |
59 | struct xtkbd { |
60 | unsigned char keycode[256]; | |
3c42f0c3 | 61 | struct input_dev *dev; |
1da177e4 LT |
62 | struct serio *serio; |
63 | char phys[32]; | |
64 | }; | |
65 | ||
66 | static irqreturn_t xtkbd_interrupt(struct serio *serio, | |
7d12e780 | 67 | unsigned char data, unsigned int flags) |
1da177e4 LT |
68 | { |
69 | struct xtkbd *xtkbd = serio_get_drvdata(serio); | |
70 | ||
71 | switch (data) { | |
72 | case XTKBD_EMUL0: | |
73 | case XTKBD_EMUL1: | |
74 | break; | |
75 | default: | |
76 | ||
77 | if (xtkbd->keycode[data & XTKBD_KEY]) { | |
3c42f0c3 DT |
78 | input_report_key(xtkbd->dev, xtkbd->keycode[data & XTKBD_KEY], !(data & XTKBD_RELEASE)); |
79 | input_sync(xtkbd->dev); | |
1da177e4 LT |
80 | } else { |
81 | printk(KERN_WARNING "xtkbd.c: Unknown key (scancode %#x) %s.\n", | |
82 | data & XTKBD_KEY, data & XTKBD_RELEASE ? "released" : "pressed"); | |
83 | } | |
84 | } | |
85 | return IRQ_HANDLED; | |
86 | } | |
87 | ||
88 | static int xtkbd_connect(struct serio *serio, struct serio_driver *drv) | |
89 | { | |
90 | struct xtkbd *xtkbd; | |
3c42f0c3 DT |
91 | struct input_dev *input_dev; |
92 | int err = -ENOMEM; | |
1da177e4 | 93 | int i; |
1da177e4 | 94 | |
3c42f0c3 DT |
95 | xtkbd = kmalloc(sizeof(struct xtkbd), GFP_KERNEL); |
96 | input_dev = input_allocate_device(); | |
97 | if (!xtkbd || !input_dev) | |
98 | goto fail; | |
1da177e4 LT |
99 | |
100 | xtkbd->serio = serio; | |
3c42f0c3 | 101 | xtkbd->dev = input_dev; |
ea08c6fa | 102 | snprintf(xtkbd->phys, sizeof(xtkbd->phys), "%s/input0", serio->phys); |
3c42f0c3 | 103 | memcpy(xtkbd->keycode, xtkbd_keycode, sizeof(xtkbd->keycode)); |
1da177e4 | 104 | |
3c42f0c3 DT |
105 | input_dev->name = "XT Keyboard"; |
106 | input_dev->phys = xtkbd->phys; | |
107 | input_dev->id.bustype = BUS_XTKBD; | |
108 | input_dev->id.vendor = 0x0001; | |
109 | input_dev->id.product = 0x0001; | |
110 | input_dev->id.version = 0x0100; | |
111 | input_dev->cdev.dev = &serio->dev; | |
112 | input_dev->private = xtkbd; | |
1da177e4 | 113 | |
3c42f0c3 DT |
114 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
115 | input_dev->keycode = xtkbd->keycode; | |
116 | input_dev->keycodesize = sizeof(unsigned char); | |
117 | input_dev->keycodemax = ARRAY_SIZE(xtkbd_keycode); | |
1da177e4 | 118 | |
1da177e4 | 119 | for (i = 0; i < 255; i++) |
3c42f0c3 DT |
120 | set_bit(xtkbd->keycode[i], input_dev->keybit); |
121 | clear_bit(0, input_dev->keybit); | |
1da177e4 | 122 | |
3c42f0c3 | 123 | serio_set_drvdata(serio, xtkbd); |
1da177e4 | 124 | |
3c42f0c3 DT |
125 | err = serio_open(serio, drv); |
126 | if (err) | |
127 | goto fail; | |
1da177e4 | 128 | |
3c42f0c3 | 129 | input_register_device(xtkbd->dev); |
1da177e4 | 130 | return 0; |
3c42f0c3 DT |
131 | |
132 | fail: serio_set_drvdata(serio, NULL); | |
133 | input_free_device(input_dev); | |
134 | kfree(xtkbd); | |
135 | return err; | |
1da177e4 LT |
136 | } |
137 | ||
138 | static void xtkbd_disconnect(struct serio *serio) | |
139 | { | |
140 | struct xtkbd *xtkbd = serio_get_drvdata(serio); | |
141 | ||
1da177e4 LT |
142 | serio_close(serio); |
143 | serio_set_drvdata(serio, NULL); | |
3c42f0c3 | 144 | input_unregister_device(xtkbd->dev); |
1da177e4 LT |
145 | kfree(xtkbd); |
146 | } | |
147 | ||
148 | static struct serio_device_id xtkbd_serio_ids[] = { | |
149 | { | |
150 | .type = SERIO_XT, | |
151 | .proto = SERIO_ANY, | |
152 | .id = SERIO_ANY, | |
153 | .extra = SERIO_ANY, | |
154 | }, | |
155 | { 0 } | |
156 | }; | |
157 | ||
158 | MODULE_DEVICE_TABLE(serio, xtkbd_serio_ids); | |
159 | ||
160 | static struct serio_driver xtkbd_drv = { | |
161 | .driver = { | |
162 | .name = "xtkbd", | |
163 | }, | |
164 | .description = DRIVER_DESC, | |
165 | .id_table = xtkbd_serio_ids, | |
166 | .interrupt = xtkbd_interrupt, | |
167 | .connect = xtkbd_connect, | |
168 | .disconnect = xtkbd_disconnect, | |
169 | }; | |
170 | ||
171 | static int __init xtkbd_init(void) | |
172 | { | |
173 | serio_register_driver(&xtkbd_drv); | |
174 | return 0; | |
175 | } | |
176 | ||
177 | static void __exit xtkbd_exit(void) | |
178 | { | |
179 | serio_unregister_driver(&xtkbd_drv); | |
180 | } | |
181 | ||
182 | module_init(xtkbd_init); | |
183 | module_exit(xtkbd_exit); |