2 * Wistron laptop button driver
3 * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
4 * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
6 * You can redistribute and/or modify this program under the terms of the
7 * GNU General Public License version 2 as published by the Free Software
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
13 * Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 59 Temple Place Suite 330, Boston, MA 02111-1307, USA.
20 #include <linux/dmi.h>
21 #include <linux/init.h>
22 #include <linux/input.h>
23 #include <linux/interrupt.h>
24 #include <linux/kernel.h>
25 #include <linux/mc146818rtc.h>
26 #include <linux/module.h>
27 #include <linux/preempt.h>
28 #include <linux/string.h>
29 #include <linux/timer.h>
30 #include <linux/types.h>
33 * Number of attempts to read data from queue per poll;
34 * the queue can hold up to 31 entries
36 #define MAX_POLL_ITERATIONS 64
38 #define POLL_FREQUENCY 10 /* Number of polls per second */
40 #if POLL_FREQUENCY > HZ
41 #error "POLL_FREQUENCY too high"
44 /* BIOS subsystem IDs */
46 #define BLUETOOTH 0x34
48 MODULE_AUTHOR("Miloslav Trmac <mitr@volny.cz>");
49 MODULE_DESCRIPTION("Wistron laptop button driver");
50 MODULE_LICENSE("GPL v2");
51 MODULE_VERSION("0.1");
53 static int force; /* = 0; */
54 module_param(force, bool, 0);
55 MODULE_PARM_DESC(force, "Load even if computer is not in database");
57 static char *keymap_name; /* = NULL; */
58 module_param_named(keymap, keymap_name, charp, 0);
59 MODULE_PARM_DESC(keymap, "Keymap name, if it can't be autodetected");
61 /* BIOS interface implementation */
63 static void __iomem *bios_entry_point; /* BIOS routine entry point */
64 static void __iomem *bios_code_map_base;
65 static void __iomem *bios_data_map_base;
67 static u8 cmos_address;
73 static void call_bios(struct regs *regs)
78 local_irq_save(flags);
79 asm volatile ("pushl %%ebp;"
83 : "=a" (regs->eax), "=b" (regs->ebx), "=c" (regs->ecx)
84 : "0" (regs->eax), "1" (regs->ebx), "2" (regs->ecx),
85 "m" (bios_entry_point), "m" (bios_data_map_base)
86 : "edx", "edi", "esi", "memory");
87 local_irq_restore(flags);
91 static size_t __init locate_wistron_bios(void __iomem *base)
93 static const unsigned char __initdata signature[] =
94 { 0x42, 0x21, 0x55, 0x30 };
97 for (offset = 0; offset < 0x10000; offset += 0x10) {
98 if (check_signature(base + offset, signature,
99 sizeof(signature)) != 0)
105 static int __init map_bios(void)
111 base = ioremap(0xF0000, 0x10000); /* Can't fail */
112 offset = locate_wistron_bios(base);
114 printk(KERN_ERR "wistron_btns: BIOS entry point not found\n");
119 entry_point = readl(base + offset + 5);
121 "wistron_btns: BIOS signature found at %p, entry point %08X\n",
122 base + offset, entry_point);
124 if (entry_point >= 0xF0000) {
125 bios_code_map_base = base;
126 bios_entry_point = bios_code_map_base + (entry_point & 0xFFFF);
129 bios_code_map_base = ioremap(entry_point & ~0x3FFF, 0x4000);
130 if (bios_code_map_base == NULL) {
132 "wistron_btns: Can't map BIOS code at %08X\n",
133 entry_point & ~0x3FFF);
136 bios_entry_point = bios_code_map_base + (entry_point & 0x3FFF);
138 /* The Windows driver maps 0x10000 bytes, we keep only one page... */
139 bios_data_map_base = ioremap(0x400, 0xc00);
140 if (bios_data_map_base == NULL) {
141 printk(KERN_ERR "wistron_btns: Can't map BIOS data\n");
147 iounmap(bios_code_map_base);
152 static void __exit unmap_bios(void)
154 iounmap(bios_code_map_base);
155 iounmap(bios_data_map_base);
160 static u16 bios_pop_queue(void)
164 memset(®s, 0, sizeof (regs));
173 static void __init bios_attach(void)
177 memset(®s, 0, sizeof (regs));
183 static void __exit bios_detach(void)
187 memset(®s, 0, sizeof (regs));
193 static u8 __init bios_get_cmos_address(void)
197 memset(®s, 0, sizeof (regs));
205 static u16 __init bios_get_default_setting(u8 subsys)
209 memset(®s, 0, sizeof (regs));
211 regs.ebx = 0x0200 | subsys;
217 static void bios_set_state(u8 subsys, int enable)
221 memset(®s, 0, sizeof (regs));
223 regs.ebx = (enable ? 0x0100 : 0x0000) | subsys;
227 /* Hardware database */
230 char type; /* See KE_* below */
232 unsigned keycode; /* For KE_KEY */
235 enum { KE_END, KE_KEY, KE_WIFI, KE_BLUETOOTH };
237 static const struct key_entry *keymap; /* = NULL; Current key map */
238 static int have_wifi;
239 static int have_bluetooth;
241 static int __init dmi_matched(struct dmi_system_id *dmi)
243 const struct key_entry *key;
245 keymap = dmi->driver_data;
246 for (key = keymap; key->type != KE_END; key++) {
247 if (key->type == KE_WIFI) {
250 } else if (key->type == KE_BLUETOOTH) {
258 static struct key_entry keymap_empty[] = {
262 static struct key_entry keymap_fs_amilo_pro_v2000[] = {
263 { KE_KEY, 0x01, KEY_HELP },
264 { KE_KEY, 0x11, KEY_PROG1 },
265 { KE_KEY, 0x12, KEY_PROG2 },
266 { KE_WIFI, 0x30, 0 },
267 { KE_KEY, 0x31, KEY_MAIL },
268 { KE_KEY, 0x36, KEY_WWW },
272 static struct key_entry keymap_wistron_ms2141[] = {
273 { KE_KEY, 0x11, KEY_PROG1 },
274 { KE_KEY, 0x12, KEY_PROG2 },
275 { KE_WIFI, 0x30, 0 },
276 { KE_KEY, 0x22, KEY_REWIND },
277 { KE_KEY, 0x23, KEY_FORWARD },
278 { KE_KEY, 0x24, KEY_PLAYPAUSE },
279 { KE_KEY, 0x25, KEY_STOPCD },
280 { KE_KEY, 0x31, KEY_MAIL },
281 { KE_KEY, 0x36, KEY_WWW },
285 static struct key_entry keymap_acer_aspire_1500[] = {
286 { KE_KEY, 0x11, KEY_PROG1 },
287 { KE_KEY, 0x12, KEY_PROG2 },
288 { KE_WIFI, 0x30, 0 },
289 { KE_KEY, 0x31, KEY_MAIL },
290 { KE_KEY, 0x36, KEY_WWW },
291 { KE_BLUETOOTH, 0x44, 0 },
296 * If your machine is not here (which is currently rather likely), please send
297 * a list of buttons and their key codes (reported when loading this module
298 * with force=1) and the output of dmidecode to $MODULE_AUTHOR.
300 static struct dmi_system_id dmi_ids[] = {
302 .callback = dmi_matched,
303 .ident = "Fujitsu-Siemens Amilo Pro V2000",
305 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
306 DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pro V2000"),
308 .driver_data = keymap_fs_amilo_pro_v2000
311 .callback = dmi_matched,
312 .ident = "Acer Aspire 1500",
314 DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
315 DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1500"),
317 .driver_data = keymap_acer_aspire_1500
322 static int __init select_keymap(void)
324 if (keymap_name != NULL) {
325 if (strcmp (keymap_name, "1557/MS2141") == 0)
326 keymap = keymap_wistron_ms2141;
328 printk(KERN_ERR "wistron_btns: Keymap unknown\n");
332 dmi_check_system(dmi_ids);
333 if (keymap == NULL) {
335 printk(KERN_ERR "wistron_btns: System unknown\n");
338 keymap = keymap_empty;
343 /* Input layer interface */
345 static struct input_dev input_dev = {
346 .name = "Wistron laptop buttons",
349 static void __init setup_input_dev(void)
351 const struct key_entry *key;
353 for (key = keymap; key->type != KE_END; key++) {
354 if (key->type == KE_KEY) {
355 input_dev.evbit[LONG(EV_KEY)] = BIT(EV_KEY);
356 input_dev.keybit[LONG(key->keycode)]
357 |= BIT(key->keycode);
361 input_register_device(&input_dev);
364 static void report_key(unsigned keycode)
366 input_report_key(&input_dev, keycode, 1);
367 input_sync(&input_dev);
368 input_report_key(&input_dev, keycode, 0);
369 input_sync(&input_dev);
374 static int wifi_enabled;
375 static int bluetooth_enabled;
377 static void poll_bios(unsigned long);
379 static struct timer_list poll_timer = TIMER_INITIALIZER(poll_bios, 0, 0);
381 static void handle_key(u8 code)
383 const struct key_entry *key;
385 for (key = keymap; key->type != KE_END; key++) {
386 if (code == key->code) {
389 report_key(key->keycode);
394 wifi_enabled = !wifi_enabled;
395 bios_set_state(WIFI, wifi_enabled);
400 if (have_bluetooth) {
401 bluetooth_enabled = !bluetooth_enabled;
402 bios_set_state(BLUETOOTH, bluetooth_enabled);
413 printk(KERN_NOTICE "wistron_btns: Unknown key code %02X\n", code);
416 static void poll_bios(unsigned long discard)
422 qlen = CMOS_READ(cmos_address);
425 val = bios_pop_queue();
426 if (val != 0 && !discard)
430 mod_timer(&poll_timer, jiffies + HZ / POLL_FREQUENCY);
433 static int __init wb_module_init(void)
437 err = select_keymap();
444 cmos_address = bios_get_cmos_address();
446 u16 wifi = bios_get_default_setting(WIFI);
448 wifi_enabled = (wifi & 2) ? 1 : 0;
453 bios_set_state(WIFI, wifi_enabled);
455 if (have_bluetooth) {
456 u16 bt = bios_get_default_setting(BLUETOOTH);
458 bluetooth_enabled = (bt & 2) ? 1 : 0;
463 bios_set_state(BLUETOOTH, bluetooth_enabled);
468 poll_bios(1); /* Flush stale event queue and arm timer */
473 static void __exit wb_module_exit(void)
475 del_timer_sync(&poll_timer);
476 input_unregister_device(&input_dev);
481 module_init(wb_module_init);
482 module_exit(wb_module_exit);