root/drivers/input/misc/wistron_btns.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. call_bios
  2. locate_wistron_bios
  3. map_bios
  4. unmap_bios
  5. bios_pop_queue
  6. bios_attach
  7. bios_detach
  8. bios_get_cmos_address
  9. bios_get_default_setting
  10. bios_set_state
  11. dmi_matched
  12. copy_keymap
  13. select_keymap
  14. wistron_mail_led_set
  15. wistron_wifi_led_set
  16. wistron_led_init
  17. wistron_led_remove
  18. wistron_led_suspend
  19. wistron_led_resume
  20. handle_key
  21. poll_bios
  22. wistron_flush
  23. wistron_poll
  24. wistron_setup_keymap
  25. setup_input_dev
  26. wistron_probe
  27. wistron_remove
  28. wistron_suspend
  29. wistron_resume
  30. wb_module_init
  31. wb_module_exit

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Wistron laptop button driver
   4  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
   5  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
   6  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
   7  */
   8 #include <linux/io.h>
   9 #include <linux/dmi.h>
  10 #include <linux/init.h>
  11 #include <linux/input-polldev.h>
  12 #include <linux/input/sparse-keymap.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/jiffies.h>
  15 #include <linux/kernel.h>
  16 #include <linux/mc146818rtc.h>
  17 #include <linux/module.h>
  18 #include <linux/preempt.h>
  19 #include <linux/string.h>
  20 #include <linux/slab.h>
  21 #include <linux/types.h>
  22 #include <linux/platform_device.h>
  23 #include <linux/leds.h>
  24 
  25 /* How often we poll keys - msecs */
  26 #define POLL_INTERVAL_DEFAULT   500 /* when idle */
  27 #define POLL_INTERVAL_BURST     100 /* when a key was recently pressed */
  28 
  29 /* BIOS subsystem IDs */
  30 #define WIFI            0x35
  31 #define BLUETOOTH       0x34
  32 #define MAIL_LED        0x31
  33 
  34 MODULE_AUTHOR("Miloslav Trmac <mitr@volny.cz>");
  35 MODULE_DESCRIPTION("Wistron laptop button driver");
  36 MODULE_LICENSE("GPL v2");
  37 
  38 static bool force; /* = 0; */
  39 module_param(force, bool, 0);
  40 MODULE_PARM_DESC(force, "Load even if computer is not in database");
  41 
  42 static char *keymap_name; /* = NULL; */
  43 module_param_named(keymap, keymap_name, charp, 0);
  44 MODULE_PARM_DESC(keymap, "Keymap name, if it can't be autodetected [generic, 1557/MS2141]");
  45 
  46 static struct platform_device *wistron_device;
  47 
  48  /* BIOS interface implementation */
  49 
  50 static void __iomem *bios_entry_point; /* BIOS routine entry point */
  51 static void __iomem *bios_code_map_base;
  52 static void __iomem *bios_data_map_base;
  53 
  54 static u8 cmos_address;
  55 
  56 struct regs {
  57         u32 eax, ebx, ecx;
  58 };
  59 
  60 static void call_bios(struct regs *regs)
  61 {
  62         unsigned long flags;
  63 
  64         preempt_disable();
  65         local_irq_save(flags);
  66         asm volatile ("pushl %%ebp;"
  67                       "movl %7, %%ebp;"
  68                       "call *%6;"
  69                       "popl %%ebp"
  70                       : "=a" (regs->eax), "=b" (regs->ebx), "=c" (regs->ecx)
  71                       : "0" (regs->eax), "1" (regs->ebx), "2" (regs->ecx),
  72                         "m" (bios_entry_point), "m" (bios_data_map_base)
  73                       : "edx", "edi", "esi", "memory");
  74         local_irq_restore(flags);
  75         preempt_enable();
  76 }
  77 
  78 static ssize_t __init locate_wistron_bios(void __iomem *base)
  79 {
  80         static unsigned char __initdata signature[] =
  81                 { 0x42, 0x21, 0x55, 0x30 };
  82         ssize_t offset;
  83 
  84         for (offset = 0; offset < 0x10000; offset += 0x10) {
  85                 if (check_signature(base + offset, signature,
  86                                     sizeof(signature)) != 0)
  87                         return offset;
  88         }
  89         return -1;
  90 }
  91 
  92 static int __init map_bios(void)
  93 {
  94         void __iomem *base;
  95         ssize_t offset;
  96         u32 entry_point;
  97 
  98         base = ioremap(0xF0000, 0x10000); /* Can't fail */
  99         offset = locate_wistron_bios(base);
 100         if (offset < 0) {
 101                 printk(KERN_ERR "wistron_btns: BIOS entry point not found\n");
 102                 iounmap(base);
 103                 return -ENODEV;
 104         }
 105 
 106         entry_point = readl(base + offset + 5);
 107         printk(KERN_DEBUG
 108                 "wistron_btns: BIOS signature found at %p, entry point %08X\n",
 109                 base + offset, entry_point);
 110 
 111         if (entry_point >= 0xF0000) {
 112                 bios_code_map_base = base;
 113                 bios_entry_point = bios_code_map_base + (entry_point & 0xFFFF);
 114         } else {
 115                 iounmap(base);
 116                 bios_code_map_base = ioremap(entry_point & ~0x3FFF, 0x4000);
 117                 if (bios_code_map_base == NULL) {
 118                         printk(KERN_ERR
 119                                 "wistron_btns: Can't map BIOS code at %08X\n",
 120                                 entry_point & ~0x3FFF);
 121                         goto err;
 122                 }
 123                 bios_entry_point = bios_code_map_base + (entry_point & 0x3FFF);
 124         }
 125         /* The Windows driver maps 0x10000 bytes, we keep only one page... */
 126         bios_data_map_base = ioremap(0x400, 0xc00);
 127         if (bios_data_map_base == NULL) {
 128                 printk(KERN_ERR "wistron_btns: Can't map BIOS data\n");
 129                 goto err_code;
 130         }
 131         return 0;
 132 
 133 err_code:
 134         iounmap(bios_code_map_base);
 135 err:
 136         return -ENOMEM;
 137 }
 138 
 139 static inline void unmap_bios(void)
 140 {
 141         iounmap(bios_code_map_base);
 142         iounmap(bios_data_map_base);
 143 }
 144 
 145  /* BIOS calls */
 146 
 147 static u16 bios_pop_queue(void)
 148 {
 149         struct regs regs;
 150 
 151         memset(&regs, 0, sizeof (regs));
 152         regs.eax = 0x9610;
 153         regs.ebx = 0x061C;
 154         regs.ecx = 0x0000;
 155         call_bios(&regs);
 156 
 157         return regs.eax;
 158 }
 159 
 160 static void bios_attach(void)
 161 {
 162         struct regs regs;
 163 
 164         memset(&regs, 0, sizeof (regs));
 165         regs.eax = 0x9610;
 166         regs.ebx = 0x012E;
 167         call_bios(&regs);
 168 }
 169 
 170 static void bios_detach(void)
 171 {
 172         struct regs regs;
 173 
 174         memset(&regs, 0, sizeof (regs));
 175         regs.eax = 0x9610;
 176         regs.ebx = 0x002E;
 177         call_bios(&regs);
 178 }
 179 
 180 static u8 bios_get_cmos_address(void)
 181 {
 182         struct regs regs;
 183 
 184         memset(&regs, 0, sizeof (regs));
 185         regs.eax = 0x9610;
 186         regs.ebx = 0x051C;
 187         call_bios(&regs);
 188 
 189         return regs.ecx;
 190 }
 191 
 192 static u16 bios_get_default_setting(u8 subsys)
 193 {
 194         struct regs regs;
 195 
 196         memset(&regs, 0, sizeof (regs));
 197         regs.eax = 0x9610;
 198         regs.ebx = 0x0200 | subsys;
 199         call_bios(&regs);
 200 
 201         return regs.eax;
 202 }
 203 
 204 static void bios_set_state(u8 subsys, int enable)
 205 {
 206         struct regs regs;
 207 
 208         memset(&regs, 0, sizeof (regs));
 209         regs.eax = 0x9610;
 210         regs.ebx = (enable ? 0x0100 : 0x0000) | subsys;
 211         call_bios(&regs);
 212 }
 213 
 214 /* Hardware database */
 215 
 216 #define KE_WIFI         (KE_LAST + 1)
 217 #define KE_BLUETOOTH    (KE_LAST + 2)
 218 
 219 #define FE_MAIL_LED 0x01
 220 #define FE_WIFI_LED 0x02
 221 #define FE_UNTESTED 0x80
 222 
 223 static struct key_entry *keymap; /* = NULL; Current key map */
 224 static bool have_wifi;
 225 static bool have_bluetooth;
 226 static int leds_present;        /* bitmask of leds present */
 227 
 228 static int __init dmi_matched(const struct dmi_system_id *dmi)
 229 {
 230         const struct key_entry *key;
 231 
 232         keymap = dmi->driver_data;
 233         for (key = keymap; key->type != KE_END; key++) {
 234                 if (key->type == KE_WIFI)
 235                         have_wifi = true;
 236                 else if (key->type == KE_BLUETOOTH)
 237                         have_bluetooth = true;
 238         }
 239         leds_present = key->code & (FE_MAIL_LED | FE_WIFI_LED);
 240 
 241         return 1;
 242 }
 243 
 244 static struct key_entry keymap_empty[] __initdata = {
 245         { KE_END, 0 }
 246 };
 247 
 248 static struct key_entry keymap_fs_amilo_pro_v2000[] __initdata = {
 249         { KE_KEY,  0x01, {KEY_HELP} },
 250         { KE_KEY,  0x11, {KEY_PROG1} },
 251         { KE_KEY,  0x12, {KEY_PROG2} },
 252         { KE_WIFI, 0x30 },
 253         { KE_KEY,  0x31, {KEY_MAIL} },
 254         { KE_KEY,  0x36, {KEY_WWW} },
 255         { KE_END,  0 }
 256 };
 257 
 258 static struct key_entry keymap_fs_amilo_pro_v3505[] __initdata = {
 259         { KE_KEY,       0x01, {KEY_HELP} },          /* Fn+F1 */
 260         { KE_KEY,       0x06, {KEY_DISPLAYTOGGLE} }, /* Fn+F4 */
 261         { KE_BLUETOOTH, 0x30 },                      /* Fn+F10 */
 262         { KE_KEY,       0x31, {KEY_MAIL} },          /* mail button */
 263         { KE_KEY,       0x36, {KEY_WWW} },           /* www button */
 264         { KE_WIFI,      0x78 },                      /* satellite dish button */
 265         { KE_END,       0 }
 266 };
 267 
 268 static struct key_entry keymap_fs_amilo_pro_v8210[] __initdata = {
 269         { KE_KEY,       0x01, {KEY_HELP} },          /* Fn+F1 */
 270         { KE_KEY,       0x06, {KEY_DISPLAYTOGGLE} }, /* Fn+F4 */
 271         { KE_BLUETOOTH, 0x30 },                      /* Fn+F10 */
 272         { KE_KEY,       0x31, {KEY_MAIL} },          /* mail button */
 273         { KE_KEY,       0x36, {KEY_WWW} },           /* www button */
 274         { KE_WIFI,      0x78 },                      /* satelite dish button */
 275         { KE_END,       FE_WIFI_LED }
 276 };
 277 
 278 static struct key_entry keymap_fujitsu_n3510[] __initdata = {
 279         { KE_KEY, 0x11, {KEY_PROG1} },
 280         { KE_KEY, 0x12, {KEY_PROG2} },
 281         { KE_KEY, 0x36, {KEY_WWW} },
 282         { KE_KEY, 0x31, {KEY_MAIL} },
 283         { KE_KEY, 0x71, {KEY_STOPCD} },
 284         { KE_KEY, 0x72, {KEY_PLAYPAUSE} },
 285         { KE_KEY, 0x74, {KEY_REWIND} },
 286         { KE_KEY, 0x78, {KEY_FORWARD} },
 287         { KE_END, 0 }
 288 };
 289 
 290 static struct key_entry keymap_wistron_ms2111[] __initdata = {
 291         { KE_KEY,  0x11, {KEY_PROG1} },
 292         { KE_KEY,  0x12, {KEY_PROG2} },
 293         { KE_KEY,  0x13, {KEY_PROG3} },
 294         { KE_KEY,  0x31, {KEY_MAIL} },
 295         { KE_KEY,  0x36, {KEY_WWW} },
 296         { KE_END, FE_MAIL_LED }
 297 };
 298 
 299 static struct key_entry keymap_wistron_md40100[] __initdata = {
 300         { KE_KEY, 0x01, {KEY_HELP} },
 301         { KE_KEY, 0x02, {KEY_CONFIG} },
 302         { KE_KEY, 0x31, {KEY_MAIL} },
 303         { KE_KEY, 0x36, {KEY_WWW} },
 304         { KE_KEY, 0x37, {KEY_DISPLAYTOGGLE} }, /* Display on/off */
 305         { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED }
 306 };
 307 
 308 static struct key_entry keymap_wistron_ms2141[] __initdata = {
 309         { KE_KEY,  0x11, {KEY_PROG1} },
 310         { KE_KEY,  0x12, {KEY_PROG2} },
 311         { KE_WIFI, 0x30 },
 312         { KE_KEY,  0x22, {KEY_REWIND} },
 313         { KE_KEY,  0x23, {KEY_FORWARD} },
 314         { KE_KEY,  0x24, {KEY_PLAYPAUSE} },
 315         { KE_KEY,  0x25, {KEY_STOPCD} },
 316         { KE_KEY,  0x31, {KEY_MAIL} },
 317         { KE_KEY,  0x36, {KEY_WWW} },
 318         { KE_END,  0 }
 319 };
 320 
 321 static struct key_entry keymap_acer_aspire_1500[] __initdata = {
 322         { KE_KEY, 0x01, {KEY_HELP} },
 323         { KE_KEY, 0x03, {KEY_POWER} },
 324         { KE_KEY, 0x11, {KEY_PROG1} },
 325         { KE_KEY, 0x12, {KEY_PROG2} },
 326         { KE_WIFI, 0x30 },
 327         { KE_KEY, 0x31, {KEY_MAIL} },
 328         { KE_KEY, 0x36, {KEY_WWW} },
 329         { KE_KEY, 0x49, {KEY_CONFIG} },
 330         { KE_BLUETOOTH, 0x44 },
 331         { KE_END, FE_UNTESTED }
 332 };
 333 
 334 static struct key_entry keymap_acer_aspire_1600[] __initdata = {
 335         { KE_KEY, 0x01, {KEY_HELP} },
 336         { KE_KEY, 0x03, {KEY_POWER} },
 337         { KE_KEY, 0x08, {KEY_MUTE} },
 338         { KE_KEY, 0x11, {KEY_PROG1} },
 339         { KE_KEY, 0x12, {KEY_PROG2} },
 340         { KE_KEY, 0x13, {KEY_PROG3} },
 341         { KE_KEY, 0x31, {KEY_MAIL} },
 342         { KE_KEY, 0x36, {KEY_WWW} },
 343         { KE_KEY, 0x49, {KEY_CONFIG} },
 344         { KE_WIFI, 0x30 },
 345         { KE_BLUETOOTH, 0x44 },
 346         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 347 };
 348 
 349 /* 3020 has been tested */
 350 static struct key_entry keymap_acer_aspire_5020[] __initdata = {
 351         { KE_KEY, 0x01, {KEY_HELP} },
 352         { KE_KEY, 0x03, {KEY_POWER} },
 353         { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */
 354         { KE_KEY, 0x11, {KEY_PROG1} },
 355         { KE_KEY, 0x12, {KEY_PROG2} },
 356         { KE_KEY, 0x31, {KEY_MAIL} },
 357         { KE_KEY, 0x36, {KEY_WWW} },
 358         { KE_KEY, 0x6a, {KEY_CONFIG} },
 359         { KE_WIFI, 0x30 },
 360         { KE_BLUETOOTH, 0x44 },
 361         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 362 };
 363 
 364 static struct key_entry keymap_acer_travelmate_2410[] __initdata = {
 365         { KE_KEY, 0x01, {KEY_HELP} },
 366         { KE_KEY, 0x6d, {KEY_POWER} },
 367         { KE_KEY, 0x11, {KEY_PROG1} },
 368         { KE_KEY, 0x12, {KEY_PROG2} },
 369         { KE_KEY, 0x31, {KEY_MAIL} },
 370         { KE_KEY, 0x36, {KEY_WWW} },
 371         { KE_KEY, 0x6a, {KEY_CONFIG} },
 372         { KE_WIFI, 0x30 },
 373         { KE_BLUETOOTH, 0x44 },
 374         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 375 };
 376 
 377 static struct key_entry keymap_acer_travelmate_110[] __initdata = {
 378         { KE_KEY, 0x01, {KEY_HELP} },
 379         { KE_KEY, 0x02, {KEY_CONFIG} },
 380         { KE_KEY, 0x03, {KEY_POWER} },
 381         { KE_KEY, 0x08, {KEY_MUTE} },
 382         { KE_KEY, 0x11, {KEY_PROG1} },
 383         { KE_KEY, 0x12, {KEY_PROG2} },
 384         { KE_KEY, 0x20, {KEY_VOLUMEUP} },
 385         { KE_KEY, 0x21, {KEY_VOLUMEDOWN} },
 386         { KE_KEY, 0x31, {KEY_MAIL} },
 387         { KE_KEY, 0x36, {KEY_WWW} },
 388         { KE_SW, 0x4a, {.sw = {SW_LID, 1}} }, /* lid close */
 389         { KE_SW, 0x4b, {.sw = {SW_LID, 0}} }, /* lid open */
 390         { KE_WIFI, 0x30 },
 391         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 392 };
 393 
 394 static struct key_entry keymap_acer_travelmate_300[] __initdata = {
 395         { KE_KEY, 0x01, {KEY_HELP} },
 396         { KE_KEY, 0x02, {KEY_CONFIG} },
 397         { KE_KEY, 0x03, {KEY_POWER} },
 398         { KE_KEY, 0x08, {KEY_MUTE} },
 399         { KE_KEY, 0x11, {KEY_PROG1} },
 400         { KE_KEY, 0x12, {KEY_PROG2} },
 401         { KE_KEY, 0x20, {KEY_VOLUMEUP} },
 402         { KE_KEY, 0x21, {KEY_VOLUMEDOWN} },
 403         { KE_KEY, 0x31, {KEY_MAIL} },
 404         { KE_KEY, 0x36, {KEY_WWW} },
 405         { KE_WIFI, 0x30 },
 406         { KE_BLUETOOTH, 0x44 },
 407         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 408 };
 409 
 410 static struct key_entry keymap_acer_travelmate_380[] __initdata = {
 411         { KE_KEY, 0x01, {KEY_HELP} },
 412         { KE_KEY, 0x02, {KEY_CONFIG} },
 413         { KE_KEY, 0x03, {KEY_POWER} }, /* not 370 */
 414         { KE_KEY, 0x11, {KEY_PROG1} },
 415         { KE_KEY, 0x12, {KEY_PROG2} },
 416         { KE_KEY, 0x13, {KEY_PROG3} },
 417         { KE_KEY, 0x31, {KEY_MAIL} },
 418         { KE_KEY, 0x36, {KEY_WWW} },
 419         { KE_WIFI, 0x30 },
 420         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 421 };
 422 
 423 /* unusual map */
 424 static struct key_entry keymap_acer_travelmate_220[] __initdata = {
 425         { KE_KEY, 0x01, {KEY_HELP} },
 426         { KE_KEY, 0x02, {KEY_CONFIG} },
 427         { KE_KEY, 0x11, {KEY_MAIL} },
 428         { KE_KEY, 0x12, {KEY_WWW} },
 429         { KE_KEY, 0x13, {KEY_PROG2} },
 430         { KE_KEY, 0x31, {KEY_PROG1} },
 431         { KE_END, FE_WIFI_LED | FE_UNTESTED }
 432 };
 433 
 434 static struct key_entry keymap_acer_travelmate_230[] __initdata = {
 435         { KE_KEY, 0x01, {KEY_HELP} },
 436         { KE_KEY, 0x02, {KEY_CONFIG} },
 437         { KE_KEY, 0x11, {KEY_PROG1} },
 438         { KE_KEY, 0x12, {KEY_PROG2} },
 439         { KE_KEY, 0x31, {KEY_MAIL} },
 440         { KE_KEY, 0x36, {KEY_WWW} },
 441         { KE_END, FE_WIFI_LED | FE_UNTESTED }
 442 };
 443 
 444 static struct key_entry keymap_acer_travelmate_240[] __initdata = {
 445         { KE_KEY, 0x01, {KEY_HELP} },
 446         { KE_KEY, 0x02, {KEY_CONFIG} },
 447         { KE_KEY, 0x03, {KEY_POWER} },
 448         { KE_KEY, 0x08, {KEY_MUTE} },
 449         { KE_KEY, 0x31, {KEY_MAIL} },
 450         { KE_KEY, 0x36, {KEY_WWW} },
 451         { KE_KEY, 0x11, {KEY_PROG1} },
 452         { KE_KEY, 0x12, {KEY_PROG2} },
 453         { KE_BLUETOOTH, 0x44 },
 454         { KE_WIFI, 0x30 },
 455         { KE_END, FE_UNTESTED }
 456 };
 457 
 458 static struct key_entry keymap_acer_travelmate_350[] __initdata = {
 459         { KE_KEY, 0x01, {KEY_HELP} },
 460         { KE_KEY, 0x02, {KEY_CONFIG} },
 461         { KE_KEY, 0x11, {KEY_PROG1} },
 462         { KE_KEY, 0x12, {KEY_PROG2} },
 463         { KE_KEY, 0x13, {KEY_MAIL} },
 464         { KE_KEY, 0x14, {KEY_PROG3} },
 465         { KE_KEY, 0x15, {KEY_WWW} },
 466         { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED }
 467 };
 468 
 469 static struct key_entry keymap_acer_travelmate_360[] __initdata = {
 470         { KE_KEY, 0x01, {KEY_HELP} },
 471         { KE_KEY, 0x02, {KEY_CONFIG} },
 472         { KE_KEY, 0x11, {KEY_PROG1} },
 473         { KE_KEY, 0x12, {KEY_PROG2} },
 474         { KE_KEY, 0x13, {KEY_MAIL} },
 475         { KE_KEY, 0x14, {KEY_PROG3} },
 476         { KE_KEY, 0x15, {KEY_WWW} },
 477         { KE_KEY, 0x40, {KEY_WLAN} },
 478         { KE_END, FE_WIFI_LED | FE_UNTESTED } /* no mail led */
 479 };
 480 
 481 /* Wifi subsystem only activates the led. Therefore we need to pass
 482  * wifi event as a normal key, then userspace can really change the wifi state.
 483  * TODO we need to export led state to userspace (wifi and mail) */
 484 static struct key_entry keymap_acer_travelmate_610[] __initdata = {
 485         { KE_KEY, 0x01, {KEY_HELP} },
 486         { KE_KEY, 0x02, {KEY_CONFIG} },
 487         { KE_KEY, 0x11, {KEY_PROG1} },
 488         { KE_KEY, 0x12, {KEY_PROG2} },
 489         { KE_KEY, 0x13, {KEY_PROG3} },
 490         { KE_KEY, 0x14, {KEY_MAIL} },
 491         { KE_KEY, 0x15, {KEY_WWW} },
 492         { KE_KEY, 0x40, {KEY_WLAN} },
 493         { KE_END, FE_MAIL_LED | FE_WIFI_LED }
 494 };
 495 
 496 static struct key_entry keymap_acer_travelmate_630[] __initdata = {
 497         { KE_KEY, 0x01, {KEY_HELP} },
 498         { KE_KEY, 0x02, {KEY_CONFIG} },
 499         { KE_KEY, 0x03, {KEY_POWER} },
 500         { KE_KEY, 0x08, {KEY_MUTE} }, /* not 620 */
 501         { KE_KEY, 0x11, {KEY_PROG1} },
 502         { KE_KEY, 0x12, {KEY_PROG2} },
 503         { KE_KEY, 0x13, {KEY_PROG3} },
 504         { KE_KEY, 0x20, {KEY_VOLUMEUP} },
 505         { KE_KEY, 0x21, {KEY_VOLUMEDOWN} },
 506         { KE_KEY, 0x31, {KEY_MAIL} },
 507         { KE_KEY, 0x36, {KEY_WWW} },
 508         { KE_WIFI, 0x30 },
 509         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 510 };
 511 
 512 static struct key_entry keymap_aopen_1559as[] __initdata = {
 513         { KE_KEY,  0x01, {KEY_HELP} },
 514         { KE_KEY,  0x06, {KEY_PROG3} },
 515         { KE_KEY,  0x11, {KEY_PROG1} },
 516         { KE_KEY,  0x12, {KEY_PROG2} },
 517         { KE_WIFI, 0x30 },
 518         { KE_KEY,  0x31, {KEY_MAIL} },
 519         { KE_KEY,  0x36, {KEY_WWW} },
 520         { KE_END,  0 },
 521 };
 522 
 523 static struct key_entry keymap_fs_amilo_d88x0[] __initdata = {
 524         { KE_KEY, 0x01, {KEY_HELP} },
 525         { KE_KEY, 0x08, {KEY_MUTE} },
 526         { KE_KEY, 0x31, {KEY_MAIL} },
 527         { KE_KEY, 0x36, {KEY_WWW} },
 528         { KE_KEY, 0x11, {KEY_PROG1} },
 529         { KE_KEY, 0x12, {KEY_PROG2} },
 530         { KE_KEY, 0x13, {KEY_PROG3} },
 531         { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED }
 532 };
 533 
 534 static struct key_entry keymap_wistron_md2900[] __initdata = {
 535         { KE_KEY, 0x01, {KEY_HELP} },
 536         { KE_KEY, 0x02, {KEY_CONFIG} },
 537         { KE_KEY, 0x11, {KEY_PROG1} },
 538         { KE_KEY, 0x12, {KEY_PROG2} },
 539         { KE_KEY, 0x31, {KEY_MAIL} },
 540         { KE_KEY, 0x36, {KEY_WWW} },
 541         { KE_WIFI, 0x30 },
 542         { KE_END, FE_MAIL_LED | FE_UNTESTED }
 543 };
 544 
 545 static struct key_entry keymap_wistron_md96500[] __initdata = {
 546         { KE_KEY, 0x01, {KEY_HELP} },
 547         { KE_KEY, 0x02, {KEY_CONFIG} },
 548         { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */
 549         { KE_KEY, 0x06, {KEY_DISPLAYTOGGLE} }, /* Display on/off */
 550         { KE_KEY, 0x08, {KEY_MUTE} },
 551         { KE_KEY, 0x11, {KEY_PROG1} },
 552         { KE_KEY, 0x12, {KEY_PROG2} },
 553         { KE_KEY, 0x20, {KEY_VOLUMEUP} },
 554         { KE_KEY, 0x21, {KEY_VOLUMEDOWN} },
 555         { KE_KEY, 0x22, {KEY_REWIND} },
 556         { KE_KEY, 0x23, {KEY_FORWARD} },
 557         { KE_KEY, 0x24, {KEY_PLAYPAUSE} },
 558         { KE_KEY, 0x25, {KEY_STOPCD} },
 559         { KE_KEY, 0x31, {KEY_MAIL} },
 560         { KE_KEY, 0x36, {KEY_WWW} },
 561         { KE_WIFI, 0x30 },
 562         { KE_BLUETOOTH, 0x44 },
 563         { KE_END, 0 }
 564 };
 565 
 566 static struct key_entry keymap_wistron_generic[] __initdata = {
 567         { KE_KEY, 0x01, {KEY_HELP} },
 568         { KE_KEY, 0x02, {KEY_CONFIG} },
 569         { KE_KEY, 0x03, {KEY_POWER} },
 570         { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */
 571         { KE_KEY, 0x06, {KEY_DISPLAYTOGGLE} }, /* Display on/off */
 572         { KE_KEY, 0x08, {KEY_MUTE} },
 573         { KE_KEY, 0x11, {KEY_PROG1} },
 574         { KE_KEY, 0x12, {KEY_PROG2} },
 575         { KE_KEY, 0x13, {KEY_PROG3} },
 576         { KE_KEY, 0x14, {KEY_MAIL} },
 577         { KE_KEY, 0x15, {KEY_WWW} },
 578         { KE_KEY, 0x20, {KEY_VOLUMEUP} },
 579         { KE_KEY, 0x21, {KEY_VOLUMEDOWN} },
 580         { KE_KEY, 0x22, {KEY_REWIND} },
 581         { KE_KEY, 0x23, {KEY_FORWARD} },
 582         { KE_KEY, 0x24, {KEY_PLAYPAUSE} },
 583         { KE_KEY, 0x25, {KEY_STOPCD} },
 584         { KE_KEY, 0x31, {KEY_MAIL} },
 585         { KE_KEY, 0x36, {KEY_WWW} },
 586         { KE_KEY, 0x37, {KEY_DISPLAYTOGGLE} }, /* Display on/off */
 587         { KE_KEY, 0x40, {KEY_WLAN} },
 588         { KE_KEY, 0x49, {KEY_CONFIG} },
 589         { KE_SW, 0x4a, {.sw = {SW_LID, 1}} }, /* lid close */
 590         { KE_SW, 0x4b, {.sw = {SW_LID, 0}} }, /* lid open */
 591         { KE_KEY, 0x6a, {KEY_CONFIG} },
 592         { KE_KEY, 0x6d, {KEY_POWER} },
 593         { KE_KEY, 0x71, {KEY_STOPCD} },
 594         { KE_KEY, 0x72, {KEY_PLAYPAUSE} },
 595         { KE_KEY, 0x74, {KEY_REWIND} },
 596         { KE_KEY, 0x78, {KEY_FORWARD} },
 597         { KE_WIFI, 0x30 },
 598         { KE_BLUETOOTH, 0x44 },
 599         { KE_END, 0 }
 600 };
 601 
 602 static struct key_entry keymap_aopen_1557[] __initdata = {
 603         { KE_KEY,  0x01, {KEY_HELP} },
 604         { KE_KEY,  0x11, {KEY_PROG1} },
 605         { KE_KEY,  0x12, {KEY_PROG2} },
 606         { KE_WIFI, 0x30 },
 607         { KE_KEY,  0x22, {KEY_REWIND} },
 608         { KE_KEY,  0x23, {KEY_FORWARD} },
 609         { KE_KEY,  0x24, {KEY_PLAYPAUSE} },
 610         { KE_KEY,  0x25, {KEY_STOPCD} },
 611         { KE_KEY,  0x31, {KEY_MAIL} },
 612         { KE_KEY,  0x36, {KEY_WWW} },
 613         { KE_END,  0 }
 614 };
 615 
 616 static struct key_entry keymap_prestigio[] __initdata = {
 617         { KE_KEY,  0x11, {KEY_PROG1} },
 618         { KE_KEY,  0x12, {KEY_PROG2} },
 619         { KE_WIFI, 0x30 },
 620         { KE_KEY,  0x22, {KEY_REWIND} },
 621         { KE_KEY,  0x23, {KEY_FORWARD} },
 622         { KE_KEY,  0x24, {KEY_PLAYPAUSE} },
 623         { KE_KEY,  0x25, {KEY_STOPCD} },
 624         { KE_KEY,  0x31, {KEY_MAIL} },
 625         { KE_KEY,  0x36, {KEY_WWW} },
 626         { KE_END,  0 }
 627 };
 628 
 629 
 630 /*
 631  * If your machine is not here (which is currently rather likely), please send
 632  * a list of buttons and their key codes (reported when loading this module
 633  * with force=1) and the output of dmidecode to $MODULE_AUTHOR.
 634  */
 635 static const struct dmi_system_id dmi_ids[] __initconst = {
 636         {
 637                 /* Fujitsu-Siemens Amilo Pro V2000 */
 638                 .callback = dmi_matched,
 639                 .matches = {
 640                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 641                         DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pro V2000"),
 642                 },
 643                 .driver_data = keymap_fs_amilo_pro_v2000
 644         },
 645         {
 646                 /* Fujitsu-Siemens Amilo Pro Edition V3505 */
 647                 .callback = dmi_matched,
 648                 .matches = {
 649                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 650                         DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pro Edition V3505"),
 651                 },
 652                 .driver_data = keymap_fs_amilo_pro_v3505
 653         },
 654         {
 655                 /* Fujitsu-Siemens Amilo Pro Edition V8210 */
 656                 .callback = dmi_matched,
 657                 .matches = {
 658                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 659                         DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pro Series V8210"),
 660                 },
 661                 .driver_data = keymap_fs_amilo_pro_v8210
 662         },
 663         {
 664                 /* Fujitsu-Siemens Amilo M7400 */
 665                 .callback = dmi_matched,
 666                 .matches = {
 667                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 668                         DMI_MATCH(DMI_PRODUCT_NAME, "AMILO M        "),
 669                 },
 670                 .driver_data = keymap_fs_amilo_pro_v2000
 671         },
 672         {
 673                 /* Maxdata Pro 7000 DX */
 674                 .callback = dmi_matched,
 675                 .matches = {
 676                         DMI_MATCH(DMI_SYS_VENDOR, "MAXDATA"),
 677                         DMI_MATCH(DMI_PRODUCT_NAME, "Pro 7000"),
 678                 },
 679                 .driver_data = keymap_fs_amilo_pro_v2000
 680         },
 681         {
 682                 /* Fujitsu N3510 */
 683                 .callback = dmi_matched,
 684                 .matches = {
 685                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
 686                         DMI_MATCH(DMI_PRODUCT_NAME, "N3510"),
 687                 },
 688                 .driver_data = keymap_fujitsu_n3510
 689         },
 690         {
 691                 /* Acer Aspire 1500 */
 692                 .callback = dmi_matched,
 693                 .matches = {
 694                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 695                         DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1500"),
 696                 },
 697                 .driver_data = keymap_acer_aspire_1500
 698         },
 699         {
 700                 /* Acer Aspire 1600 */
 701                 .callback = dmi_matched,
 702                 .matches = {
 703                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 704                         DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1600"),
 705                 },
 706                 .driver_data = keymap_acer_aspire_1600
 707         },
 708         {
 709                 /* Acer Aspire 3020 */
 710                 .callback = dmi_matched,
 711                 .matches = {
 712                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 713                         DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 3020"),
 714                 },
 715                 .driver_data = keymap_acer_aspire_5020
 716         },
 717         {
 718                 /* Acer Aspire 5020 */
 719                 .callback = dmi_matched,
 720                 .matches = {
 721                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 722                         DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5020"),
 723                 },
 724                 .driver_data = keymap_acer_aspire_5020
 725         },
 726         {
 727                 /* Acer TravelMate 2100 */
 728                 .callback = dmi_matched,
 729                 .matches = {
 730                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 731                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2100"),
 732                 },
 733                 .driver_data = keymap_acer_aspire_5020
 734         },
 735         {
 736                 /* Acer TravelMate 2410 */
 737                 .callback = dmi_matched,
 738                 .matches = {
 739                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 740                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2410"),
 741                 },
 742                 .driver_data = keymap_acer_travelmate_2410
 743         },
 744         {
 745                 /* Acer TravelMate C300 */
 746                 .callback = dmi_matched,
 747                 .matches = {
 748                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 749                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C300"),
 750                 },
 751                 .driver_data = keymap_acer_travelmate_300
 752         },
 753         {
 754                 /* Acer TravelMate C100 */
 755                 .callback = dmi_matched,
 756                 .matches = {
 757                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 758                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C100"),
 759                 },
 760                 .driver_data = keymap_acer_travelmate_300
 761         },
 762         {
 763                 /* Acer TravelMate C110 */
 764                 .callback = dmi_matched,
 765                 .matches = {
 766                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 767                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C110"),
 768                 },
 769                 .driver_data = keymap_acer_travelmate_110
 770         },
 771         {
 772                 /* Acer TravelMate 380 */
 773                 .callback = dmi_matched,
 774                 .matches = {
 775                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 776                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 380"),
 777                 },
 778                 .driver_data = keymap_acer_travelmate_380
 779         },
 780         {
 781                 /* Acer TravelMate 370 */
 782                 .callback = dmi_matched,
 783                 .matches = {
 784                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 785                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 370"),
 786                 },
 787                 .driver_data = keymap_acer_travelmate_380 /* keyboard minus 1 key */
 788         },
 789         {
 790                 /* Acer TravelMate 220 */
 791                 .callback = dmi_matched,
 792                 .matches = {
 793                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 794                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 220"),
 795                 },
 796                 .driver_data = keymap_acer_travelmate_220
 797         },
 798         {
 799                 /* Acer TravelMate 260 */
 800                 .callback = dmi_matched,
 801                 .matches = {
 802                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 803                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 260"),
 804                 },
 805                 .driver_data = keymap_acer_travelmate_220
 806         },
 807         {
 808                 /* Acer TravelMate 230 */
 809                 .callback = dmi_matched,
 810                 .matches = {
 811                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 812                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 230"),
 813                         /* acerhk looks for "TravelMate F4..." ?! */
 814                 },
 815                 .driver_data = keymap_acer_travelmate_230
 816         },
 817         {
 818                 /* Acer TravelMate 280 */
 819                 .callback = dmi_matched,
 820                 .matches = {
 821                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 822                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 280"),
 823                 },
 824                 .driver_data = keymap_acer_travelmate_230
 825         },
 826         {
 827                 /* Acer TravelMate 240 */
 828                 .callback = dmi_matched,
 829                 .matches = {
 830                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 831                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 240"),
 832                 },
 833                 .driver_data = keymap_acer_travelmate_240
 834         },
 835         {
 836                 /* Acer TravelMate 250 */
 837                 .callback = dmi_matched,
 838                 .matches = {
 839                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 840                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 250"),
 841                 },
 842                 .driver_data = keymap_acer_travelmate_240
 843         },
 844         {
 845                 /* Acer TravelMate 2424NWXCi */
 846                 .callback = dmi_matched,
 847                 .matches = {
 848                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 849                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2420"),
 850                 },
 851                 .driver_data = keymap_acer_travelmate_240
 852         },
 853         {
 854                 /* Acer TravelMate 350 */
 855                 .callback = dmi_matched,
 856                 .matches = {
 857                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 858                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 350"),
 859                 },
 860                 .driver_data = keymap_acer_travelmate_350
 861         },
 862         {
 863                 /* Acer TravelMate 360 */
 864                 .callback = dmi_matched,
 865                 .matches = {
 866                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 867                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 360"),
 868                 },
 869                 .driver_data = keymap_acer_travelmate_360
 870         },
 871         {
 872                 /* Acer TravelMate 610 */
 873                 .callback = dmi_matched,
 874                 .matches = {
 875                         DMI_MATCH(DMI_SYS_VENDOR, "ACER"),
 876                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 610"),
 877                 },
 878                 .driver_data = keymap_acer_travelmate_610
 879         },
 880         {
 881                 /* Acer TravelMate 620 */
 882                 .callback = dmi_matched,
 883                 .matches = {
 884                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 885                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 620"),
 886                 },
 887                 .driver_data = keymap_acer_travelmate_630
 888         },
 889         {
 890                 /* Acer TravelMate 630 */
 891                 .callback = dmi_matched,
 892                 .matches = {
 893                         DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
 894                         DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 630"),
 895                 },
 896                 .driver_data = keymap_acer_travelmate_630
 897         },
 898         {
 899                 /* AOpen 1559AS */
 900                 .callback = dmi_matched,
 901                 .matches = {
 902                         DMI_MATCH(DMI_PRODUCT_NAME, "E2U"),
 903                         DMI_MATCH(DMI_BOARD_NAME, "E2U"),
 904                 },
 905                 .driver_data = keymap_aopen_1559as
 906         },
 907         {
 908                 /* Medion MD 9783 */
 909                 .callback = dmi_matched,
 910                 .matches = {
 911                         DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"),
 912                         DMI_MATCH(DMI_PRODUCT_NAME, "MD 9783"),
 913                 },
 914                 .driver_data = keymap_wistron_ms2111
 915         },
 916         {
 917                 /* Medion MD 40100 */
 918                 .callback = dmi_matched,
 919                 .matches = {
 920                         DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"),
 921                         DMI_MATCH(DMI_PRODUCT_NAME, "WID2000"),
 922                 },
 923                 .driver_data = keymap_wistron_md40100
 924         },
 925         {
 926                 /* Medion MD 2900 */
 927                 .callback = dmi_matched,
 928                 .matches = {
 929                         DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"),
 930                         DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2000"),
 931                 },
 932                 .driver_data = keymap_wistron_md2900
 933         },
 934         {
 935                 /* Medion MD 42200 */
 936                 .callback = dmi_matched,
 937                 .matches = {
 938                         DMI_MATCH(DMI_SYS_VENDOR, "Medion"),
 939                         DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2030"),
 940                 },
 941                 .driver_data = keymap_fs_amilo_pro_v2000
 942         },
 943         {
 944                 /* Medion MD 96500 */
 945                 .callback = dmi_matched,
 946                 .matches = {
 947                         DMI_MATCH(DMI_SYS_VENDOR, "MEDIONPC"),
 948                         DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2040"),
 949                 },
 950                 .driver_data = keymap_wistron_md96500
 951         },
 952         {
 953                 /* Medion MD 95400 */
 954                 .callback = dmi_matched,
 955                 .matches = {
 956                         DMI_MATCH(DMI_SYS_VENDOR, "MEDIONPC"),
 957                         DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2050"),
 958                 },
 959                 .driver_data = keymap_wistron_md96500
 960         },
 961         {
 962                 /* Fujitsu Siemens Amilo D7820 */
 963                 .callback = dmi_matched,
 964                 .matches = {
 965                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), /* not sure */
 966                         DMI_MATCH(DMI_PRODUCT_NAME, "Amilo D"),
 967                 },
 968                 .driver_data = keymap_fs_amilo_d88x0
 969         },
 970         {
 971                 /* Fujitsu Siemens Amilo D88x0 */
 972                 .callback = dmi_matched,
 973                 .matches = {
 974                         DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 975                         DMI_MATCH(DMI_PRODUCT_NAME, "AMILO D"),
 976                 },
 977                 .driver_data = keymap_fs_amilo_d88x0
 978         },
 979         { NULL, }
 980 };
 981 MODULE_DEVICE_TABLE(dmi, dmi_ids);
 982 
 983 /* Copy the good keymap, as the original ones are free'd */
 984 static int __init copy_keymap(void)
 985 {
 986         const struct key_entry *key;
 987         struct key_entry *new_keymap;
 988         unsigned int length = 1;
 989 
 990         for (key = keymap; key->type != KE_END; key++)
 991                 length++;
 992 
 993         new_keymap = kmemdup(keymap, length * sizeof(struct key_entry),
 994                              GFP_KERNEL);
 995         if (!new_keymap)
 996                 return -ENOMEM;
 997 
 998         keymap = new_keymap;
 999 
1000         return 0;
1001 }
1002 
1003 static int __init select_keymap(void)
1004 {
1005         dmi_check_system(dmi_ids);
1006         if (keymap_name != NULL) {
1007                 if (strcmp (keymap_name, "1557/MS2141") == 0)
1008                         keymap = keymap_wistron_ms2141;
1009                 else if (strcmp (keymap_name, "aopen1557") == 0)
1010                         keymap = keymap_aopen_1557;
1011                 else if (strcmp (keymap_name, "prestigio") == 0)
1012                         keymap = keymap_prestigio;
1013                 else if (strcmp (keymap_name, "generic") == 0)
1014                         keymap = keymap_wistron_generic;
1015                 else {
1016                         printk(KERN_ERR "wistron_btns: Keymap unknown\n");
1017                         return -EINVAL;
1018                 }
1019         }
1020         if (keymap == NULL) {
1021                 if (!force) {
1022                         printk(KERN_ERR "wistron_btns: System unknown\n");
1023                         return -ENODEV;
1024                 }
1025                 keymap = keymap_empty;
1026         }
1027 
1028         return copy_keymap();
1029 }
1030 
1031  /* Input layer interface */
1032 
1033 static struct input_polled_dev *wistron_idev;
1034 static unsigned long jiffies_last_press;
1035 static bool wifi_enabled;
1036 static bool bluetooth_enabled;
1037 
1038  /* led management */
1039 static void wistron_mail_led_set(struct led_classdev *led_cdev,
1040                                 enum led_brightness value)
1041 {
1042         bios_set_state(MAIL_LED, (value != LED_OFF) ? 1 : 0);
1043 }
1044 
1045 /* same as setting up wifi card, but for laptops on which the led is managed */
1046 static void wistron_wifi_led_set(struct led_classdev *led_cdev,
1047                                 enum led_brightness value)
1048 {
1049         bios_set_state(WIFI, (value != LED_OFF) ? 1 : 0);
1050 }
1051 
1052 static struct led_classdev wistron_mail_led = {
1053         .name                   = "wistron:green:mail",
1054         .brightness_set         = wistron_mail_led_set,
1055 };
1056 
1057 static struct led_classdev wistron_wifi_led = {
1058         .name                   = "wistron:red:wifi",
1059         .brightness_set         = wistron_wifi_led_set,
1060 };
1061 
1062 static void wistron_led_init(struct device *parent)
1063 {
1064         if (leds_present & FE_WIFI_LED) {
1065                 u16 wifi = bios_get_default_setting(WIFI);
1066                 if (wifi & 1) {
1067                         wistron_wifi_led.brightness = (wifi & 2) ? LED_FULL : LED_OFF;
1068                         if (led_classdev_register(parent, &wistron_wifi_led))
1069                                 leds_present &= ~FE_WIFI_LED;
1070                         else
1071                                 bios_set_state(WIFI, wistron_wifi_led.brightness);
1072 
1073                 } else
1074                         leds_present &= ~FE_WIFI_LED;
1075         }
1076 
1077         if (leds_present & FE_MAIL_LED) {
1078                 /* bios_get_default_setting(MAIL) always retuns 0, so just turn the led off */
1079                 wistron_mail_led.brightness = LED_OFF;
1080                 if (led_classdev_register(parent, &wistron_mail_led))
1081                         leds_present &= ~FE_MAIL_LED;
1082                 else
1083                         bios_set_state(MAIL_LED, wistron_mail_led.brightness);
1084         }
1085 }
1086 
1087 static void wistron_led_remove(void)
1088 {
1089         if (leds_present & FE_MAIL_LED)
1090                 led_classdev_unregister(&wistron_mail_led);
1091 
1092         if (leds_present & FE_WIFI_LED)
1093                 led_classdev_unregister(&wistron_wifi_led);
1094 }
1095 
1096 static inline void wistron_led_suspend(void)
1097 {
1098         if (leds_present & FE_MAIL_LED)
1099                 led_classdev_suspend(&wistron_mail_led);
1100 
1101         if (leds_present & FE_WIFI_LED)
1102                 led_classdev_suspend(&wistron_wifi_led);
1103 }
1104 
1105 static inline void wistron_led_resume(void)
1106 {
1107         if (leds_present & FE_MAIL_LED)
1108                 led_classdev_resume(&wistron_mail_led);
1109 
1110         if (leds_present & FE_WIFI_LED)
1111                 led_classdev_resume(&wistron_wifi_led);
1112 }
1113 
1114 static void handle_key(u8 code)
1115 {
1116         const struct key_entry *key =
1117                 sparse_keymap_entry_from_scancode(wistron_idev->input, code);
1118 
1119         if (key) {
1120                 switch (key->type) {
1121                 case KE_WIFI:
1122                         if (have_wifi) {
1123                                 wifi_enabled = !wifi_enabled;
1124                                 bios_set_state(WIFI, wifi_enabled);
1125                         }
1126                         break;
1127 
1128                 case KE_BLUETOOTH:
1129                         if (have_bluetooth) {
1130                                 bluetooth_enabled = !bluetooth_enabled;
1131                                 bios_set_state(BLUETOOTH, bluetooth_enabled);
1132                         }
1133                         break;
1134 
1135                 default:
1136                         sparse_keymap_report_entry(wistron_idev->input,
1137                                                    key, 1, true);
1138                         break;
1139                 }
1140                 jiffies_last_press = jiffies;
1141         } else
1142                 printk(KERN_NOTICE
1143                         "wistron_btns: Unknown key code %02X\n", code);
1144 }
1145 
1146 static void poll_bios(bool discard)
1147 {
1148         u8 qlen;
1149         u16 val;
1150 
1151         for (;;) {
1152                 qlen = CMOS_READ(cmos_address);
1153                 if (qlen == 0)
1154                         break;
1155                 val = bios_pop_queue();
1156                 if (val != 0 && !discard)
1157                         handle_key((u8)val);
1158         }
1159 }
1160 
1161 static void wistron_flush(struct input_polled_dev *dev)
1162 {
1163         /* Flush stale event queue */
1164         poll_bios(true);
1165 }
1166 
1167 static void wistron_poll(struct input_polled_dev *dev)
1168 {
1169         poll_bios(false);
1170 
1171         /* Increase poll frequency if user is currently pressing keys (< 2s ago) */
1172         if (time_before(jiffies, jiffies_last_press + 2 * HZ))
1173                 dev->poll_interval = POLL_INTERVAL_BURST;
1174         else
1175                 dev->poll_interval = POLL_INTERVAL_DEFAULT;
1176 }
1177 
1178 static int wistron_setup_keymap(struct input_dev *dev,
1179                                           struct key_entry *entry)
1180 {
1181         switch (entry->type) {
1182 
1183         /* if wifi or bluetooth are not available, create normal keys */
1184         case KE_WIFI:
1185                 if (!have_wifi) {
1186                         entry->type = KE_KEY;
1187                         entry->keycode = KEY_WLAN;
1188                 }
1189                 break;
1190 
1191         case KE_BLUETOOTH:
1192                 if (!have_bluetooth) {
1193                         entry->type = KE_KEY;
1194                         entry->keycode = KEY_BLUETOOTH;
1195                 }
1196                 break;
1197 
1198         case KE_END:
1199                 if (entry->code & FE_UNTESTED)
1200                         printk(KERN_WARNING "Untested laptop multimedia keys, "
1201                                 "please report success or failure to "
1202                                 "eric.piel@tremplin-utc.net\n");
1203                 break;
1204         }
1205 
1206         return 0;
1207 }
1208 
1209 static int setup_input_dev(void)
1210 {
1211         struct input_dev *input_dev;
1212         int error;
1213 
1214         wistron_idev = input_allocate_polled_device();
1215         if (!wistron_idev)
1216                 return -ENOMEM;
1217 
1218         wistron_idev->open = wistron_flush;
1219         wistron_idev->poll = wistron_poll;
1220         wistron_idev->poll_interval = POLL_INTERVAL_DEFAULT;
1221 
1222         input_dev = wistron_idev->input;
1223         input_dev->name = "Wistron laptop buttons";
1224         input_dev->phys = "wistron/input0";
1225         input_dev->id.bustype = BUS_HOST;
1226         input_dev->dev.parent = &wistron_device->dev;
1227 
1228         error = sparse_keymap_setup(input_dev, keymap, wistron_setup_keymap);
1229         if (error)
1230                 goto err_free_dev;
1231 
1232         error = input_register_polled_device(wistron_idev);
1233         if (error)
1234                 goto err_free_dev;
1235 
1236         return 0;
1237 
1238  err_free_dev:
1239         input_free_polled_device(wistron_idev);
1240         return error;
1241 }
1242 
1243 /* Driver core */
1244 
1245 static int wistron_probe(struct platform_device *dev)
1246 {
1247         int err;
1248 
1249         bios_attach();
1250         cmos_address = bios_get_cmos_address();
1251 
1252         if (have_wifi) {
1253                 u16 wifi = bios_get_default_setting(WIFI);
1254                 if (wifi & 1)
1255                         wifi_enabled = wifi & 2;
1256                 else
1257                         have_wifi = 0;
1258 
1259                 if (have_wifi)
1260                         bios_set_state(WIFI, wifi_enabled);
1261         }
1262 
1263         if (have_bluetooth) {
1264                 u16 bt = bios_get_default_setting(BLUETOOTH);
1265                 if (bt & 1)
1266                         bluetooth_enabled = bt & 2;
1267                 else
1268                         have_bluetooth = false;
1269 
1270                 if (have_bluetooth)
1271                         bios_set_state(BLUETOOTH, bluetooth_enabled);
1272         }
1273 
1274         wistron_led_init(&dev->dev);
1275 
1276         err = setup_input_dev();
1277         if (err) {
1278                 bios_detach();
1279                 return err;
1280         }
1281 
1282         return 0;
1283 }
1284 
1285 static int wistron_remove(struct platform_device *dev)
1286 {
1287         wistron_led_remove();
1288         input_unregister_polled_device(wistron_idev);
1289         input_free_polled_device(wistron_idev);
1290         bios_detach();
1291 
1292         return 0;
1293 }
1294 
1295 #ifdef CONFIG_PM
1296 static int wistron_suspend(struct device *dev)
1297 {
1298         if (have_wifi)
1299                 bios_set_state(WIFI, 0);
1300 
1301         if (have_bluetooth)
1302                 bios_set_state(BLUETOOTH, 0);
1303 
1304         wistron_led_suspend();
1305 
1306         return 0;
1307 }
1308 
1309 static int wistron_resume(struct device *dev)
1310 {
1311         if (have_wifi)
1312                 bios_set_state(WIFI, wifi_enabled);
1313 
1314         if (have_bluetooth)
1315                 bios_set_state(BLUETOOTH, bluetooth_enabled);
1316 
1317         wistron_led_resume();
1318 
1319         poll_bios(true);
1320 
1321         return 0;
1322 }
1323 
1324 static const struct dev_pm_ops wistron_pm_ops = {
1325         .suspend        = wistron_suspend,
1326         .resume         = wistron_resume,
1327         .poweroff       = wistron_suspend,
1328         .restore        = wistron_resume,
1329 };
1330 #endif
1331 
1332 static struct platform_driver wistron_driver = {
1333         .driver         = {
1334                 .name   = "wistron-bios",
1335 #ifdef CONFIG_PM
1336                 .pm     = &wistron_pm_ops,
1337 #endif
1338         },
1339         .probe          = wistron_probe,
1340         .remove         = wistron_remove,
1341 };
1342 
1343 static int __init wb_module_init(void)
1344 {
1345         int err;
1346 
1347         err = select_keymap();
1348         if (err)
1349                 return err;
1350 
1351         err = map_bios();
1352         if (err)
1353                 goto err_free_keymap;
1354 
1355         err = platform_driver_register(&wistron_driver);
1356         if (err)
1357                 goto err_unmap_bios;
1358 
1359         wistron_device = platform_device_alloc("wistron-bios", -1);
1360         if (!wistron_device) {
1361                 err = -ENOMEM;
1362                 goto err_unregister_driver;
1363         }
1364 
1365         err = platform_device_add(wistron_device);
1366         if (err)
1367                 goto err_free_device;
1368 
1369         return 0;
1370 
1371  err_free_device:
1372         platform_device_put(wistron_device);
1373  err_unregister_driver:
1374         platform_driver_unregister(&wistron_driver);
1375  err_unmap_bios:
1376         unmap_bios();
1377  err_free_keymap:
1378         kfree(keymap);
1379 
1380         return err;
1381 }
1382 
1383 static void __exit wb_module_exit(void)
1384 {
1385         platform_device_unregister(wistron_device);
1386         platform_driver_unregister(&wistron_driver);
1387         unmap_bios();
1388         kfree(keymap);
1389 }
1390 
1391 module_init(wb_module_init);
1392 module_exit(wb_module_exit);

/* [<][>][^][v][top][bottom][index][help] */