drivers/input/keyboard/atkbd.c

   1 /*
   2  * AT and PS/2 keyboard driver
   3  *
   4  * Copyright (c) 1999-2002 Vojtech Pavlik
   5  */
   6
   7 /*
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms of the GNU General Public License version 2 as published by
  10  * the Free Software Foundation.
  11  */
  12
  13 /*
  14  * This driver can handle standard AT keyboards and PS/2 keyboards in
  15  * Translated and Raw Set 2 and Set 3, as well as AT keyboards on dumb
  16  * input-only controllers and AT keyboards connected over a one way RS232
  17  * converter.
  18  */
  19
  20 #include <linux/delay.h>
  21 #include <linux/module.h>
  22 #include <linux/moduleparam.h>
  23 #include <linux/slab.h>
  24 #include <linux/interrupt.h>
  25 #include <linux/init.h>
  26 #include <linux/input.h>
  27 #include <linux/serio.h>
  28 #include <linux/workqueue.h>
  29 #include <linux/libps2.h>
  30 #include <linux/mutex.h>
  31
  32 #define DRIVER_DESC     "AT and PS/2 keyboard driver"
  33
  34 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
  35 MODULE_DESCRIPTION(DRIVER_DESC);
  36 MODULE_LICENSE("GPL");
  37
  38 static int atkbd_set = 2;
  39 module_param_named(set, atkbd_set, int, 0);
  40 MODULE_PARM_DESC(set, "Select keyboard code set (2 = default, 3 = PS/2 native)");
  41
  42 #if defined(__i386__) || defined(__x86_64__) || defined(__hppa__)
  43 static int atkbd_reset;
  44 #else
  45 static int atkbd_reset = 1;
  46 #endif
  47 module_param_named(reset, atkbd_reset, bool, 0);
  48 MODULE_PARM_DESC(reset, "Reset keyboard during initialization");
  49
  50 static int atkbd_softrepeat;
  51 module_param_named(softrepeat, atkbd_softrepeat, bool, 0);
  52 MODULE_PARM_DESC(softrepeat, "Use software keyboard repeat");
  53
  54 static int atkbd_softraw = 1;
  55 module_param_named(softraw, atkbd_softraw, bool, 0);
  56 MODULE_PARM_DESC(softraw, "Use software generated rawmode");
  57
  58 static int atkbd_scroll;
  59 module_param_named(scroll, atkbd_scroll, bool, 0);
  60 MODULE_PARM_DESC(scroll, "Enable scroll-wheel on MS Office and similar keyboards");
  61
  62 static int atkbd_extra;
  63 module_param_named(extra, atkbd_extra, bool, 0);
  64 MODULE_PARM_DESC(extra, "Enable extra LEDs and keys on IBM RapidAcces, EzKey and similar keyboards");
  65
  66 __obsolete_setup("atkbd_set=");
  67 __obsolete_setup("atkbd_reset");
  68 __obsolete_setup("atkbd_softrepeat=");
  69
  70 /*
  71  * Scancode to keycode tables. These are just the default setting, and
  72  * are loadable via an userland utility.
  73  */
  74
  75 static unsigned char atkbd_set2_keycode[512] = {
  76
  77 #ifdef CONFIG_KEYBOARD_ATKBD_HP_KEYCODES
  78
  79 /* XXX: need a more general approach */
  80
  81 #include "hpps2atkbd.h" /* include the keyboard scancodes */
  82
  83 #else
  84           0, 67, 65, 63, 61, 59, 60, 88,  0, 68, 66, 64, 62, 15, 41,117,
  85           0, 56, 42, 93, 29, 16,  2,  0,  0,  0, 44, 31, 30, 17,  3,  0,
  86           0, 46, 45, 32, 18,  5,  4, 95,  0, 57, 47, 33, 20, 19,  6,183,
  87           0, 49, 48, 35, 34, 21,  7,184,  0,  0, 50, 36, 22,  8,  9,185,
  88           0, 51, 37, 23, 24, 11, 10,  0,  0, 52, 53, 38, 39, 25, 12,  0,
  89           0, 89, 40,  0, 26, 13,  0,  0, 58, 54, 28, 27,  0, 43,  0, 85,
  90           0, 86, 91, 90, 92,  0, 14, 94,  0, 79,124, 75, 71,121,  0,  0,
  91          82, 83, 80, 76, 77, 72,  1, 69, 87, 78, 81, 74, 55, 73, 70, 99,
  92
  93           0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  94         217,100,255,  0, 97,165,  0,  0,156,  0,  0,  0,  0,  0,  0,125,
  95         173,114,  0,113,  0,  0,  0,126,128,  0,  0,140,  0,  0,  0,127,
  96         159,  0,115,  0,164,  0,  0,116,158,  0,150,166,  0,  0,  0,142,
  97         157,  0,  0,  0,  0,  0,  0,  0,155,  0, 98,  0,  0,163,  0,  0,
  98         226,  0,  0,  0,  0,  0,  0,  0,  0,255, 96,  0,  0,  0,143,  0,
  99           0,  0,  0,  0,  0,  0,  0,  0,  0,107,  0,105,102,  0,  0,112,
 100         110,111,108,112,106,103,  0,119,  0,118,109,  0, 99,104,119,  0,
 101
 102           0,  0,  0, 65, 99,
 103 #endif
 104 };
 105
 106 static unsigned char atkbd_set3_keycode[512] = {
 107
 108           0,  0,  0,  0,  0,  0,  0, 59,  1,138,128,129,130, 15, 41, 60,
 109         131, 29, 42, 86, 58, 16,  2, 61,133, 56, 44, 31, 30, 17,  3, 62,
 110         134, 46, 45, 32, 18,  5,  4, 63,135, 57, 47, 33, 20, 19,  6, 64,
 111         136, 49, 48, 35, 34, 21,  7, 65,137,100, 50, 36, 22,  8,  9, 66,
 112         125, 51, 37, 23, 24, 11, 10, 67,126, 52, 53, 38, 39, 25, 12, 68,
 113         113,114, 40, 43, 26, 13, 87, 99, 97, 54, 28, 27, 43, 43, 88, 70,
 114         108,105,119,103,111,107, 14,110,  0, 79,106, 75, 71,109,102,104,
 115          82, 83, 80, 76, 77, 72, 69, 98,  0, 96, 81,  0, 78, 73, 55,183,
 116
 117         184,185,186,187, 74, 94, 92, 93,  0,  0,  0,125,126,127,112,  0,
 118           0,139,150,163,165,115,152,150,166,140,160,154,113,114,167,168,
 119         148,149,147,140
 120 };
 121
 122 static unsigned char atkbd_unxlate_table[128] = {
 123           0,118, 22, 30, 38, 37, 46, 54, 61, 62, 70, 69, 78, 85,102, 13,
 124          21, 29, 36, 45, 44, 53, 60, 67, 68, 77, 84, 91, 90, 20, 28, 27,
 125          35, 43, 52, 51, 59, 66, 75, 76, 82, 14, 18, 93, 26, 34, 33, 42,
 126          50, 49, 58, 65, 73, 74, 89,124, 17, 41, 88,  5,  6,  4, 12,  3,
 127          11,  2, 10,  1,  9,119,126,108,117,125,123,107,115,116,121,105,
 128         114,122,112,113,127, 96, 97,120,  7, 15, 23, 31, 39, 47, 55, 63,
 129          71, 79, 86, 94,  8, 16, 24, 32, 40, 48, 56, 64, 72, 80, 87,111,
 130          19, 25, 57, 81, 83, 92, 95, 98, 99,100,101,103,104,106,109,110
 131 };
 132
 133 #define ATKBD_CMD_SETLEDS       0x10ed
 134 #define ATKBD_CMD_GSCANSET      0x11f0
 135 #define ATKBD_CMD_SSCANSET      0x10f0
 136 #define ATKBD_CMD_GETID         0x02f2
 137 #define ATKBD_CMD_SETREP        0x10f3
 138 #define ATKBD_CMD_ENABLE        0x00f4
 139 #define ATKBD_CMD_RESET_DIS     0x00f5
 140 #define ATKBD_CMD_SETALL_MBR    0x00fa
 141 #define ATKBD_CMD_RESET_BAT     0x02ff
 142 #define ATKBD_CMD_RESEND        0x00fe
 143 #define ATKBD_CMD_EX_ENABLE     0x10ea
 144 #define ATKBD_CMD_EX_SETLEDS    0x20eb
 145 #define ATKBD_CMD_OK_GETID      0x02e8
 146
 147 #define ATKBD_RET_ACK           0xfa
 148 #define ATKBD_RET_NAK           0xfe
 149 #define ATKBD_RET_BAT           0xaa
 150 #define ATKBD_RET_EMUL0         0xe0
 151 #define ATKBD_RET_EMUL1         0xe1
 152 #define ATKBD_RET_RELEASE       0xf0
 153 #define ATKBD_RET_HANJA         0xf1
 154 #define ATKBD_RET_HANGEUL       0xf2
 155 #define ATKBD_RET_ERR           0xff
 156
 157 #define ATKBD_KEY_UNKNOWN         0
 158 #define ATKBD_KEY_NULL          255
 159
 160 #define ATKBD_SCR_1             254
 161 #define ATKBD_SCR_2             253
 162 #define ATKBD_SCR_4             252
 163 #define ATKBD_SCR_8             251
 164 #define ATKBD_SCR_CLICK         250
 165 #define ATKBD_SCR_LEFT          249
 166 #define ATKBD_SCR_RIGHT         248
 167
 168 #define ATKBD_SPECIAL           248
 169
 170 #define ATKBD_LED_EVENT_BIT     0
 171 #define ATKBD_REP_EVENT_BIT     1
 172
 173 #define ATKBD_XL_ERR            0x01
 174 #define ATKBD_XL_BAT            0x02
 175 #define ATKBD_XL_ACK            0x04
 176 #define ATKBD_XL_NAK            0x08
 177 #define ATKBD_XL_HANGEUL        0x10
 178 #define ATKBD_XL_HANJA          0x20
 179
 180 static struct {
 181         unsigned char keycode;
 182         unsigned char set2;
 183 } atkbd_scroll_keys[] = {
 184         { ATKBD_SCR_1,     0xc5 },
 185         { ATKBD_SCR_2,     0x9d },
 186         { ATKBD_SCR_4,     0xa4 },
 187         { ATKBD_SCR_8,     0x9b },
 188         { ATKBD_SCR_CLICK, 0xe0 },
 189         { ATKBD_SCR_LEFT,  0xcb },
 190         { ATKBD_SCR_RIGHT, 0xd2 },
 191 };
 192
 193 /*
 194  * The atkbd control structure
 195  */
 196
 197 struct atkbd {
 198
 199         struct ps2dev ps2dev;
 200         struct input_dev *dev;
 201
 202         /* Written only during init */
 203         char name[64];
 204         char phys[32];
 205
 206         unsigned short id;
 207         unsigned char keycode[512];
 208         unsigned char set;
 209         unsigned char translated;
 210         unsigned char extra;
 211         unsigned char write;
 212         unsigned char softrepeat;
 213         unsigned char softraw;
 214         unsigned char scroll;
 215         unsigned char enabled;
 216
 217         /* Accessed only from interrupt */
 218         unsigned char emul;
 219         unsigned char resend;
 220         unsigned char release;
 221         unsigned long xl_bit;
 222         unsigned int last;
 223         unsigned long time;
 224
 225         struct work_struct event_work;
 226         struct mutex event_mutex;
 227         unsigned long event_mask;
 228 };
 229
 230 static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
 231                                 ssize_t (*handler)(struct atkbd *, char *));
 232 static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
 233                                 ssize_t (*handler)(struct atkbd *, const char *, size_t));
 234 #define ATKBD_DEFINE_ATTR(_name)                                                \
 235 static ssize_t atkbd_show_##_name(struct atkbd *, char *);                      \
 236 static ssize_t atkbd_set_##_name(struct atkbd *, const char *, size_t);         \
 237 static ssize_t atkbd_do_show_##_name(struct device *d, struct device_attribute *attr, char *b)                  \
 238 {                                                                               \
 239         return atkbd_attr_show_helper(d, b, atkbd_show_##_name);                \
 240 }                                                                               \
 241 static ssize_t atkbd_do_set_##_name(struct device *d, struct device_attribute *attr, const char *b, size_t s)   \
 242 {                                                                               \
 243         return atkbd_attr_set_helper(d, b, s, atkbd_set_##_name);               \
 244 }                                                                               \
 245 static struct device_attribute atkbd_attr_##_name =                             \
 246         __ATTR(_name, S_IWUSR | S_IRUGO, atkbd_do_show_##_name, atkbd_do_set_##_name);
 247
 248 ATKBD_DEFINE_ATTR(extra);
 249 ATKBD_DEFINE_ATTR(scroll);
 250 ATKBD_DEFINE_ATTR(set);
 251 ATKBD_DEFINE_ATTR(softrepeat);
 252 ATKBD_DEFINE_ATTR(softraw);
 253
 254 static const unsigned int xl_table[] = {
 255         ATKBD_RET_BAT, ATKBD_RET_ERR, ATKBD_RET_ACK,
 256         ATKBD_RET_NAK, ATKBD_RET_HANJA, ATKBD_RET_HANGEUL,
 257 };
 258
 259 /*
 260  * Checks if we should mangle the scancode to extract 'release' bit
 261  * in translated mode.
 262  */
 263 static int atkbd_need_xlate(unsigned long xl_bit, unsigned char code)
 264 {
 265         int i;
 266
 267         if (code == ATKBD_RET_EMUL0 || code == ATKBD_RET_EMUL1)
 268                 return 0;
 269
 270         for (i = 0; i < ARRAY_SIZE(xl_table); i++)
 271                 if (code == xl_table[i])
 272                         return test_bit(i, &xl_bit);
 273
 274         return 1;
 275 }
 276
 277 /*
 278  * Calculates new value of xl_bit so the driver can distinguish
 279  * between make/break pair of scancodes for select keys and PS/2
 280  * protocol responses.
 281  */
 282 static void atkbd_calculate_xl_bit(struct atkbd *atkbd, unsigned char code)
 283 {
 284         int i;
 285
 286         for (i = 0; i < ARRAY_SIZE(xl_table); i++) {
 287                 if (!((code ^ xl_table[i]) & 0x7f)) {
 288                         if (code & 0x80)
 289                                 __clear_bit(i, &atkbd->xl_bit);
 290                         else
 291                                 __set_bit(i, &atkbd->xl_bit);
 292                         break;
 293                 }
 294         }
 295 }
 296
 297 /*
 298  * Encode the scancode, 0xe0 prefix, and high bit into a single integer,
 299  * keeping kernel 2.4 compatibility for set 2
 300  */
 301 static unsigned int atkbd_compat_scancode(struct atkbd *atkbd, unsigned int code)
 302 {
 303         if (atkbd->set == 3) {
 304                 if (atkbd->emul == 1)
 305                         code |= 0x100;
 306         } else {
 307                 code = (code & 0x7f) | ((code & 0x80) << 1);
 308                 if (atkbd->emul == 1)
 309                         code |= 0x80;
 310         }
 311
 312         return code;
 313 }
 314
 315 /*
 316  * atkbd_interrupt(). Here takes place processing of data received from
 317  * the keyboard into events.
 318  */
 319
 320 static irqreturn_t atkbd_interrupt(struct serio *serio, unsigned char data,
 321                         unsigned int flags, struct pt_regs *regs)
 322 {
 323         struct atkbd *atkbd = serio_get_drvdata(serio);
 324         struct input_dev *dev = atkbd->dev;
 325         unsigned int code = data;
 326         int scroll = 0, hscroll = 0, click = -1, add_release_event = 0;
 327         int value;
 328         unsigned char keycode;
 329
 330 #ifdef ATKBD_DEBUG
 331         printk(KERN_DEBUG "atkbd.c: Received %02x flags %02x\n", data, flags);
 332 #endif
 333
 334 #if !defined(__i386__) && !defined (__x86_64__)
 335         if ((flags & (SERIO_FRAME | SERIO_PARITY)) && (~flags & SERIO_TIMEOUT) && !atkbd->resend && atkbd->write) {
 336                 printk(KERN_WARNING "atkbd.c: frame/parity error: %02x\n", flags);
 337                 serio_write(serio, ATKBD_CMD_RESEND);
 338                 atkbd->resend = 1;
 339                 goto out;
 340         }
 341
 342         if (!flags && data == ATKBD_RET_ACK)
 343                 atkbd->resend = 0;
 344 #endif
 345
 346         if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_ACK))
 347                 if  (ps2_handle_ack(&atkbd->ps2dev, data))
 348                         goto out;
 349
 350         if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_CMD))
 351                 if  (ps2_handle_response(&atkbd->ps2dev, data))
 352                         goto out;
 353
 354         if (!atkbd->enabled)
 355                 goto out;
 356
 357         input_event(dev, EV_MSC, MSC_RAW, code);
 358
 359         if (atkbd->translated) {
 360
 361                 if (atkbd->emul || atkbd_need_xlate(atkbd->xl_bit, code)) {
 362                         atkbd->release = code >> 7;
 363                         code &= 0x7f;
 364                 }
 365
 366                 if (!atkbd->emul)
 367                         atkbd_calculate_xl_bit(atkbd, data);
 368         }
 369
 370         switch (code) {
 371                 case ATKBD_RET_BAT:
 372                         atkbd->enabled = 0;
 373                         serio_reconnect(atkbd->ps2dev.serio);
 374                         goto out;
 375                 case ATKBD_RET_EMUL0:
 376                         atkbd->emul = 1;
 377                         goto out;
 378                 case ATKBD_RET_EMUL1:
 379                         atkbd->emul = 2;
 380                         goto out;
 381                 case ATKBD_RET_RELEASE:
 382                         atkbd->release = 1;
 383                         goto out;
 384                 case ATKBD_RET_ACK:
 385                 case ATKBD_RET_NAK:
 386                         printk(KERN_WARNING "atkbd.c: Spurious %s on %s. "
 387                                "Some program might be trying access hardware directly.\n",
 388                                data == ATKBD_RET_ACK ? "ACK" : "NAK", serio->phys);
 389                         goto out;
 390                 case ATKBD_RET_HANGEUL:
 391                 case ATKBD_RET_HANJA:
 392                         /*
 393                          * These keys do not report release and thus need to be
 394                          * flagged properly
 395                          */
 396                         add_release_event = 1;
 397                         break;
 398                 case ATKBD_RET_ERR:
 399                         printk(KERN_DEBUG "atkbd.c: Keyboard on %s reports too many keys pressed.\n", serio->phys);
 400                         goto out;
 401         }
 402
 403         code = atkbd_compat_scancode(atkbd, code);
 404
 405         if (atkbd->emul && --atkbd->emul)
 406                 goto out;
 407
 408         keycode = atkbd->keycode[code];
 409
 410         if (keycode != ATKBD_KEY_NULL)
 411                 input_event(dev, EV_MSC, MSC_SCAN, code);
 412
 413         switch (keycode) {
 414                 case ATKBD_KEY_NULL:
 415                         break;
 416                 case ATKBD_KEY_UNKNOWN:
 417                         printk(KERN_WARNING
 418                                "atkbd.c: Unknown key %s (%s set %d, code %#x on %s).\n",
 419                                atkbd->release ? "released" : "pressed",
 420                                atkbd->translated ? "translated" : "raw",
 421                                atkbd->set, code, serio->phys);
 422                         printk(KERN_WARNING
 423                                "atkbd.c: Use 'setkeycodes %s%02x <keycode>' to make it known.\n",
 424                                code & 0x80 ? "e0" : "", code & 0x7f);
 425                         input_sync(dev);
 426                         break;
 427                 case ATKBD_SCR_1:
 428                         scroll = 1 - atkbd->release * 2;
 429                         break;
 430                 case ATKBD_SCR_2:
 431                         scroll = 2 - atkbd->release * 4;
 432                         break;
 433                 case ATKBD_SCR_4:
 434                         scroll = 4 - atkbd->release * 8;
 435                         break;
 436                 case ATKBD_SCR_8:
 437                         scroll = 8 - atkbd->release * 16;
 438                         break;
 439                 case ATKBD_SCR_CLICK:
 440                         click = !atkbd->release;
 441                         break;
 442                 case ATKBD_SCR_LEFT:
 443                         hscroll = -1;
 444                         break;
 445                 case ATKBD_SCR_RIGHT:
 446                         hscroll = 1;
 447                         break;
 448                 default:
 449                         if (atkbd->release) {
 450                                 value = 0;
 451                                 atkbd->last = 0;
 452                         } else if (!atkbd->softrepeat && test_bit(keycode, dev->key)) {
 453                                 /* Workaround Toshiba laptop multiple keypress */
 454                                 value = time_before(jiffies, atkbd->time) && atkbd->last == code ? 1 : 2;
 455                         } else {
 456                                 value = 1;
 457                                 atkbd->last = code;
 458                                 atkbd->time = jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]) / 2;
 459                         }
 460
 461                         input_regs(dev, regs);
 462                         input_event(dev, EV_KEY, keycode, value);
 463                         input_sync(dev);
 464
 465                         if (value && add_release_event) {
 466                                 input_report_key(dev, keycode, 0);
 467                                 input_sync(dev);
 468                         }
 469         }
 470
 471         if (atkbd->scroll) {
 472                 input_regs(dev, regs);
 473                 if (click != -1)
 474                         input_report_key(dev, BTN_MIDDLE, click);
 475                 input_report_rel(dev, REL_WHEEL, scroll);
 476                 input_report_rel(dev, REL_HWHEEL, hscroll);
 477                 input_sync(dev);
 478         }
 479
 480         atkbd->release = 0;
 481 out:
 482         return IRQ_HANDLED;
 483 }
 484
 485 static int atkbd_set_repeat_rate(struct atkbd *atkbd)
 486 {
 487         const short period[32] =
 488                 { 33,  37,  42,  46,  50,  54,  58,  63,  67,  75,  83,  92, 100, 109, 116, 125,
 489                  133, 149, 167, 182, 200, 217, 232, 250, 270, 303, 333, 370, 400, 435, 470, 500 };
 490         const short delay[4] =
 491                 { 250, 500, 750, 1000 };
 492
 493         struct input_dev *dev = atkbd->dev;
 494         unsigned char param;
 495         int i = 0, j = 0;
 496
 497         while (i < ARRAY_SIZE(period) - 1 && period[i] < dev->rep[REP_PERIOD])
 498                 i++;
 499         dev->rep[REP_PERIOD] = period[i];
 500
 501         while (j < ARRAY_SIZE(delay) - 1 && delay[j] < dev->rep[REP_DELAY])
 502                 j++;
 503         dev->rep[REP_DELAY] = delay[j];
 504
 505         param = i | (j << 5);
 506         return ps2_command(&atkbd->ps2dev, &param, ATKBD_CMD_SETREP);
 507 }
 508
 509 static int atkbd_set_leds(struct atkbd *atkbd)
 510 {
 511         struct input_dev *dev = atkbd->dev;
 512         unsigned char param[2];
 513
 514         param[0] = (test_bit(LED_SCROLLL, dev->led) ? 1 : 0)
 515                  | (test_bit(LED_NUML,    dev->led) ? 2 : 0)
 516                  | (test_bit(LED_CAPSL,   dev->led) ? 4 : 0);
 517         if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))
 518                 return -1;
 519
 520         if (atkbd->extra) {
 521                 param[0] = 0;
 522                 param[1] = (test_bit(LED_COMPOSE, dev->led) ? 0x01 : 0)
 523                          | (test_bit(LED_SLEEP,   dev->led) ? 0x02 : 0)
 524                          | (test_bit(LED_SUSPEND, dev->led) ? 0x04 : 0)
 525                          | (test_bit(LED_MISC,    dev->led) ? 0x10 : 0)
 526                          | (test_bit(LED_MUTE,    dev->led) ? 0x20 : 0);
 527                 if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_EX_SETLEDS))
 528                         return -1;
 529         }
 530
 531         return 0;
 532 }
 533
 534 /*
 535  * atkbd_event_work() is used to complete processing of events that
 536  * can not be processed by input_event() which is often called from
 537  * interrupt context.
 538  */
 539
 540 static void atkbd_event_work(void *data)
 541 {
 542         struct atkbd *atkbd = data;
 543
 544         mutex_lock(&atkbd->event_mutex);
 545
 546         if (test_and_clear_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask))
 547                 atkbd_set_leds(atkbd);
 548
 549         if (test_and_clear_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask))
 550                 atkbd_set_repeat_rate(atkbd);
 551
 552         mutex_unlock(&atkbd->event_mutex);
 553 }
 554
 555 /*
 556  * Event callback from the input module. Events that change the state of
 557  * the hardware are processed here. If action can not be performed in
 558  * interrupt context it is offloaded to atkbd_event_work.
 559  */
 560
 561 static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
 562 {
 563         struct atkbd *atkbd = dev->private;
 564
 565         if (!atkbd->write)
 566                 return -1;
 567
 568         switch (type) {
 569
 570                 case EV_LED:
 571                         set_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask);
 572                         wmb();
 573                         schedule_work(&atkbd->event_work);
 574                         return 0;
 575
 576                 case EV_REP:
 577
 578                         if (!atkbd->softrepeat) {
 579                                 set_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask);
 580                                 wmb();
 581                                 schedule_work(&atkbd->event_work);
 582                         }
 583
 584                         return 0;
 585         }
 586
 587         return -1;
 588 }
 589
 590 /*
 591  * atkbd_enable() signals that interrupt handler is allowed to
 592  * generate input events.
 593  */
 594
 595 static inline void atkbd_enable(struct atkbd *atkbd)
 596 {
 597         serio_pause_rx(atkbd->ps2dev.serio);
 598         atkbd->enabled = 1;
 599         serio_continue_rx(atkbd->ps2dev.serio);
 600 }
 601
 602 /*
 603  * atkbd_disable() tells input handler that all incoming data except
 604  * for ACKs and command response should be dropped.
 605  */
 606
 607 static inline void atkbd_disable(struct atkbd *atkbd)
 608 {
 609         serio_pause_rx(atkbd->ps2dev.serio);
 610         atkbd->enabled = 0;
 611         serio_continue_rx(atkbd->ps2dev.serio);
 612 }
 613
 614 /*
 615  * atkbd_probe() probes for an AT keyboard on a serio port.
 616  */
 617
 618 static int atkbd_probe(struct atkbd *atkbd)
 619 {
 620         struct ps2dev *ps2dev = &atkbd->ps2dev;
 621         unsigned char param[2];
 622
 623 /*
 624  * Some systems, where the bit-twiddling when testing the io-lines of the
 625  * controller may confuse the keyboard need a full reset of the keyboard. On
 626  * these systems the BIOS also usually doesn't do it for us.
 627  */
 628
 629         if (atkbd_reset)
 630                 if (ps2_command(ps2dev, NULL, ATKBD_CMD_RESET_BAT))
 631                         printk(KERN_WARNING "atkbd.c: keyboard reset failed on %s\n", ps2dev->serio->phys);
 632
 633 /*
 634  * Then we check the keyboard ID. We should get 0xab83 under normal conditions.
 635  * Some keyboards report different values, but the first byte is always 0xab or
 636  * 0xac. Some old AT keyboards don't report anything. If a mouse is connected, this
 637  * should make sure we don't try to set the LEDs on it.
 638  */
 639
 640         param[0] = param[1] = 0xa5;     /* initialize with invalid values */
 641         if (ps2_command(ps2dev, param, ATKBD_CMD_GETID)) {
 642
 643 /*
 644  * If the get ID command failed, we check if we can at least set the LEDs on
 645  * the keyboard. This should work on every keyboard out there. It also turns
 646  * the LEDs off, which we want anyway.
 647  */
 648                 param[0] = 0;
 649                 if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
 650                         return -1;
 651                 atkbd->id = 0xabba;
 652                 return 0;
 653         }
 654
 655         if (param[0] != 0xab && param[0] != 0xac &&     /* Regular and NCD Sun keyboards */
 656             param[0] != 0x2b && param[0] != 0x5d &&     /* Trust keyboard, raw and translated */
 657             param[0] != 0x60 && param[0] != 0x47)       /* NMB SGI keyboard, raw and translated */
 658                 return -1;
 659
 660         atkbd->id = (param[0] << 8) | param[1];
 661
 662         if (atkbd->id == 0xaca1 && atkbd->translated) {
 663                 printk(KERN_ERR "atkbd.c: NCD terminal keyboards are only supported on non-translating\n");
 664                 printk(KERN_ERR "atkbd.c: controllers. Use i8042.direct=1 to disable translation.\n");
 665                 return -1;
 666         }
 667
 668         return 0;
 669 }
 670
 671 /*
 672  * atkbd_select_set checks if a keyboard has a working Set 3 support, and
 673  * sets it into that. Unfortunately there are keyboards that can be switched
 674  * to Set 3, but don't work well in that (BTC Multimedia ...)
 675  */
 676
 677 static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra)
 678 {
 679         struct ps2dev *ps2dev = &atkbd->ps2dev;
 680         unsigned char param[2];
 681
 682         atkbd->extra = 0;
 683 /*
 684  * For known special keyboards we can go ahead and set the correct set.
 685  * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and
 686  * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards.
 687  */
 688
 689         if (atkbd->translated)
 690                 return 2;
 691
 692         if (atkbd->id == 0xaca1) {
 693                 param[0] = 3;
 694                 ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);
 695                 return 3;
 696         }
 697
 698         if (allow_extra) {
 699                 param[0] = 0x71;
 700                 if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {
 701                         atkbd->extra = 1;
 702                         return 2;
 703                 }
 704         }
 705
 706         if (target_set != 3)
 707                 return 2;
 708
 709         if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {
 710                 atkbd->id = param[0] << 8 | param[1];
 711                 return 2;
 712         }
 713
 714         param[0] = 3;
 715         if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
 716                 return 2;
 717
 718         param[0] = 0;
 719         if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))
 720                 return 2;
 721
 722         if (param[0] != 3) {
 723                 param[0] = 2;
 724                 if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
 725                 return 2;
 726         }
 727
 728         ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);
 729
 730         return 3;
 731 }
 732
 733 static int atkbd_activate(struct atkbd *atkbd)
 734 {
 735         struct ps2dev *ps2dev = &atkbd->ps2dev;
 736         unsigned char param[1];
 737
 738 /*
 739  * Set the LEDs to a defined state.
 740  */
 741
 742         param[0] = 0;
 743         if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
 744                 return -1;
 745
 746 /*
 747  * Set autorepeat to fastest possible.
 748  */
 749
 750         param[0] = 0;
 751         if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
 752                 return -1;
 753
 754 /*
 755  * Enable the keyboard to receive keystrokes.
 756  */
 757
 758         if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {
 759                 printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",
 760                         ps2dev->serio->phys);
 761                 return -1;
 762         }
 763
 764         return 0;
 765 }
 766
 767 /*
 768  * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a
 769  * reboot.
 770  */
 771
 772 static void atkbd_cleanup(struct serio *serio)
 773 {
 774         struct atkbd *atkbd = serio_get_drvdata(serio);
 775         ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);
 776 }
 777
 778
 779 /*
 780  * atkbd_disconnect() closes and frees.
 781  */
 782
 783 static void atkbd_disconnect(struct serio *serio)
 784 {
 785         struct atkbd *atkbd = serio_get_drvdata(serio);
 786
 787         atkbd_disable(atkbd);
 788
 789         /* make sure we don't have a command in flight */
 790         synchronize_sched();  /* Allow atkbd_interrupt()s to complete. */
 791         flush_scheduled_work();
 792
 793         device_remove_file(&serio->dev, &atkbd_attr_extra);
 794         device_remove_file(&serio->dev, &atkbd_attr_scroll);
 795         device_remove_file(&serio->dev, &atkbd_attr_set);
 796         device_remove_file(&serio->dev, &atkbd_attr_softrepeat);
 797         device_remove_file(&serio->dev, &atkbd_attr_softraw);
 798
 799         input_unregister_device(atkbd->dev);
 800         serio_close(serio);
 801         serio_set_drvdata(serio, NULL);
 802         kfree(atkbd);
 803 }
 804
 805
 806 /*
 807  * atkbd_set_keycode_table() initializes keyboard's keycode table
 808  * according to the selected scancode set
 809  */
 810
 811 static void atkbd_set_keycode_table(struct atkbd *atkbd)
 812 {
 813         int i, j;
 814
 815         memset(atkbd->keycode, 0, sizeof(atkbd->keycode));
 816
 817         if (atkbd->translated) {
 818                 for (i = 0; i < 128; i++) {
 819                         atkbd->keycode[i] = atkbd_set2_keycode[atkbd_unxlate_table[i]];
 820                         atkbd->keycode[i | 0x80] = atkbd_set2_keycode[atkbd_unxlate_table[i] | 0x80];
 821                         if (atkbd->scroll)
 822                                 for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)
 823                                         if ((atkbd_unxlate_table[i] | 0x80) == atkbd_scroll_keys[j].set2)
 824                                                 atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;
 825                 }
 826         } else if (atkbd->set == 3) {
 827                 memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));
 828         } else {
 829                 memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));
 830
 831                 if (atkbd->scroll)
 832                         for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++)
 833                                 atkbd->keycode[atkbd_scroll_keys[i].set2] = atkbd_scroll_keys[i].keycode;
 834         }
 835
 836         atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANGEUL)] = KEY_HANGUEL;
 837         atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANJA)] = KEY_HANJA;
 838 }
 839
 840 /*
 841  * atkbd_set_device_attrs() sets up keyboard's input device structure
 842  */
 843
 844 static void atkbd_set_device_attrs(struct atkbd *atkbd)
 845 {
 846         struct input_dev *input_dev = atkbd->dev;
 847         int i;
 848
 849         if (atkbd->extra)
 850                 snprintf(atkbd->name, sizeof(atkbd->name),
 851                          "AT Set 2 Extra keyboard");
 852         else
 853                 snprintf(atkbd->name, sizeof(atkbd->name),
 854                          "AT %s Set %d keyboard",
 855                          atkbd->translated ? "Translated" : "Raw", atkbd->set);
 856
 857         snprintf(atkbd->phys, sizeof(atkbd->phys),
 858                  "%s/input0", atkbd->ps2dev.serio->phys);
 859
 860         input_dev->name = atkbd->name;
 861         input_dev->phys = atkbd->phys;
 862         input_dev->id.bustype = BUS_I8042;
 863         input_dev->id.vendor = 0x0001;
 864         input_dev->id.product = atkbd->translated ? 1 : atkbd->set;
 865         input_dev->id.version = atkbd->id;
 866         input_dev->event = atkbd_event;
 867         input_dev->private = atkbd;
 868         input_dev->cdev.dev = &atkbd->ps2dev.serio->dev;
 869
 870         input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC);
 871
 872         if (atkbd->write) {
 873                 input_dev->evbit[0] |= BIT(EV_LED);
 874                 input_dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL);
 875         }
 876
 877         if (atkbd->extra)
 878                 input_dev->ledbit[0] |= BIT(LED_COMPOSE) | BIT(LED_SUSPEND) |
 879                                         BIT(LED_SLEEP) | BIT(LED_MUTE) | BIT(LED_MISC);
 880
 881         if (!atkbd->softrepeat) {
 882                 input_dev->rep[REP_DELAY] = 250;
 883                 input_dev->rep[REP_PERIOD] = 33;
 884         }
 885
 886         input_dev->mscbit[0] = atkbd->softraw ? BIT(MSC_SCAN) : BIT(MSC_RAW) | BIT(MSC_SCAN);
 887
 888         if (atkbd->scroll) {
 889                 input_dev->evbit[0] |= BIT(EV_REL);
 890                 input_dev->relbit[0] = BIT(REL_WHEEL) | BIT(REL_HWHEEL);
 891                 set_bit(BTN_MIDDLE, input_dev->keybit);
 892         }
 893
 894         input_dev->keycode = atkbd->keycode;
 895         input_dev->keycodesize = sizeof(unsigned char);
 896         input_dev->keycodemax = ARRAY_SIZE(atkbd_set2_keycode);
 897
 898         for (i = 0; i < 512; i++)
 899                 if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)
 900                         set_bit(atkbd->keycode[i], input_dev->keybit);
 901 }
 902
 903 /*
 904  * atkbd_connect() is called when the serio module finds an interface
 905  * that isn't handled yet by an appropriate device driver. We check if
 906  * there is an AT keyboard out there and if yes, we register ourselves
 907  * to the input module.
 908  */
 909
 910 static int atkbd_connect(struct serio *serio, struct serio_driver *drv)
 911 {
 912         struct atkbd *atkbd;
 913         struct input_dev *dev;
 914         int err = -ENOMEM;
 915
 916         atkbd = kzalloc(sizeof(struct atkbd), GFP_KERNEL);
 917         dev = input_allocate_device();
 918         if (!atkbd || !dev)
 919                 goto fail;
 920
 921         atkbd->dev = dev;
 922         ps2_init(&atkbd->ps2dev, serio);
 923         INIT_WORK(&atkbd->event_work, atkbd_event_work, atkbd);
 924         mutex_init(&atkbd->event_mutex);
 925
 926         switch (serio->id.type) {
 927
 928                 case SERIO_8042_XL:
 929                         atkbd->translated = 1;
 930                 case SERIO_8042:
 931                         if (serio->write)
 932                                 atkbd->write = 1;
 933                         break;
 934         }
 935
 936         atkbd->softraw = atkbd_softraw;
 937         atkbd->softrepeat = atkbd_softrepeat;
 938         atkbd->scroll = atkbd_scroll;
 939
 940         if (atkbd->softrepeat)
 941                 atkbd->softraw = 1;
 942
 943         serio_set_drvdata(serio, atkbd);
 944
 945         err = serio_open(serio, drv);
 946         if (err)
 947                 goto fail;
 948
 949         if (atkbd->write) {
 950
 951                 if (atkbd_probe(atkbd)) {
 952                         serio_close(serio);
 953                         err = -ENODEV;
 954                         goto fail;
 955                 }
 956
 957                 atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);
 958                 atkbd_activate(atkbd);
 959
 960         } else {
 961                 atkbd->set = 2;
 962                 atkbd->id = 0xab00;
 963         }
 964
 965         atkbd_set_keycode_table(atkbd);
 966         atkbd_set_device_attrs(atkbd);
 967
 968         device_create_file(&serio->dev, &atkbd_attr_extra);
 969         device_create_file(&serio->dev, &atkbd_attr_scroll);
 970         device_create_file(&serio->dev, &atkbd_attr_set);
 971         device_create_file(&serio->dev, &atkbd_attr_softrepeat);
 972         device_create_file(&serio->dev, &atkbd_attr_softraw);
 973
 974         atkbd_enable(atkbd);
 975
 976         input_register_device(atkbd->dev);
 977
 978         return 0;
 979
 980  fail:  serio_set_drvdata(serio, NULL);
 981         input_free_device(dev);
 982         kfree(atkbd);
 983         return err;
 984 }
 985
 986 /*
 987  * atkbd_reconnect() tries to restore keyboard into a sane state and is
 988  * most likely called on resume.
 989  */
 990
 991 static int atkbd_reconnect(struct serio *serio)
 992 {
 993         struct atkbd *atkbd = serio_get_drvdata(serio);
 994         struct serio_driver *drv = serio->drv;
 995
 996         if (!atkbd || !drv) {
 997                 printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");
 998                 return -1;
 999         }
1000
1001         atkbd_disable(atkbd);
1002
1003         if (atkbd->write) {
1004                 if (atkbd_probe(atkbd))
1005                         return -1;
1006                 if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))
1007                         return -1;
1008
1009                 atkbd_activate(atkbd);
1010
1011 /*
1012  * Restore repeat rate and LEDs (that were reset by atkbd_activate)
1013  * to pre-resume state
1014  */
1015                 if (!atkbd->softrepeat)
1016                         atkbd_set_repeat_rate(atkbd);
1017                 atkbd_set_leds(atkbd);
1018         }
1019
1020         atkbd_enable(atkbd);
1021
1022         return 0;
1023 }
1024
1025 static struct serio_device_id atkbd_serio_ids[] = {
1026         {
1027                 .type   = SERIO_8042,
1028                 .proto  = SERIO_ANY,
1029                 .id     = SERIO_ANY,
1030                 .extra  = SERIO_ANY,
1031         },
1032         {
1033                 .type   = SERIO_8042_XL,
1034                 .proto  = SERIO_ANY,
1035                 .id     = SERIO_ANY,
1036                 .extra  = SERIO_ANY,
1037         },
1038         {
1039                 .type   = SERIO_RS232,
1040                 .proto  = SERIO_PS2SER,
1041                 .id     = SERIO_ANY,
1042                 .extra  = SERIO_ANY,
1043         },
1044         { 0 }
1045 };
1046
1047 MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);
1048
1049 static struct serio_driver atkbd_drv = {
1050         .driver         = {
1051                 .name   = "atkbd",
1052         },
1053         .description    = DRIVER_DESC,
1054         .id_table       = atkbd_serio_ids,
1055         .interrupt      = atkbd_interrupt,
1056         .connect        = atkbd_connect,
1057         .reconnect      = atkbd_reconnect,
1058         .disconnect     = atkbd_disconnect,
1059         .cleanup        = atkbd_cleanup,
1060 };
1061
1062 static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
1063                                 ssize_t (*handler)(struct atkbd *, char *))
1064 {
1065         struct serio *serio = to_serio_port(dev);
1066         int retval;
1067
1068         retval = serio_pin_driver(serio);
1069         if (retval)
1070                 return retval;
1071
1072         if (serio->drv != &atkbd_drv) {
1073                 retval = -ENODEV;
1074                 goto out;
1075         }
1076
1077         retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);
1078
1079 out:
1080         serio_unpin_driver(serio);
1081         return retval;
1082 }
1083
1084 static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
1085                                 ssize_t (*handler)(struct atkbd *, const char *, size_t))
1086 {
1087         struct serio *serio = to_serio_port(dev);
1088         struct atkbd *atkbd;
1089         int retval;
1090
1091         retval = serio_pin_driver(serio);
1092         if (retval)
1093                 return retval;
1094
1095         if (serio->drv != &atkbd_drv) {
1096                 retval = -ENODEV;
1097                 goto out;
1098         }
1099
1100         atkbd = serio_get_drvdata(serio);
1101         atkbd_disable(atkbd);
1102         retval = handler(atkbd, buf, count);
1103         atkbd_enable(atkbd);
1104
1105 out:
1106         serio_unpin_driver(serio);
1107         return retval;
1108 }
1109
1110 static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf)
1111 {
1112         return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);
1113 }
1114
1115 static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count)
1116 {
1117         struct input_dev *new_dev;
1118         unsigned long value;
1119         char *rest;
1120
1121         if (!atkbd->write)
1122                 return -EIO;
1123
1124         value = simple_strtoul(buf, &rest, 10);
1125         if (*rest || value > 1)
1126                 return -EINVAL;
1127
1128         if (atkbd->extra != value) {
1129                 /*
1130                  * Since device's properties will change we need to
1131                  * unregister old device. But allocate new one first
1132                  * to make sure we have it.
1133                  */
1134                 if (!(new_dev = input_allocate_device()))
1135                         return -ENOMEM;
1136                 input_unregister_device(atkbd->dev);
1137                 atkbd->dev = new_dev;
1138                 atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);
1139                 atkbd_activate(atkbd);
1140                 atkbd_set_device_attrs(atkbd);
1141                 input_register_device(atkbd->dev);
1142         }
1143         return count;
1144 }
1145
1146 static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf)
1147 {
1148         return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);
1149 }
1150
1151 static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count)
1152 {
1153         struct input_dev *new_dev;
1154         unsigned long value;
1155         char *rest;
1156
1157         value = simple_strtoul(buf, &rest, 10);
1158         if (*rest || value > 1)
1159                 return -EINVAL;
1160
1161         if (atkbd->scroll != value) {
1162                 if (!(new_dev = input_allocate_device()))
1163                         return -ENOMEM;
1164                 input_unregister_device(atkbd->dev);
1165                 atkbd->dev = new_dev;
1166                 atkbd->scroll = value;
1167                 atkbd_set_keycode_table(atkbd);
1168                 atkbd_set_device_attrs(atkbd);
1169                 input_register_device(atkbd->dev);
1170         }
1171         return count;
1172 }
1173
1174 static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf)
1175 {
1176         return sprintf(buf, "%d\n", atkbd->set);
1177 }
1178
1179 static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count)
1180 {
1181         struct input_dev *new_dev;
1182         unsigned long value;
1183         char *rest;
1184
1185         if (!atkbd->write)
1186                 return -EIO;
1187
1188         value = simple_strtoul(buf, &rest, 10);
1189         if (*rest || (value != 2 && value != 3))
1190                 return -EINVAL;
1191
1192         if (atkbd->set != value) {
1193                 if (!(new_dev = input_allocate_device()))
1194                         return -ENOMEM;
1195                 input_unregister_device(atkbd->dev);
1196                 atkbd->dev = new_dev;
1197                 atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);
1198                 atkbd_activate(atkbd);
1199                 atkbd_set_keycode_table(atkbd);
1200                 atkbd_set_device_attrs(atkbd);
1201                 input_register_device(atkbd->dev);
1202         }
1203         return count;
1204 }
1205
1206 static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf)
1207 {
1208         return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);
1209 }
1210
1211 static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count)
1212 {
1213         struct input_dev *new_dev;
1214         unsigned long value;
1215         char *rest;
1216
1217         if (!atkbd->write)
1218                 return -EIO;
1219
1220         value = simple_strtoul(buf, &rest, 10);
1221         if (*rest || value > 1)
1222                 return -EINVAL;
1223
1224         if (atkbd->softrepeat != value) {
1225                 if (!(new_dev = input_allocate_device()))
1226                         return -ENOMEM;
1227                 input_unregister_device(atkbd->dev);
1228                 atkbd->dev = new_dev;
1229                 atkbd->softrepeat = value;
1230                 if (atkbd->softrepeat)
1231                         atkbd->softraw = 1;
1232                 atkbd_set_device_attrs(atkbd);
1233                 input_register_device(atkbd->dev);
1234         }
1235         return count;
1236 }
1237
1238
1239 static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf)
1240 {
1241         return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);
1242 }
1243
1244 static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count)
1245 {
1246         struct input_dev *new_dev;
1247         unsigned long value;
1248         char *rest;
1249
1250         value = simple_strtoul(buf, &rest, 10);
1251         if (*rest || value > 1)
1252                 return -EINVAL;
1253
1254         if (atkbd->softraw != value) {
1255                 if (!(new_dev = input_allocate_device()))
1256                         return -ENOMEM;
1257                 input_unregister_device(atkbd->dev);
1258                 atkbd->dev = new_dev;
1259                 atkbd->softraw = value;
1260                 atkbd_set_device_attrs(atkbd);
1261                 input_register_device(atkbd->dev);
1262         }
1263         return count;
1264 }
1265
1266
1267 static int __init atkbd_init(void)
1268 {
1269         serio_register_driver(&atkbd_drv);
1270         return 0;
1271 }
1272
1273 static void __exit atkbd_exit(void)
1274 {
1275         serio_unregister_driver(&atkbd_drv);
1276 }
1277
1278 module_init(atkbd_init);
1279 module_exit(atkbd_exit);