drivers/input/misc/wistron_btns.c

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