xref: /linux/drivers/input/keyboard/atkbd.c (revision adcb523eb39e0dd2f712d8dbd8e18b5d36a97825)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * AT and PS/2 keyboard driver
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * Copyright (c) 1999-2002 Vojtech Pavlik
51da177e4SLinus Torvalds  */
61da177e4SLinus Torvalds 
71da177e4SLinus Torvalds /*
81da177e4SLinus Torvalds  * This program is free software; you can redistribute it and/or modify it
91da177e4SLinus Torvalds  * under the terms of the GNU General Public License version 2 as published by
101da177e4SLinus Torvalds  * the Free Software Foundation.
111da177e4SLinus Torvalds  */
121da177e4SLinus Torvalds 
131da177e4SLinus Torvalds /*
141da177e4SLinus Torvalds  * This driver can handle standard AT keyboards and PS/2 keyboards in
151da177e4SLinus Torvalds  * Translated and Raw Set 2 and Set 3, as well as AT keyboards on dumb
161da177e4SLinus Torvalds  * input-only controllers and AT keyboards connected over a one way RS232
171da177e4SLinus Torvalds  * converter.
181da177e4SLinus Torvalds  */
191da177e4SLinus Torvalds 
201da177e4SLinus Torvalds #include <linux/delay.h>
211da177e4SLinus Torvalds #include <linux/module.h>
221da177e4SLinus Torvalds #include <linux/slab.h>
231da177e4SLinus Torvalds #include <linux/interrupt.h>
241da177e4SLinus Torvalds #include <linux/init.h>
251da177e4SLinus Torvalds #include <linux/input.h>
261da177e4SLinus Torvalds #include <linux/serio.h>
271da177e4SLinus Torvalds #include <linux/workqueue.h>
281da177e4SLinus Torvalds #include <linux/libps2.h>
2933d3f07aSIngo Molnar #include <linux/mutex.h>
30554101e3SGiel de Nijs #include <linux/dmi.h>
311da177e4SLinus Torvalds 
321da177e4SLinus Torvalds #define DRIVER_DESC	"AT and PS/2 keyboard driver"
331da177e4SLinus Torvalds 
341da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
351da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC);
361da177e4SLinus Torvalds MODULE_LICENSE("GPL");
371da177e4SLinus Torvalds 
381da177e4SLinus Torvalds static int atkbd_set = 2;
391da177e4SLinus Torvalds module_param_named(set, atkbd_set, int, 0);
401da177e4SLinus Torvalds MODULE_PARM_DESC(set, "Select keyboard code set (2 = default, 3 = PS/2 native)");
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds #if defined(__i386__) || defined(__x86_64__) || defined(__hppa__)
431da177e4SLinus Torvalds static int atkbd_reset;
441da177e4SLinus Torvalds #else
451da177e4SLinus Torvalds static int atkbd_reset = 1;
461da177e4SLinus Torvalds #endif
471da177e4SLinus Torvalds module_param_named(reset, atkbd_reset, bool, 0);
481da177e4SLinus Torvalds MODULE_PARM_DESC(reset, "Reset keyboard during initialization");
491da177e4SLinus Torvalds 
501da177e4SLinus Torvalds static int atkbd_softrepeat;
511da177e4SLinus Torvalds module_param_named(softrepeat, atkbd_softrepeat, bool, 0);
521da177e4SLinus Torvalds MODULE_PARM_DESC(softrepeat, "Use software keyboard repeat");
531da177e4SLinus Torvalds 
541da177e4SLinus Torvalds static int atkbd_softraw = 1;
551da177e4SLinus Torvalds module_param_named(softraw, atkbd_softraw, bool, 0);
561da177e4SLinus Torvalds MODULE_PARM_DESC(softraw, "Use software generated rawmode");
571da177e4SLinus Torvalds 
580ae051a1SDmitry Torokhov static int atkbd_scroll;
591da177e4SLinus Torvalds module_param_named(scroll, atkbd_scroll, bool, 0);
601da177e4SLinus Torvalds MODULE_PARM_DESC(scroll, "Enable scroll-wheel on MS Office and similar keyboards");
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds static int atkbd_extra;
631da177e4SLinus Torvalds module_param_named(extra, atkbd_extra, bool, 0);
641da177e4SLinus Torvalds MODULE_PARM_DESC(extra, "Enable extra LEDs and keys on IBM RapidAcces, EzKey and similar keyboards");
651da177e4SLinus Torvalds 
661da177e4SLinus Torvalds /*
671da177e4SLinus Torvalds  * Scancode to keycode tables. These are just the default setting, and
680211a9c8SFrederik Schwarzer  * are loadable via a userland utility.
691da177e4SLinus Torvalds  */
701da177e4SLinus Torvalds 
71f6d65610SDmitry Torokhov static const unsigned short atkbd_set2_keycode[512] = {
721da177e4SLinus Torvalds 
731da177e4SLinus Torvalds #ifdef CONFIG_KEYBOARD_ATKBD_HP_KEYCODES
741da177e4SLinus Torvalds 
751da177e4SLinus Torvalds /* XXX: need a more general approach */
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds #include "hpps2atkbd.h"	/* include the keyboard scancodes */
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds #else
801da177e4SLinus Torvalds 	  0, 67, 65, 63, 61, 59, 60, 88,  0, 68, 66, 64, 62, 15, 41,117,
811da177e4SLinus Torvalds 	  0, 56, 42, 93, 29, 16,  2,  0,  0,  0, 44, 31, 30, 17,  3,  0,
821da177e4SLinus Torvalds 	  0, 46, 45, 32, 18,  5,  4, 95,  0, 57, 47, 33, 20, 19,  6,183,
831da177e4SLinus Torvalds 	  0, 49, 48, 35, 34, 21,  7,184,  0,  0, 50, 36, 22,  8,  9,185,
841da177e4SLinus Torvalds 	  0, 51, 37, 23, 24, 11, 10,  0,  0, 52, 53, 38, 39, 25, 12,  0,
851da177e4SLinus Torvalds 	  0, 89, 40,  0, 26, 13,  0,  0, 58, 54, 28, 27,  0, 43,  0, 85,
861da177e4SLinus Torvalds 	  0, 86, 91, 90, 92,  0, 14, 94,  0, 79,124, 75, 71,121,  0,  0,
871da177e4SLinus Torvalds 	 82, 83, 80, 76, 77, 72,  1, 69, 87, 78, 81, 74, 55, 73, 70, 99,
881da177e4SLinus Torvalds 
891da177e4SLinus Torvalds 	  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
901da177e4SLinus Torvalds 	217,100,255,  0, 97,165,  0,  0,156,  0,  0,  0,  0,  0,  0,125,
911da177e4SLinus Torvalds 	173,114,  0,113,  0,  0,  0,126,128,  0,  0,140,  0,  0,  0,127,
9272a42f24SHans de Goede 	159,  0,115,  0,164,  0,  0,116,158,  0,172,166,  0,  0,  0,142,
931da177e4SLinus Torvalds 	157,  0,  0,  0,  0,  0,  0,  0,155,  0, 98,  0,  0,163,  0,  0,
941da177e4SLinus Torvalds 	226,  0,  0,  0,  0,  0,  0,  0,  0,255, 96,  0,  0,  0,143,  0,
951da177e4SLinus Torvalds 	  0,  0,  0,  0,  0,  0,  0,  0,  0,107,  0,105,102,  0,  0,112,
961da177e4SLinus Torvalds 	110,111,108,112,106,103,  0,119,  0,118,109,  0, 99,104,119,  0,
971da177e4SLinus Torvalds 
981da177e4SLinus Torvalds 	  0,  0,  0, 65, 99,
991da177e4SLinus Torvalds #endif
1001da177e4SLinus Torvalds };
1011da177e4SLinus Torvalds 
102f6d65610SDmitry Torokhov static const unsigned short atkbd_set3_keycode[512] = {
1031da177e4SLinus Torvalds 
1041da177e4SLinus Torvalds 	  0,  0,  0,  0,  0,  0,  0, 59,  1,138,128,129,130, 15, 41, 60,
1051da177e4SLinus Torvalds 	131, 29, 42, 86, 58, 16,  2, 61,133, 56, 44, 31, 30, 17,  3, 62,
1061da177e4SLinus Torvalds 	134, 46, 45, 32, 18,  5,  4, 63,135, 57, 47, 33, 20, 19,  6, 64,
1071da177e4SLinus Torvalds 	136, 49, 48, 35, 34, 21,  7, 65,137,100, 50, 36, 22,  8,  9, 66,
1081da177e4SLinus Torvalds 	125, 51, 37, 23, 24, 11, 10, 67,126, 52, 53, 38, 39, 25, 12, 68,
1091da177e4SLinus Torvalds 	113,114, 40, 43, 26, 13, 87, 99, 97, 54, 28, 27, 43, 43, 88, 70,
1101da177e4SLinus Torvalds 	108,105,119,103,111,107, 14,110,  0, 79,106, 75, 71,109,102,104,
1111da177e4SLinus Torvalds 	 82, 83, 80, 76, 77, 72, 69, 98,  0, 96, 81,  0, 78, 73, 55,183,
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds 	184,185,186,187, 74, 94, 92, 93,  0,  0,  0,125,126,127,112,  0,
11472a42f24SHans de Goede 	  0,139,172,163,165,115,152,172,166,140,160,154,113,114,167,168,
1151da177e4SLinus Torvalds 	148,149,147,140
1161da177e4SLinus Torvalds };
1171da177e4SLinus Torvalds 
118f6d65610SDmitry Torokhov static const unsigned short atkbd_unxlate_table[128] = {
1191da177e4SLinus Torvalds           0,118, 22, 30, 38, 37, 46, 54, 61, 62, 70, 69, 78, 85,102, 13,
1201da177e4SLinus Torvalds          21, 29, 36, 45, 44, 53, 60, 67, 68, 77, 84, 91, 90, 20, 28, 27,
1211da177e4SLinus Torvalds          35, 43, 52, 51, 59, 66, 75, 76, 82, 14, 18, 93, 26, 34, 33, 42,
1221da177e4SLinus Torvalds          50, 49, 58, 65, 73, 74, 89,124, 17, 41, 88,  5,  6,  4, 12,  3,
1231da177e4SLinus Torvalds          11,  2, 10,  1,  9,119,126,108,117,125,123,107,115,116,121,105,
1241da177e4SLinus Torvalds         114,122,112,113,127, 96, 97,120,  7, 15, 23, 31, 39, 47, 55, 63,
1251da177e4SLinus Torvalds          71, 79, 86, 94,  8, 16, 24, 32, 40, 48, 56, 64, 72, 80, 87,111,
1261da177e4SLinus Torvalds          19, 25, 57, 81, 83, 92, 95, 98, 99,100,101,103,104,106,109,110
1271da177e4SLinus Torvalds };
1281da177e4SLinus Torvalds 
1291da177e4SLinus Torvalds #define ATKBD_CMD_SETLEDS	0x10ed
1301da177e4SLinus Torvalds #define ATKBD_CMD_GSCANSET	0x11f0
1311da177e4SLinus Torvalds #define ATKBD_CMD_SSCANSET	0x10f0
1321da177e4SLinus Torvalds #define ATKBD_CMD_GETID		0x02f2
1331da177e4SLinus Torvalds #define ATKBD_CMD_SETREP	0x10f3
1341da177e4SLinus Torvalds #define ATKBD_CMD_ENABLE	0x00f4
1351da177e4SLinus Torvalds #define ATKBD_CMD_RESET_DIS	0x00f5
1361da177e4SLinus Torvalds #define ATKBD_CMD_SETALL_MBR	0x00fa
1371da177e4SLinus Torvalds #define ATKBD_CMD_RESET_BAT	0x02ff
1381da177e4SLinus Torvalds #define ATKBD_CMD_RESEND	0x00fe
1391da177e4SLinus Torvalds #define ATKBD_CMD_EX_ENABLE	0x10ea
1401da177e4SLinus Torvalds #define ATKBD_CMD_EX_SETLEDS	0x20eb
1411da177e4SLinus Torvalds #define ATKBD_CMD_OK_GETID	0x02e8
1421da177e4SLinus Torvalds 
1431da177e4SLinus Torvalds #define ATKBD_RET_ACK		0xfa
1441da177e4SLinus Torvalds #define ATKBD_RET_NAK		0xfe
1451da177e4SLinus Torvalds #define ATKBD_RET_BAT		0xaa
1461da177e4SLinus Torvalds #define ATKBD_RET_EMUL0		0xe0
1471da177e4SLinus Torvalds #define ATKBD_RET_EMUL1		0xe1
1481da177e4SLinus Torvalds #define ATKBD_RET_RELEASE	0xf0
1490ae051a1SDmitry Torokhov #define ATKBD_RET_HANJA		0xf1
1500ae051a1SDmitry Torokhov #define ATKBD_RET_HANGEUL	0xf2
1511da177e4SLinus Torvalds #define ATKBD_RET_ERR		0xff
1521da177e4SLinus Torvalds 
1531da177e4SLinus Torvalds #define ATKBD_KEY_UNKNOWN	  0
1541da177e4SLinus Torvalds #define ATKBD_KEY_NULL		255
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds #define ATKBD_SCR_1		254
1571da177e4SLinus Torvalds #define ATKBD_SCR_2		253
1581da177e4SLinus Torvalds #define ATKBD_SCR_4		252
1591da177e4SLinus Torvalds #define ATKBD_SCR_8		251
1601da177e4SLinus Torvalds #define ATKBD_SCR_CLICK		250
1611da177e4SLinus Torvalds #define ATKBD_SCR_LEFT		249
1621da177e4SLinus Torvalds #define ATKBD_SCR_RIGHT		248
1631da177e4SLinus Torvalds 
164f6d65610SDmitry Torokhov #define ATKBD_SPECIAL		ATKBD_SCR_RIGHT
1651da177e4SLinus Torvalds 
1660d4c8597SDmitry Torokhov #define ATKBD_LED_EVENT_BIT	0
1670d4c8597SDmitry Torokhov #define ATKBD_REP_EVENT_BIT	1
1680d4c8597SDmitry Torokhov 
1690ae051a1SDmitry Torokhov #define ATKBD_XL_ERR		0x01
1700ae051a1SDmitry Torokhov #define ATKBD_XL_BAT		0x02
1710ae051a1SDmitry Torokhov #define ATKBD_XL_ACK		0x04
1720ae051a1SDmitry Torokhov #define ATKBD_XL_NAK		0x08
1730ae051a1SDmitry Torokhov #define ATKBD_XL_HANGEUL	0x10
1740ae051a1SDmitry Torokhov #define ATKBD_XL_HANJA		0x20
1750ae051a1SDmitry Torokhov 
176f6d65610SDmitry Torokhov static const struct {
1771da177e4SLinus Torvalds 	unsigned char keycode;
1781da177e4SLinus Torvalds 	unsigned char set2;
1791da177e4SLinus Torvalds } atkbd_scroll_keys[] = {
1801da177e4SLinus Torvalds 	{ ATKBD_SCR_1,     0xc5 },
1815212dd58SVojtech Pavlik 	{ ATKBD_SCR_2,     0x9d },
1825212dd58SVojtech Pavlik 	{ ATKBD_SCR_4,     0xa4 },
1835212dd58SVojtech Pavlik 	{ ATKBD_SCR_8,     0x9b },
1841da177e4SLinus Torvalds 	{ ATKBD_SCR_CLICK, 0xe0 },
1851da177e4SLinus Torvalds 	{ ATKBD_SCR_LEFT,  0xcb },
1861da177e4SLinus Torvalds 	{ ATKBD_SCR_RIGHT, 0xd2 },
1871da177e4SLinus Torvalds };
1881da177e4SLinus Torvalds 
1891da177e4SLinus Torvalds /*
1901da177e4SLinus Torvalds  * The atkbd control structure
1911da177e4SLinus Torvalds  */
1921da177e4SLinus Torvalds 
1931da177e4SLinus Torvalds struct atkbd {
1941da177e4SLinus Torvalds 
1951da177e4SLinus Torvalds 	struct ps2dev ps2dev;
1963c42f0c3SDmitry Torokhov 	struct input_dev *dev;
1971da177e4SLinus Torvalds 
1981da177e4SLinus Torvalds 	/* Written only during init */
1991da177e4SLinus Torvalds 	char name[64];
2001da177e4SLinus Torvalds 	char phys[32];
2011da177e4SLinus Torvalds 
2021da177e4SLinus Torvalds 	unsigned short id;
203f6d65610SDmitry Torokhov 	unsigned short keycode[512];
204554101e3SGiel de Nijs 	DECLARE_BITMAP(force_release_mask, 512);
2051da177e4SLinus Torvalds 	unsigned char set;
2061da177e4SLinus Torvalds 	unsigned char translated;
2071da177e4SLinus Torvalds 	unsigned char extra;
2081da177e4SLinus Torvalds 	unsigned char write;
2091da177e4SLinus Torvalds 	unsigned char softrepeat;
2101da177e4SLinus Torvalds 	unsigned char softraw;
2111da177e4SLinus Torvalds 	unsigned char scroll;
2121da177e4SLinus Torvalds 	unsigned char enabled;
2131da177e4SLinus Torvalds 
2141da177e4SLinus Torvalds 	/* Accessed only from interrupt */
2151da177e4SLinus Torvalds 	unsigned char emul;
2161da177e4SLinus Torvalds 	unsigned char resend;
2171da177e4SLinus Torvalds 	unsigned char release;
2180ae051a1SDmitry Torokhov 	unsigned long xl_bit;
2191da177e4SLinus Torvalds 	unsigned int last;
2201da177e4SLinus Torvalds 	unsigned long time;
22186255d9dSDmitry Torokhov 	unsigned long err_count;
2220d4c8597SDmitry Torokhov 
223da4249c9SDmitry Torokhov 	struct delayed_work event_work;
224da4249c9SDmitry Torokhov 	unsigned long event_jiffies;
22533d3f07aSIngo Molnar 	struct mutex event_mutex;
2260d4c8597SDmitry Torokhov 	unsigned long event_mask;
2271da177e4SLinus Torvalds };
2281da177e4SLinus Torvalds 
229554101e3SGiel de Nijs /*
230554101e3SGiel de Nijs  * System-specific ketymap fixup routine
231554101e3SGiel de Nijs  */
23239191698SDaniel Mierswa static void (*atkbd_platform_fixup)(struct atkbd *, const void *data);
23339191698SDaniel Mierswa static void *atkbd_platform_fixup_data;
234554101e3SGiel de Nijs 
2351da177e4SLinus Torvalds static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
2361da177e4SLinus Torvalds 				ssize_t (*handler)(struct atkbd *, char *));
2371da177e4SLinus Torvalds static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
2381da177e4SLinus Torvalds 				ssize_t (*handler)(struct atkbd *, const char *, size_t));
2391da177e4SLinus Torvalds #define ATKBD_DEFINE_ATTR(_name)						\
2401da177e4SLinus Torvalds static ssize_t atkbd_show_##_name(struct atkbd *, char *);			\
2411da177e4SLinus Torvalds static ssize_t atkbd_set_##_name(struct atkbd *, const char *, size_t);		\
24286255d9dSDmitry Torokhov static ssize_t atkbd_do_show_##_name(struct device *d,				\
24386255d9dSDmitry Torokhov 				struct device_attribute *attr, char *b)		\
2441da177e4SLinus Torvalds {										\
2451da177e4SLinus Torvalds 	return atkbd_attr_show_helper(d, b, atkbd_show_##_name);		\
2461da177e4SLinus Torvalds }										\
24786255d9dSDmitry Torokhov static ssize_t atkbd_do_set_##_name(struct device *d,				\
24886255d9dSDmitry Torokhov 			struct device_attribute *attr, const char *b, size_t s)	\
2491da177e4SLinus Torvalds {										\
2501da177e4SLinus Torvalds 	return atkbd_attr_set_helper(d, b, s, atkbd_set_##_name);		\
2511da177e4SLinus Torvalds }										\
2521da177e4SLinus Torvalds static struct device_attribute atkbd_attr_##_name =				\
2531da177e4SLinus Torvalds 	__ATTR(_name, S_IWUSR | S_IRUGO, atkbd_do_show_##_name, atkbd_do_set_##_name);
2541da177e4SLinus Torvalds 
2551da177e4SLinus Torvalds ATKBD_DEFINE_ATTR(extra);
2561da177e4SLinus Torvalds ATKBD_DEFINE_ATTR(scroll);
2571da177e4SLinus Torvalds ATKBD_DEFINE_ATTR(set);
2581da177e4SLinus Torvalds ATKBD_DEFINE_ATTR(softrepeat);
2591da177e4SLinus Torvalds ATKBD_DEFINE_ATTR(softraw);
2601da177e4SLinus Torvalds 
26186255d9dSDmitry Torokhov #define ATKBD_DEFINE_RO_ATTR(_name)						\
26286255d9dSDmitry Torokhov static ssize_t atkbd_show_##_name(struct atkbd *, char *);			\
26386255d9dSDmitry Torokhov static ssize_t atkbd_do_show_##_name(struct device *d,				\
26486255d9dSDmitry Torokhov 				struct device_attribute *attr, char *b)		\
26586255d9dSDmitry Torokhov {										\
26686255d9dSDmitry Torokhov 	return atkbd_attr_show_helper(d, b, atkbd_show_##_name);		\
26786255d9dSDmitry Torokhov }										\
26886255d9dSDmitry Torokhov static struct device_attribute atkbd_attr_##_name =				\
26986255d9dSDmitry Torokhov 	__ATTR(_name, S_IRUGO, atkbd_do_show_##_name, NULL);
27086255d9dSDmitry Torokhov 
27186255d9dSDmitry Torokhov ATKBD_DEFINE_RO_ATTR(err_count);
27286255d9dSDmitry Torokhov 
27386255d9dSDmitry Torokhov static struct attribute *atkbd_attributes[] = {
27486255d9dSDmitry Torokhov 	&atkbd_attr_extra.attr,
27586255d9dSDmitry Torokhov 	&atkbd_attr_scroll.attr,
27686255d9dSDmitry Torokhov 	&atkbd_attr_set.attr,
27786255d9dSDmitry Torokhov 	&atkbd_attr_softrepeat.attr,
27886255d9dSDmitry Torokhov 	&atkbd_attr_softraw.attr,
27986255d9dSDmitry Torokhov 	&atkbd_attr_err_count.attr,
28086255d9dSDmitry Torokhov 	NULL
28186255d9dSDmitry Torokhov };
28286255d9dSDmitry Torokhov 
28386255d9dSDmitry Torokhov static struct attribute_group atkbd_attribute_group = {
28486255d9dSDmitry Torokhov 	.attrs	= atkbd_attributes,
28586255d9dSDmitry Torokhov };
28686255d9dSDmitry Torokhov 
2870ae051a1SDmitry Torokhov static const unsigned int xl_table[] = {
2880ae051a1SDmitry Torokhov 	ATKBD_RET_BAT, ATKBD_RET_ERR, ATKBD_RET_ACK,
2890ae051a1SDmitry Torokhov 	ATKBD_RET_NAK, ATKBD_RET_HANJA, ATKBD_RET_HANGEUL,
2900ae051a1SDmitry Torokhov };
2911da177e4SLinus Torvalds 
2920ae051a1SDmitry Torokhov /*
2930ae051a1SDmitry Torokhov  * Checks if we should mangle the scancode to extract 'release' bit
2940ae051a1SDmitry Torokhov  * in translated mode.
2950ae051a1SDmitry Torokhov  */
2960ae051a1SDmitry Torokhov static int atkbd_need_xlate(unsigned long xl_bit, unsigned char code)
2971da177e4SLinus Torvalds {
2980ae051a1SDmitry Torokhov 	int i;
2990ae051a1SDmitry Torokhov 
3000ae051a1SDmitry Torokhov 	if (code == ATKBD_RET_EMUL0 || code == ATKBD_RET_EMUL1)
3010ae051a1SDmitry Torokhov 		return 0;
3020ae051a1SDmitry Torokhov 
3030ae051a1SDmitry Torokhov 	for (i = 0; i < ARRAY_SIZE(xl_table); i++)
3040ae051a1SDmitry Torokhov 		if (code == xl_table[i])
3050ae051a1SDmitry Torokhov 			return test_bit(i, &xl_bit);
3060ae051a1SDmitry Torokhov 
3070ae051a1SDmitry Torokhov 	return 1;
3080ae051a1SDmitry Torokhov }
3090ae051a1SDmitry Torokhov 
3100ae051a1SDmitry Torokhov /*
3110ae051a1SDmitry Torokhov  * Calculates new value of xl_bit so the driver can distinguish
3120ae051a1SDmitry Torokhov  * between make/break pair of scancodes for select keys and PS/2
3130ae051a1SDmitry Torokhov  * protocol responses.
3140ae051a1SDmitry Torokhov  */
3150ae051a1SDmitry Torokhov static void atkbd_calculate_xl_bit(struct atkbd *atkbd, unsigned char code)
3160ae051a1SDmitry Torokhov {
3170ae051a1SDmitry Torokhov 	int i;
3180ae051a1SDmitry Torokhov 
3190ae051a1SDmitry Torokhov 	for (i = 0; i < ARRAY_SIZE(xl_table); i++) {
3200ae051a1SDmitry Torokhov 		if (!((code ^ xl_table[i]) & 0x7f)) {
3210ae051a1SDmitry Torokhov 			if (code & 0x80)
3220ae051a1SDmitry Torokhov 				__clear_bit(i, &atkbd->xl_bit);
3230ae051a1SDmitry Torokhov 			else
3240ae051a1SDmitry Torokhov 				__set_bit(i, &atkbd->xl_bit);
3250ae051a1SDmitry Torokhov 			break;
3260ae051a1SDmitry Torokhov 		}
3270ae051a1SDmitry Torokhov 	}
3280ae051a1SDmitry Torokhov }
3290ae051a1SDmitry Torokhov 
3300ae051a1SDmitry Torokhov /*
3310ae051a1SDmitry Torokhov  * Encode the scancode, 0xe0 prefix, and high bit into a single integer,
3320ae051a1SDmitry Torokhov  * keeping kernel 2.4 compatibility for set 2
3330ae051a1SDmitry Torokhov  */
3340ae051a1SDmitry Torokhov static unsigned int atkbd_compat_scancode(struct atkbd *atkbd, unsigned int code)
3350ae051a1SDmitry Torokhov {
3360ae051a1SDmitry Torokhov 	if (atkbd->set == 3) {
3370ae051a1SDmitry Torokhov 		if (atkbd->emul == 1)
3380ae051a1SDmitry Torokhov 			code |= 0x100;
3390ae051a1SDmitry Torokhov         } else {
3400ae051a1SDmitry Torokhov 		code = (code & 0x7f) | ((code & 0x80) << 1);
3410ae051a1SDmitry Torokhov 		if (atkbd->emul == 1)
3420ae051a1SDmitry Torokhov 			code |= 0x80;
3430ae051a1SDmitry Torokhov 	}
3440ae051a1SDmitry Torokhov 
3450ae051a1SDmitry Torokhov 	return code;
3461da177e4SLinus Torvalds }
3471da177e4SLinus Torvalds 
3481da177e4SLinus Torvalds /*
3491da177e4SLinus Torvalds  * atkbd_interrupt(). Here takes place processing of data received from
3501da177e4SLinus Torvalds  * the keyboard into events.
3511da177e4SLinus Torvalds  */
3521da177e4SLinus Torvalds 
3531da177e4SLinus Torvalds static irqreturn_t atkbd_interrupt(struct serio *serio, unsigned char data,
3547d12e780SDavid Howells 			unsigned int flags)
3551da177e4SLinus Torvalds {
3561da177e4SLinus Torvalds 	struct atkbd *atkbd = serio_get_drvdata(serio);
3570ae051a1SDmitry Torokhov 	struct input_dev *dev = atkbd->dev;
3581da177e4SLinus Torvalds 	unsigned int code = data;
359554101e3SGiel de Nijs 	int scroll = 0, hscroll = 0, click = -1;
3601da177e4SLinus Torvalds 	int value;
361f6d65610SDmitry Torokhov 	unsigned short keycode;
3621da177e4SLinus Torvalds 
3631da177e4SLinus Torvalds #ifdef ATKBD_DEBUG
3641da177e4SLinus Torvalds 	printk(KERN_DEBUG "atkbd.c: Received %02x flags %02x\n", data, flags);
3651da177e4SLinus Torvalds #endif
3661da177e4SLinus Torvalds 
3671da177e4SLinus Torvalds #if !defined(__i386__) && !defined (__x86_64__)
3681da177e4SLinus Torvalds 	if ((flags & (SERIO_FRAME | SERIO_PARITY)) && (~flags & SERIO_TIMEOUT) && !atkbd->resend && atkbd->write) {
3691da177e4SLinus Torvalds 		printk(KERN_WARNING "atkbd.c: frame/parity error: %02x\n", flags);
3701da177e4SLinus Torvalds 		serio_write(serio, ATKBD_CMD_RESEND);
3711da177e4SLinus Torvalds 		atkbd->resend = 1;
3721da177e4SLinus Torvalds 		goto out;
3731da177e4SLinus Torvalds 	}
3741da177e4SLinus Torvalds 
3751da177e4SLinus Torvalds 	if (!flags && data == ATKBD_RET_ACK)
3761da177e4SLinus Torvalds 		atkbd->resend = 0;
3771da177e4SLinus Torvalds #endif
3781da177e4SLinus Torvalds 
3791da177e4SLinus Torvalds 	if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_ACK))
3801da177e4SLinus Torvalds 		if  (ps2_handle_ack(&atkbd->ps2dev, data))
3811da177e4SLinus Torvalds 			goto out;
3821da177e4SLinus Torvalds 
3831da177e4SLinus Torvalds 	if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_CMD))
3841da177e4SLinus Torvalds 		if  (ps2_handle_response(&atkbd->ps2dev, data))
3851da177e4SLinus Torvalds 			goto out;
3861da177e4SLinus Torvalds 
3871da177e4SLinus Torvalds 	if (!atkbd->enabled)
3881da177e4SLinus Torvalds 		goto out;
3891da177e4SLinus Torvalds 
3900ae051a1SDmitry Torokhov 	input_event(dev, EV_MSC, MSC_RAW, code);
3911da177e4SLinus Torvalds 
3921da177e4SLinus Torvalds 	if (atkbd->translated) {
3931da177e4SLinus Torvalds 
3940ae051a1SDmitry Torokhov 		if (atkbd->emul || atkbd_need_xlate(atkbd->xl_bit, code)) {
3951da177e4SLinus Torvalds 			atkbd->release = code >> 7;
3961da177e4SLinus Torvalds 			code &= 0x7f;
3971da177e4SLinus Torvalds 		}
3981da177e4SLinus Torvalds 
3990ae051a1SDmitry Torokhov 		if (!atkbd->emul)
4000ae051a1SDmitry Torokhov 			atkbd_calculate_xl_bit(atkbd, data);
4011da177e4SLinus Torvalds 	}
4021da177e4SLinus Torvalds 
4031da177e4SLinus Torvalds 	switch (code) {
4041da177e4SLinus Torvalds 		case ATKBD_RET_BAT:
4051da177e4SLinus Torvalds 			atkbd->enabled = 0;
406dbc26344SDmitry Torokhov 			serio_reconnect(atkbd->ps2dev.serio);
4071da177e4SLinus Torvalds 			goto out;
4081da177e4SLinus Torvalds 		case ATKBD_RET_EMUL0:
4091da177e4SLinus Torvalds 			atkbd->emul = 1;
4101da177e4SLinus Torvalds 			goto out;
4111da177e4SLinus Torvalds 		case ATKBD_RET_EMUL1:
4121da177e4SLinus Torvalds 			atkbd->emul = 2;
4131da177e4SLinus Torvalds 			goto out;
4141da177e4SLinus Torvalds 		case ATKBD_RET_RELEASE:
4151da177e4SLinus Torvalds 			atkbd->release = 1;
4161da177e4SLinus Torvalds 			goto out;
4170ae051a1SDmitry Torokhov 		case ATKBD_RET_ACK:
4180ae051a1SDmitry Torokhov 		case ATKBD_RET_NAK:
4199f7a60d6SQi Yong 			if (printk_ratelimit())
4200ae051a1SDmitry Torokhov 				printk(KERN_WARNING "atkbd.c: Spurious %s on %s. "
4210ae051a1SDmitry Torokhov 				       "Some program might be trying access hardware directly.\n",
4220ae051a1SDmitry Torokhov 				       data == ATKBD_RET_ACK ? "ACK" : "NAK", serio->phys);
4230ae051a1SDmitry Torokhov 			goto out;
4241da177e4SLinus Torvalds 		case ATKBD_RET_ERR:
42586255d9dSDmitry Torokhov 			atkbd->err_count++;
42686255d9dSDmitry Torokhov #ifdef ATKBD_DEBUG
4271da177e4SLinus Torvalds 			printk(KERN_DEBUG "atkbd.c: Keyboard on %s reports too many keys pressed.\n", serio->phys);
42886255d9dSDmitry Torokhov #endif
4291da177e4SLinus Torvalds 			goto out;
4301da177e4SLinus Torvalds 	}
4311da177e4SLinus Torvalds 
4320ae051a1SDmitry Torokhov 	code = atkbd_compat_scancode(atkbd, code);
4330ae051a1SDmitry Torokhov 
4340ae051a1SDmitry Torokhov 	if (atkbd->emul && --atkbd->emul)
4351da177e4SLinus Torvalds 		goto out;
4361da177e4SLinus Torvalds 
4370ae051a1SDmitry Torokhov 	keycode = atkbd->keycode[code];
4381da177e4SLinus Torvalds 
4390ae051a1SDmitry Torokhov 	if (keycode != ATKBD_KEY_NULL)
4400ae051a1SDmitry Torokhov 		input_event(dev, EV_MSC, MSC_SCAN, code);
4410ae051a1SDmitry Torokhov 
4420ae051a1SDmitry Torokhov 	switch (keycode) {
4431da177e4SLinus Torvalds 		case ATKBD_KEY_NULL:
4441da177e4SLinus Torvalds 			break;
4451da177e4SLinus Torvalds 		case ATKBD_KEY_UNKNOWN:
4460ae051a1SDmitry Torokhov 			printk(KERN_WARNING
4470ae051a1SDmitry Torokhov 			       "atkbd.c: Unknown key %s (%s set %d, code %#x on %s).\n",
4481da177e4SLinus Torvalds 			       atkbd->release ? "released" : "pressed",
4491da177e4SLinus Torvalds 			       atkbd->translated ? "translated" : "raw",
4501da177e4SLinus Torvalds 			       atkbd->set, code, serio->phys);
4510ae051a1SDmitry Torokhov 			printk(KERN_WARNING
4520ae051a1SDmitry Torokhov 			       "atkbd.c: Use 'setkeycodes %s%02x <keycode>' to make it known.\n",
4531da177e4SLinus Torvalds 			       code & 0x80 ? "e0" : "", code & 0x7f);
4540ae051a1SDmitry Torokhov 			input_sync(dev);
4551da177e4SLinus Torvalds 			break;
4561da177e4SLinus Torvalds 		case ATKBD_SCR_1:
4571da177e4SLinus Torvalds 			scroll = 1 - atkbd->release * 2;
4581da177e4SLinus Torvalds 			break;
4591da177e4SLinus Torvalds 		case ATKBD_SCR_2:
4601da177e4SLinus Torvalds 			scroll = 2 - atkbd->release * 4;
4611da177e4SLinus Torvalds 			break;
4621da177e4SLinus Torvalds 		case ATKBD_SCR_4:
4631da177e4SLinus Torvalds 			scroll = 4 - atkbd->release * 8;
4641da177e4SLinus Torvalds 			break;
4651da177e4SLinus Torvalds 		case ATKBD_SCR_8:
4661da177e4SLinus Torvalds 			scroll = 8 - atkbd->release * 16;
4671da177e4SLinus Torvalds 			break;
4681da177e4SLinus Torvalds 		case ATKBD_SCR_CLICK:
4691da177e4SLinus Torvalds 			click = !atkbd->release;
4701da177e4SLinus Torvalds 			break;
4711da177e4SLinus Torvalds 		case ATKBD_SCR_LEFT:
4721da177e4SLinus Torvalds 			hscroll = -1;
4731da177e4SLinus Torvalds 			break;
4741da177e4SLinus Torvalds 		case ATKBD_SCR_RIGHT:
4751da177e4SLinus Torvalds 			hscroll = 1;
4761da177e4SLinus Torvalds 			break;
4771da177e4SLinus Torvalds 		default:
4780ae051a1SDmitry Torokhov 			if (atkbd->release) {
4790ae051a1SDmitry Torokhov 				value = 0;
4801da177e4SLinus Torvalds 				atkbd->last = 0;
4810ae051a1SDmitry Torokhov 			} else if (!atkbd->softrepeat && test_bit(keycode, dev->key)) {
4820ae051a1SDmitry Torokhov 				/* Workaround Toshiba laptop multiple keypress */
4830ae051a1SDmitry Torokhov 				value = time_before(jiffies, atkbd->time) && atkbd->last == code ? 1 : 2;
4840ae051a1SDmitry Torokhov 			} else {
4851da177e4SLinus Torvalds 				value = 1;
4860ae051a1SDmitry Torokhov 				atkbd->last = code;
4870ae051a1SDmitry Torokhov 				atkbd->time = jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]) / 2;
4881da177e4SLinus Torvalds 			}
4891da177e4SLinus Torvalds 
490f8b4c46cSDmitry Torokhov 			input_event(dev, EV_KEY, keycode, value);
4910ae051a1SDmitry Torokhov 			input_sync(dev);
4920ae051a1SDmitry Torokhov 
493554101e3SGiel de Nijs 			if (value && test_bit(code, atkbd->force_release_mask)) {
4940ae051a1SDmitry Torokhov 				input_report_key(dev, keycode, 0);
4950ae051a1SDmitry Torokhov 				input_sync(dev);
4960ae051a1SDmitry Torokhov 			}
4971da177e4SLinus Torvalds 	}
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds 	if (atkbd->scroll) {
5001da177e4SLinus Torvalds 		if (click != -1)
5010ae051a1SDmitry Torokhov 			input_report_key(dev, BTN_MIDDLE, click);
5020ae051a1SDmitry Torokhov 		input_report_rel(dev, REL_WHEEL, scroll);
5030ae051a1SDmitry Torokhov 		input_report_rel(dev, REL_HWHEEL, hscroll);
5040ae051a1SDmitry Torokhov 		input_sync(dev);
5051da177e4SLinus Torvalds 	}
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds 	atkbd->release = 0;
5081da177e4SLinus Torvalds out:
5091da177e4SLinus Torvalds 	return IRQ_HANDLED;
5101da177e4SLinus Torvalds }
5111da177e4SLinus Torvalds 
5123d0f0fa0SDmitry Torokhov static int atkbd_set_repeat_rate(struct atkbd *atkbd)
5131da177e4SLinus Torvalds {
5141da177e4SLinus Torvalds 	const short period[32] =
5151da177e4SLinus Torvalds 		{ 33,  37,  42,  46,  50,  54,  58,  63,  67,  75,  83,  92, 100, 109, 116, 125,
5161da177e4SLinus Torvalds 		 133, 149, 167, 182, 200, 217, 232, 250, 270, 303, 333, 370, 400, 435, 470, 500 };
5171da177e4SLinus Torvalds 	const short delay[4] =
5181da177e4SLinus Torvalds 		{ 250, 500, 750, 1000 };
5190d4c8597SDmitry Torokhov 
5203d0f0fa0SDmitry Torokhov 	struct input_dev *dev = atkbd->dev;
5213d0f0fa0SDmitry Torokhov 	unsigned char param;
5223d0f0fa0SDmitry Torokhov 	int i = 0, j = 0;
5233d0f0fa0SDmitry Torokhov 
5243d0f0fa0SDmitry Torokhov 	while (i < ARRAY_SIZE(period) - 1 && period[i] < dev->rep[REP_PERIOD])
5253d0f0fa0SDmitry Torokhov 		i++;
5263d0f0fa0SDmitry Torokhov 	dev->rep[REP_PERIOD] = period[i];
5273d0f0fa0SDmitry Torokhov 
5288ea371fbSFlorin Malita 	while (j < ARRAY_SIZE(delay) - 1 && delay[j] < dev->rep[REP_DELAY])
5293d0f0fa0SDmitry Torokhov 		j++;
5303d0f0fa0SDmitry Torokhov 	dev->rep[REP_DELAY] = delay[j];
5313d0f0fa0SDmitry Torokhov 
5323d0f0fa0SDmitry Torokhov 	param = i | (j << 5);
5333d0f0fa0SDmitry Torokhov 	return ps2_command(&atkbd->ps2dev, &param, ATKBD_CMD_SETREP);
5343d0f0fa0SDmitry Torokhov }
5353d0f0fa0SDmitry Torokhov 
5363d0f0fa0SDmitry Torokhov static int atkbd_set_leds(struct atkbd *atkbd)
5373d0f0fa0SDmitry Torokhov {
5380d4c8597SDmitry Torokhov 	struct input_dev *dev = atkbd->dev;
5391da177e4SLinus Torvalds 	unsigned char param[2];
5401da177e4SLinus Torvalds 
5411da177e4SLinus Torvalds 	param[0] = (test_bit(LED_SCROLLL, dev->led) ? 1 : 0)
5421da177e4SLinus Torvalds 		 | (test_bit(LED_NUML,    dev->led) ? 2 : 0)
5431da177e4SLinus Torvalds 		 | (test_bit(LED_CAPSL,   dev->led) ? 4 : 0);
5443d0f0fa0SDmitry Torokhov 	if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))
5453d0f0fa0SDmitry Torokhov 		return -1;
5461da177e4SLinus Torvalds 
5471da177e4SLinus Torvalds 	if (atkbd->extra) {
5481da177e4SLinus Torvalds 		param[0] = 0;
5491da177e4SLinus Torvalds 		param[1] = (test_bit(LED_COMPOSE, dev->led) ? 0x01 : 0)
5501da177e4SLinus Torvalds 			 | (test_bit(LED_SLEEP,   dev->led) ? 0x02 : 0)
5511da177e4SLinus Torvalds 			 | (test_bit(LED_SUSPEND, dev->led) ? 0x04 : 0)
5521da177e4SLinus Torvalds 			 | (test_bit(LED_MISC,    dev->led) ? 0x10 : 0)
5531da177e4SLinus Torvalds 			 | (test_bit(LED_MUTE,    dev->led) ? 0x20 : 0);
5543d0f0fa0SDmitry Torokhov 		if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_EX_SETLEDS))
5553d0f0fa0SDmitry Torokhov 			return -1;
5561da177e4SLinus Torvalds 	}
5571da177e4SLinus Torvalds 
5583d0f0fa0SDmitry Torokhov 	return 0;
5590d4c8597SDmitry Torokhov }
5600d4c8597SDmitry Torokhov 
5613d0f0fa0SDmitry Torokhov /*
5623d0f0fa0SDmitry Torokhov  * atkbd_event_work() is used to complete processing of events that
5633d0f0fa0SDmitry Torokhov  * can not be processed by input_event() which is often called from
5643d0f0fa0SDmitry Torokhov  * interrupt context.
5653d0f0fa0SDmitry Torokhov  */
5663d0f0fa0SDmitry Torokhov 
56765f27f38SDavid Howells static void atkbd_event_work(struct work_struct *work)
5683d0f0fa0SDmitry Torokhov {
569da4249c9SDmitry Torokhov 	struct atkbd *atkbd = container_of(work, struct atkbd, event_work.work);
5703d0f0fa0SDmitry Torokhov 
5713d0f0fa0SDmitry Torokhov 	mutex_lock(&atkbd->event_mutex);
5723d0f0fa0SDmitry Torokhov 
5733d0f0fa0SDmitry Torokhov 	if (test_and_clear_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask))
5743d0f0fa0SDmitry Torokhov 		atkbd_set_leds(atkbd);
5753d0f0fa0SDmitry Torokhov 
5763d0f0fa0SDmitry Torokhov 	if (test_and_clear_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask))
5773d0f0fa0SDmitry Torokhov 		atkbd_set_repeat_rate(atkbd);
5783d0f0fa0SDmitry Torokhov 
57933d3f07aSIngo Molnar 	mutex_unlock(&atkbd->event_mutex);
5800d4c8597SDmitry Torokhov }
5810d4c8597SDmitry Torokhov 
5820d4c8597SDmitry Torokhov /*
583da4249c9SDmitry Torokhov  * Schedule switch for execution. We need to throttle requests,
584da4249c9SDmitry Torokhov  * otherwise keyboard may become unresponsive.
585da4249c9SDmitry Torokhov  */
586da4249c9SDmitry Torokhov static void atkbd_schedule_event_work(struct atkbd *atkbd, int event_bit)
587da4249c9SDmitry Torokhov {
588da4249c9SDmitry Torokhov 	unsigned long delay = msecs_to_jiffies(50);
589da4249c9SDmitry Torokhov 
590da4249c9SDmitry Torokhov 	if (time_after(jiffies, atkbd->event_jiffies + delay))
591da4249c9SDmitry Torokhov 		delay = 0;
592da4249c9SDmitry Torokhov 
593da4249c9SDmitry Torokhov 	atkbd->event_jiffies = jiffies;
594da4249c9SDmitry Torokhov 	set_bit(event_bit, &atkbd->event_mask);
595da4249c9SDmitry Torokhov 	wmb();
596da4249c9SDmitry Torokhov 	schedule_delayed_work(&atkbd->event_work, delay);
597da4249c9SDmitry Torokhov }
598da4249c9SDmitry Torokhov 
599da4249c9SDmitry Torokhov /*
6000d4c8597SDmitry Torokhov  * Event callback from the input module. Events that change the state of
6010d4c8597SDmitry Torokhov  * the hardware are processed here. If action can not be performed in
6020d4c8597SDmitry Torokhov  * interrupt context it is offloaded to atkbd_event_work.
6030d4c8597SDmitry Torokhov  */
6040d4c8597SDmitry Torokhov 
605da4249c9SDmitry Torokhov static int atkbd_event(struct input_dev *dev,
606da4249c9SDmitry Torokhov 			unsigned int type, unsigned int code, int value)
6070d4c8597SDmitry Torokhov {
608b356872fSDmitry Torokhov 	struct atkbd *atkbd = input_get_drvdata(dev);
6090d4c8597SDmitry Torokhov 
6100d4c8597SDmitry Torokhov 	if (!atkbd->write)
6110d4c8597SDmitry Torokhov 		return -1;
6120d4c8597SDmitry Torokhov 
6130d4c8597SDmitry Torokhov 	switch (type) {
6140d4c8597SDmitry Torokhov 
6150d4c8597SDmitry Torokhov 		case EV_LED:
616da4249c9SDmitry Torokhov 			atkbd_schedule_event_work(atkbd, ATKBD_LED_EVENT_BIT);
6170d4c8597SDmitry Torokhov 			return 0;
6180d4c8597SDmitry Torokhov 
6190d4c8597SDmitry Torokhov 		case EV_REP:
620da4249c9SDmitry Torokhov 			if (!atkbd->softrepeat)
621da4249c9SDmitry Torokhov 				atkbd_schedule_event_work(atkbd, ATKBD_REP_EVENT_BIT);
6221da177e4SLinus Torvalds 			return 0;
6231da177e4SLinus Torvalds 	}
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds 	return -1;
6261da177e4SLinus Torvalds }
6271da177e4SLinus Torvalds 
6281da177e4SLinus Torvalds /*
6291da177e4SLinus Torvalds  * atkbd_enable() signals that interrupt handler is allowed to
6301da177e4SLinus Torvalds  * generate input events.
6311da177e4SLinus Torvalds  */
6321da177e4SLinus Torvalds 
6331da177e4SLinus Torvalds static inline void atkbd_enable(struct atkbd *atkbd)
6341da177e4SLinus Torvalds {
6351da177e4SLinus Torvalds 	serio_pause_rx(atkbd->ps2dev.serio);
6361da177e4SLinus Torvalds 	atkbd->enabled = 1;
6371da177e4SLinus Torvalds 	serio_continue_rx(atkbd->ps2dev.serio);
6381da177e4SLinus Torvalds }
6391da177e4SLinus Torvalds 
6401da177e4SLinus Torvalds /*
6411da177e4SLinus Torvalds  * atkbd_disable() tells input handler that all incoming data except
6421da177e4SLinus Torvalds  * for ACKs and command response should be dropped.
6431da177e4SLinus Torvalds  */
6441da177e4SLinus Torvalds 
6451da177e4SLinus Torvalds static inline void atkbd_disable(struct atkbd *atkbd)
6461da177e4SLinus Torvalds {
6471da177e4SLinus Torvalds 	serio_pause_rx(atkbd->ps2dev.serio);
6481da177e4SLinus Torvalds 	atkbd->enabled = 0;
6491da177e4SLinus Torvalds 	serio_continue_rx(atkbd->ps2dev.serio);
6501da177e4SLinus Torvalds }
6511da177e4SLinus Torvalds 
6521da177e4SLinus Torvalds /*
6531da177e4SLinus Torvalds  * atkbd_probe() probes for an AT keyboard on a serio port.
6541da177e4SLinus Torvalds  */
6551da177e4SLinus Torvalds 
6561da177e4SLinus Torvalds static int atkbd_probe(struct atkbd *atkbd)
6571da177e4SLinus Torvalds {
6581da177e4SLinus Torvalds 	struct ps2dev *ps2dev = &atkbd->ps2dev;
6591da177e4SLinus Torvalds 	unsigned char param[2];
6601da177e4SLinus Torvalds 
6611da177e4SLinus Torvalds /*
6621da177e4SLinus Torvalds  * Some systems, where the bit-twiddling when testing the io-lines of the
6631da177e4SLinus Torvalds  * controller may confuse the keyboard need a full reset of the keyboard. On
6641da177e4SLinus Torvalds  * these systems the BIOS also usually doesn't do it for us.
6651da177e4SLinus Torvalds  */
6661da177e4SLinus Torvalds 
6671da177e4SLinus Torvalds 	if (atkbd_reset)
6681da177e4SLinus Torvalds 		if (ps2_command(ps2dev, NULL, ATKBD_CMD_RESET_BAT))
6691da177e4SLinus Torvalds 			printk(KERN_WARNING "atkbd.c: keyboard reset failed on %s\n", ps2dev->serio->phys);
6701da177e4SLinus Torvalds 
6711da177e4SLinus Torvalds /*
6721da177e4SLinus Torvalds  * Then we check the keyboard ID. We should get 0xab83 under normal conditions.
6731da177e4SLinus Torvalds  * Some keyboards report different values, but the first byte is always 0xab or
6741da177e4SLinus Torvalds  * 0xac. Some old AT keyboards don't report anything. If a mouse is connected, this
6751da177e4SLinus Torvalds  * should make sure we don't try to set the LEDs on it.
6761da177e4SLinus Torvalds  */
6771da177e4SLinus Torvalds 
6781da177e4SLinus Torvalds 	param[0] = param[1] = 0xa5;	/* initialize with invalid values */
6791da177e4SLinus Torvalds 	if (ps2_command(ps2dev, param, ATKBD_CMD_GETID)) {
6801da177e4SLinus Torvalds 
6811da177e4SLinus Torvalds /*
6821da177e4SLinus Torvalds  * If the get ID command failed, we check if we can at least set the LEDs on
6831da177e4SLinus Torvalds  * the keyboard. This should work on every keyboard out there. It also turns
6841da177e4SLinus Torvalds  * the LEDs off, which we want anyway.
6851da177e4SLinus Torvalds  */
6861da177e4SLinus Torvalds 		param[0] = 0;
6871da177e4SLinus Torvalds 		if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
6881da177e4SLinus Torvalds 			return -1;
6891da177e4SLinus Torvalds 		atkbd->id = 0xabba;
6901da177e4SLinus Torvalds 		return 0;
6911da177e4SLinus Torvalds 	}
6921da177e4SLinus Torvalds 
6939807879bSDmitry Torokhov 	if (!ps2_is_keyboard_id(param[0]))
6941da177e4SLinus Torvalds 		return -1;
6951da177e4SLinus Torvalds 
6961da177e4SLinus Torvalds 	atkbd->id = (param[0] << 8) | param[1];
6971da177e4SLinus Torvalds 
6981da177e4SLinus Torvalds 	if (atkbd->id == 0xaca1 && atkbd->translated) {
6991da177e4SLinus Torvalds 		printk(KERN_ERR "atkbd.c: NCD terminal keyboards are only supported on non-translating\n");
7001da177e4SLinus Torvalds 		printk(KERN_ERR "atkbd.c: controllers. Use i8042.direct=1 to disable translation.\n");
7011da177e4SLinus Torvalds 		return -1;
7021da177e4SLinus Torvalds 	}
7031da177e4SLinus Torvalds 
7041da177e4SLinus Torvalds 	return 0;
7051da177e4SLinus Torvalds }
7061da177e4SLinus Torvalds 
7071da177e4SLinus Torvalds /*
7081da177e4SLinus Torvalds  * atkbd_select_set checks if a keyboard has a working Set 3 support, and
7091da177e4SLinus Torvalds  * sets it into that. Unfortunately there are keyboards that can be switched
7101da177e4SLinus Torvalds  * to Set 3, but don't work well in that (BTC Multimedia ...)
7111da177e4SLinus Torvalds  */
7121da177e4SLinus Torvalds 
7131da177e4SLinus Torvalds static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra)
7141da177e4SLinus Torvalds {
7151da177e4SLinus Torvalds 	struct ps2dev *ps2dev = &atkbd->ps2dev;
7161da177e4SLinus Torvalds 	unsigned char param[2];
7171da177e4SLinus Torvalds 
7181da177e4SLinus Torvalds 	atkbd->extra = 0;
7191da177e4SLinus Torvalds /*
7201da177e4SLinus Torvalds  * For known special keyboards we can go ahead and set the correct set.
7211da177e4SLinus Torvalds  * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and
7221da177e4SLinus Torvalds  * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards.
7231da177e4SLinus Torvalds  */
7241da177e4SLinus Torvalds 
7251da177e4SLinus Torvalds 	if (atkbd->translated)
7261da177e4SLinus Torvalds 		return 2;
7271da177e4SLinus Torvalds 
7281da177e4SLinus Torvalds 	if (atkbd->id == 0xaca1) {
7291da177e4SLinus Torvalds 		param[0] = 3;
7301da177e4SLinus Torvalds 		ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);
7311da177e4SLinus Torvalds 		return 3;
7321da177e4SLinus Torvalds 	}
7331da177e4SLinus Torvalds 
7341da177e4SLinus Torvalds 	if (allow_extra) {
7351da177e4SLinus Torvalds 		param[0] = 0x71;
7361da177e4SLinus Torvalds 		if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {
7371da177e4SLinus Torvalds 			atkbd->extra = 1;
7381da177e4SLinus Torvalds 			return 2;
7391da177e4SLinus Torvalds 		}
7401da177e4SLinus Torvalds 	}
7411da177e4SLinus Torvalds 
7421da177e4SLinus Torvalds 	if (target_set != 3)
7431da177e4SLinus Torvalds 		return 2;
7441da177e4SLinus Torvalds 
7451da177e4SLinus Torvalds 	if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {
7461da177e4SLinus Torvalds 		atkbd->id = param[0] << 8 | param[1];
7471da177e4SLinus Torvalds 		return 2;
7481da177e4SLinus Torvalds 	}
7491da177e4SLinus Torvalds 
7501da177e4SLinus Torvalds 	param[0] = 3;
7511da177e4SLinus Torvalds 	if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
7521da177e4SLinus Torvalds 		return 2;
7531da177e4SLinus Torvalds 
7541da177e4SLinus Torvalds 	param[0] = 0;
7551da177e4SLinus Torvalds 	if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))
7561da177e4SLinus Torvalds 		return 2;
7571da177e4SLinus Torvalds 
7581da177e4SLinus Torvalds 	if (param[0] != 3) {
7591da177e4SLinus Torvalds 		param[0] = 2;
7601da177e4SLinus Torvalds 		if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
7611da177e4SLinus Torvalds 		return 2;
7621da177e4SLinus Torvalds 	}
7631da177e4SLinus Torvalds 
7641da177e4SLinus Torvalds 	ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);
7651da177e4SLinus Torvalds 
7661da177e4SLinus Torvalds 	return 3;
7671da177e4SLinus Torvalds }
7681da177e4SLinus Torvalds 
7691da177e4SLinus Torvalds static int atkbd_activate(struct atkbd *atkbd)
7701da177e4SLinus Torvalds {
7711da177e4SLinus Torvalds 	struct ps2dev *ps2dev = &atkbd->ps2dev;
7721da177e4SLinus Torvalds 	unsigned char param[1];
7731da177e4SLinus Torvalds 
7741da177e4SLinus Torvalds /*
7751da177e4SLinus Torvalds  * Set the LEDs to a defined state.
7761da177e4SLinus Torvalds  */
7771da177e4SLinus Torvalds 
7781da177e4SLinus Torvalds 	param[0] = 0;
7791da177e4SLinus Torvalds 	if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
7801da177e4SLinus Torvalds 		return -1;
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds /*
7831da177e4SLinus Torvalds  * Set autorepeat to fastest possible.
7841da177e4SLinus Torvalds  */
7851da177e4SLinus Torvalds 
7861da177e4SLinus Torvalds 	param[0] = 0;
7871da177e4SLinus Torvalds 	if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
7881da177e4SLinus Torvalds 		return -1;
7891da177e4SLinus Torvalds 
7901da177e4SLinus Torvalds /*
7911da177e4SLinus Torvalds  * Enable the keyboard to receive keystrokes.
7921da177e4SLinus Torvalds  */
7931da177e4SLinus Torvalds 
7941da177e4SLinus Torvalds 	if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {
7951da177e4SLinus Torvalds 		printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",
7961da177e4SLinus Torvalds 			ps2dev->serio->phys);
7971da177e4SLinus Torvalds 		return -1;
7981da177e4SLinus Torvalds 	}
7991da177e4SLinus Torvalds 
8001da177e4SLinus Torvalds 	return 0;
8011da177e4SLinus Torvalds }
8021da177e4SLinus Torvalds 
8031da177e4SLinus Torvalds /*
8041da177e4SLinus Torvalds  * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a
8051da177e4SLinus Torvalds  * reboot.
8061da177e4SLinus Torvalds  */
8071da177e4SLinus Torvalds 
8081da177e4SLinus Torvalds static void atkbd_cleanup(struct serio *serio)
8091da177e4SLinus Torvalds {
8101da177e4SLinus Torvalds 	struct atkbd *atkbd = serio_get_drvdata(serio);
81157f5b159SDmitry Torokhov 
81257f5b159SDmitry Torokhov 	atkbd_disable(atkbd);
8131da177e4SLinus Torvalds 	ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);
8141da177e4SLinus Torvalds }
8151da177e4SLinus Torvalds 
8161da177e4SLinus Torvalds 
8171da177e4SLinus Torvalds /*
8181da177e4SLinus Torvalds  * atkbd_disconnect() closes and frees.
8191da177e4SLinus Torvalds  */
8201da177e4SLinus Torvalds 
8211da177e4SLinus Torvalds static void atkbd_disconnect(struct serio *serio)
8221da177e4SLinus Torvalds {
8231da177e4SLinus Torvalds 	struct atkbd *atkbd = serio_get_drvdata(serio);
8241da177e4SLinus Torvalds 
8251da177e4SLinus Torvalds 	atkbd_disable(atkbd);
8261da177e4SLinus Torvalds 
8271da177e4SLinus Torvalds 	/* make sure we don't have a command in flight */
828d6d79a78SJiri Pirko 	cancel_delayed_work_sync(&atkbd->event_work);
8291da177e4SLinus Torvalds 
83086255d9dSDmitry Torokhov 	sysfs_remove_group(&serio->dev.kobj, &atkbd_attribute_group);
8313c42f0c3SDmitry Torokhov 	input_unregister_device(atkbd->dev);
8321da177e4SLinus Torvalds 	serio_close(serio);
8331da177e4SLinus Torvalds 	serio_set_drvdata(serio, NULL);
8341da177e4SLinus Torvalds 	kfree(atkbd);
8351da177e4SLinus Torvalds }
8361da177e4SLinus Torvalds 
837554101e3SGiel de Nijs /*
83839191698SDaniel Mierswa  * generate release events for the keycodes given in data
83939191698SDaniel Mierswa  */
84039191698SDaniel Mierswa static void atkbd_apply_forced_release_keylist(struct atkbd* atkbd,
84139191698SDaniel Mierswa 						const void *data)
84239191698SDaniel Mierswa {
84339191698SDaniel Mierswa 	const unsigned int *keys = data;
84439191698SDaniel Mierswa 	unsigned int i;
84539191698SDaniel Mierswa 
84639191698SDaniel Mierswa 	if (atkbd->set == 2)
84739191698SDaniel Mierswa 		for (i = 0; keys[i] != -1U; i++)
84839191698SDaniel Mierswa 			__set_bit(keys[i], atkbd->force_release_mask);
84939191698SDaniel Mierswa }
85039191698SDaniel Mierswa 
85139191698SDaniel Mierswa /*
85261579ba8SMatthew Garrett  * Most special keys (Fn+F?) on Dell laptops do not generate release
853554101e3SGiel de Nijs  * events so we have to do it ourselves.
854554101e3SGiel de Nijs  */
85539191698SDaniel Mierswa static unsigned int atkbd_dell_laptop_forced_release_keys[] = {
85639191698SDaniel Mierswa 	0x85, 0x86, 0x87, 0x88, 0x89, 0x8a, 0x8b, 0x8f, 0x93, -1U
857554101e3SGiel de Nijs };
8581da177e4SLinus Torvalds 
8591da177e4SLinus Torvalds /*
8605a54c011SJiri Kosina  * Perform fixup for HP system that doesn't generate release
8615a54c011SJiri Kosina  * for its video switch
8625a54c011SJiri Kosina  */
86339191698SDaniel Mierswa static unsigned int atkbd_hp_forced_release_keys[] = {
86439191698SDaniel Mierswa 	0x94, -1U
8655a54c011SJiri Kosina };
8665a54c011SJiri Kosina 
8675a54c011SJiri Kosina /*
868a8215b81SMatthew Garrett  * Inventec system with broken key release on volume keys
869a8215b81SMatthew Garrett  */
87039191698SDaniel Mierswa static unsigned int atkbd_inventec_forced_release_keys[] = {
87139191698SDaniel Mierswa 	0xae, 0xb0, -1U
872a8215b81SMatthew Garrett };
873a8215b81SMatthew Garrett 
874a8215b81SMatthew Garrett /*
875181f6382SRikard Ljungstrand  * Perform fixup for HP Pavilion ZV6100 laptop that doesn't generate release
876181f6382SRikard Ljungstrand  * for its volume buttons
877181f6382SRikard Ljungstrand  */
87839191698SDaniel Mierswa static unsigned int atkbd_hp_zv6100_forced_release_keys[] = {
87939191698SDaniel Mierswa 	0xae, 0xb0, -1U
880181f6382SRikard Ljungstrand };
881181f6382SRikard Ljungstrand 
882181f6382SRikard Ljungstrand /*
8834200844bSStuart Hopkins  * Samsung NC10 with Fn+F? key release not working
8844200844bSStuart Hopkins  */
88539191698SDaniel Mierswa static unsigned int atkbd_samsung_forced_release_keys[] = {
88639191698SDaniel Mierswa 	0x82, 0x83, 0x84, 0x86, 0x88, 0x89, 0xb3, 0xf7, 0xf9, -1U
8874200844bSStuart Hopkins };
8884200844bSStuart Hopkins 
8894200844bSStuart Hopkins /*
890*adcb523eSDaniel Mierswa  * The volume up and volume down special keys on a Fujitsu Amilo PA 1510 laptop
891*adcb523eSDaniel Mierswa  * do not generate release events so we have to do it ourselves.
892*adcb523eSDaniel Mierswa  */
893*adcb523eSDaniel Mierswa static unsigned int atkbd_amilo_pa1510_forced_release_keys[] = {
894*adcb523eSDaniel Mierswa 	0xb0, 0xae, -1U
895*adcb523eSDaniel Mierswa };
896*adcb523eSDaniel Mierswa 
897*adcb523eSDaniel Mierswa /*
8983c42f0c3SDmitry Torokhov  * atkbd_set_keycode_table() initializes keyboard's keycode table
8991da177e4SLinus Torvalds  * according to the selected scancode set
9001da177e4SLinus Torvalds  */
9011da177e4SLinus Torvalds 
9021da177e4SLinus Torvalds static void atkbd_set_keycode_table(struct atkbd *atkbd)
9031da177e4SLinus Torvalds {
904554101e3SGiel de Nijs 	unsigned int scancode;
9051da177e4SLinus Torvalds 	int i, j;
9061da177e4SLinus Torvalds 
9071da177e4SLinus Torvalds 	memset(atkbd->keycode, 0, sizeof(atkbd->keycode));
908554101e3SGiel de Nijs 	bitmap_zero(atkbd->force_release_mask, 512);
9091da177e4SLinus Torvalds 
9101da177e4SLinus Torvalds 	if (atkbd->translated) {
9111da177e4SLinus Torvalds 		for (i = 0; i < 128; i++) {
912554101e3SGiel de Nijs 			scancode = atkbd_unxlate_table[i];
913554101e3SGiel de Nijs 			atkbd->keycode[i] = atkbd_set2_keycode[scancode];
914554101e3SGiel de Nijs 			atkbd->keycode[i | 0x80] = atkbd_set2_keycode[scancode | 0x80];
9151da177e4SLinus Torvalds 			if (atkbd->scroll)
9161da177e4SLinus Torvalds 				for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)
917554101e3SGiel de Nijs 					if ((scancode | 0x80) == atkbd_scroll_keys[j].set2)
9181da177e4SLinus Torvalds 						atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;
9191da177e4SLinus Torvalds 		}
9201da177e4SLinus Torvalds 	} else if (atkbd->set == 3) {
9211da177e4SLinus Torvalds 		memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));
9221da177e4SLinus Torvalds 	} else {
9231da177e4SLinus Torvalds 		memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));
9241da177e4SLinus Torvalds 
9251da177e4SLinus Torvalds 		if (atkbd->scroll)
926554101e3SGiel de Nijs 			for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++) {
927554101e3SGiel de Nijs 				scancode = atkbd_scroll_keys[i].set2;
928554101e3SGiel de Nijs 				atkbd->keycode[scancode] = atkbd_scroll_keys[i].keycode;
929554101e3SGiel de Nijs 		}
9301da177e4SLinus Torvalds 	}
9310ae051a1SDmitry Torokhov 
932554101e3SGiel de Nijs /*
933554101e3SGiel de Nijs  * HANGEUL and HANJA keys do not send release events so we need to
934554101e3SGiel de Nijs  * generate such events ourselves
935554101e3SGiel de Nijs  */
936554101e3SGiel de Nijs 	scancode = atkbd_compat_scancode(atkbd, ATKBD_RET_HANGEUL);
937554101e3SGiel de Nijs 	atkbd->keycode[scancode] = KEY_HANGEUL;
938554101e3SGiel de Nijs 	__set_bit(scancode, atkbd->force_release_mask);
939554101e3SGiel de Nijs 
940554101e3SGiel de Nijs 	scancode = atkbd_compat_scancode(atkbd, ATKBD_RET_HANJA);
941554101e3SGiel de Nijs 	atkbd->keycode[scancode] = KEY_HANJA;
942554101e3SGiel de Nijs 	__set_bit(scancode, atkbd->force_release_mask);
943554101e3SGiel de Nijs 
944554101e3SGiel de Nijs /*
945554101e3SGiel de Nijs  * Perform additional fixups
946554101e3SGiel de Nijs  */
947554101e3SGiel de Nijs 	if (atkbd_platform_fixup)
94839191698SDaniel Mierswa 		atkbd_platform_fixup(atkbd, atkbd_platform_fixup_data);
9491da177e4SLinus Torvalds }
9501da177e4SLinus Torvalds 
9511da177e4SLinus Torvalds /*
9521da177e4SLinus Torvalds  * atkbd_set_device_attrs() sets up keyboard's input device structure
9531da177e4SLinus Torvalds  */
9541da177e4SLinus Torvalds 
9551da177e4SLinus Torvalds static void atkbd_set_device_attrs(struct atkbd *atkbd)
9561da177e4SLinus Torvalds {
9573c42f0c3SDmitry Torokhov 	struct input_dev *input_dev = atkbd->dev;
9581da177e4SLinus Torvalds 	int i;
9591da177e4SLinus Torvalds 
9603c42f0c3SDmitry Torokhov 	if (atkbd->extra)
961ea08c6faSDmitry Torokhov 		snprintf(atkbd->name, sizeof(atkbd->name),
962ea08c6faSDmitry Torokhov 			 "AT Set 2 Extra keyboard");
9633c42f0c3SDmitry Torokhov 	else
964ea08c6faSDmitry Torokhov 		snprintf(atkbd->name, sizeof(atkbd->name),
965ea08c6faSDmitry Torokhov 			 "AT %s Set %d keyboard",
9663c42f0c3SDmitry Torokhov 			 atkbd->translated ? "Translated" : "Raw", atkbd->set);
9671da177e4SLinus Torvalds 
968ea08c6faSDmitry Torokhov 	snprintf(atkbd->phys, sizeof(atkbd->phys),
969ea08c6faSDmitry Torokhov 		 "%s/input0", atkbd->ps2dev.serio->phys);
9701da177e4SLinus Torvalds 
9713c42f0c3SDmitry Torokhov 	input_dev->name = atkbd->name;
9723c42f0c3SDmitry Torokhov 	input_dev->phys = atkbd->phys;
9733c42f0c3SDmitry Torokhov 	input_dev->id.bustype = BUS_I8042;
9743c42f0c3SDmitry Torokhov 	input_dev->id.vendor = 0x0001;
9753c42f0c3SDmitry Torokhov 	input_dev->id.product = atkbd->translated ? 1 : atkbd->set;
9763c42f0c3SDmitry Torokhov 	input_dev->id.version = atkbd->id;
9773c42f0c3SDmitry Torokhov 	input_dev->event = atkbd_event;
978469ba4dfSDmitry Torokhov 	input_dev->dev.parent = &atkbd->ps2dev.serio->dev;
9791da177e4SLinus Torvalds 
980b356872fSDmitry Torokhov 	input_set_drvdata(input_dev, atkbd);
981b356872fSDmitry Torokhov 
9827b19ada2SJiri Slaby 	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) |
9837b19ada2SJiri Slaby 		BIT_MASK(EV_MSC);
9841da177e4SLinus Torvalds 
9851da177e4SLinus Torvalds 	if (atkbd->write) {
9867b19ada2SJiri Slaby 		input_dev->evbit[0] |= BIT_MASK(EV_LED);
9877b19ada2SJiri Slaby 		input_dev->ledbit[0] = BIT_MASK(LED_NUML) |
9887b19ada2SJiri Slaby 			BIT_MASK(LED_CAPSL) | BIT_MASK(LED_SCROLLL);
9891da177e4SLinus Torvalds 	}
9901da177e4SLinus Torvalds 
9911da177e4SLinus Torvalds 	if (atkbd->extra)
9927b19ada2SJiri Slaby 		input_dev->ledbit[0] |= BIT_MASK(LED_COMPOSE) |
9937b19ada2SJiri Slaby 			BIT_MASK(LED_SUSPEND) | BIT_MASK(LED_SLEEP) |
9947b19ada2SJiri Slaby 			BIT_MASK(LED_MUTE) | BIT_MASK(LED_MISC);
9951da177e4SLinus Torvalds 
9961da177e4SLinus Torvalds 	if (!atkbd->softrepeat) {
9973c42f0c3SDmitry Torokhov 		input_dev->rep[REP_DELAY] = 250;
9983c42f0c3SDmitry Torokhov 		input_dev->rep[REP_PERIOD] = 33;
9991da177e4SLinus Torvalds 	}
10001da177e4SLinus Torvalds 
10017b19ada2SJiri Slaby 	input_dev->mscbit[0] = atkbd->softraw ? BIT_MASK(MSC_SCAN) :
10027b19ada2SJiri Slaby 		BIT_MASK(MSC_RAW) | BIT_MASK(MSC_SCAN);
10031da177e4SLinus Torvalds 
10041da177e4SLinus Torvalds 	if (atkbd->scroll) {
10057b19ada2SJiri Slaby 		input_dev->evbit[0] |= BIT_MASK(EV_REL);
10067b19ada2SJiri Slaby 		input_dev->relbit[0] = BIT_MASK(REL_WHEEL) |
10077b19ada2SJiri Slaby 			BIT_MASK(REL_HWHEEL);
1008f6d65610SDmitry Torokhov 		__set_bit(BTN_MIDDLE, input_dev->keybit);
10091da177e4SLinus Torvalds 	}
10101da177e4SLinus Torvalds 
10113c42f0c3SDmitry Torokhov 	input_dev->keycode = atkbd->keycode;
1012f6d65610SDmitry Torokhov 	input_dev->keycodesize = sizeof(unsigned short);
10133c42f0c3SDmitry Torokhov 	input_dev->keycodemax = ARRAY_SIZE(atkbd_set2_keycode);
10141da177e4SLinus Torvalds 
10151da177e4SLinus Torvalds 	for (i = 0; i < 512; i++)
10161da177e4SLinus Torvalds 		if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)
1017f6d65610SDmitry Torokhov 			__set_bit(atkbd->keycode[i], input_dev->keybit);
10181da177e4SLinus Torvalds }
10191da177e4SLinus Torvalds 
10201da177e4SLinus Torvalds /*
10211da177e4SLinus Torvalds  * atkbd_connect() is called when the serio module finds an interface
10221da177e4SLinus Torvalds  * that isn't handled yet by an appropriate device driver. We check if
10231da177e4SLinus Torvalds  * there is an AT keyboard out there and if yes, we register ourselves
10241da177e4SLinus Torvalds  * to the input module.
10251da177e4SLinus Torvalds  */
10261da177e4SLinus Torvalds 
10271da177e4SLinus Torvalds static int atkbd_connect(struct serio *serio, struct serio_driver *drv)
10281da177e4SLinus Torvalds {
10291da177e4SLinus Torvalds 	struct atkbd *atkbd;
10303c42f0c3SDmitry Torokhov 	struct input_dev *dev;
10313c42f0c3SDmitry Torokhov 	int err = -ENOMEM;
10321da177e4SLinus Torvalds 
10333c42f0c3SDmitry Torokhov 	atkbd = kzalloc(sizeof(struct atkbd), GFP_KERNEL);
10343c42f0c3SDmitry Torokhov 	dev = input_allocate_device();
10353c42f0c3SDmitry Torokhov 	if (!atkbd || !dev)
10362b03b60eSDmitry Torokhov 		goto fail1;
10371da177e4SLinus Torvalds 
10383c42f0c3SDmitry Torokhov 	atkbd->dev = dev;
10391da177e4SLinus Torvalds 	ps2_init(&atkbd->ps2dev, serio);
1040da4249c9SDmitry Torokhov 	INIT_DELAYED_WORK(&atkbd->event_work, atkbd_event_work);
104133d3f07aSIngo Molnar 	mutex_init(&atkbd->event_mutex);
10421da177e4SLinus Torvalds 
10431da177e4SLinus Torvalds 	switch (serio->id.type) {
10441da177e4SLinus Torvalds 
10451da177e4SLinus Torvalds 		case SERIO_8042_XL:
10461da177e4SLinus Torvalds 			atkbd->translated = 1;
10471da177e4SLinus Torvalds 		case SERIO_8042:
10481da177e4SLinus Torvalds 			if (serio->write)
10491da177e4SLinus Torvalds 				atkbd->write = 1;
10501da177e4SLinus Torvalds 			break;
10511da177e4SLinus Torvalds 	}
10521da177e4SLinus Torvalds 
10531da177e4SLinus Torvalds 	atkbd->softraw = atkbd_softraw;
10541da177e4SLinus Torvalds 	atkbd->softrepeat = atkbd_softrepeat;
10551da177e4SLinus Torvalds 	atkbd->scroll = atkbd_scroll;
10561da177e4SLinus Torvalds 
10571da177e4SLinus Torvalds 	if (atkbd->softrepeat)
10581da177e4SLinus Torvalds 		atkbd->softraw = 1;
10591da177e4SLinus Torvalds 
10601da177e4SLinus Torvalds 	serio_set_drvdata(serio, atkbd);
10611da177e4SLinus Torvalds 
10621da177e4SLinus Torvalds 	err = serio_open(serio, drv);
10633c42f0c3SDmitry Torokhov 	if (err)
10642b03b60eSDmitry Torokhov 		goto fail2;
10651da177e4SLinus Torvalds 
10661da177e4SLinus Torvalds 	if (atkbd->write) {
10671da177e4SLinus Torvalds 
10681da177e4SLinus Torvalds 		if (atkbd_probe(atkbd)) {
10693c42f0c3SDmitry Torokhov 			err = -ENODEV;
10702b03b60eSDmitry Torokhov 			goto fail3;
10711da177e4SLinus Torvalds 		}
10721da177e4SLinus Torvalds 
10731da177e4SLinus Torvalds 		atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);
10741da177e4SLinus Torvalds 		atkbd_activate(atkbd);
10751da177e4SLinus Torvalds 
10761da177e4SLinus Torvalds 	} else {
10771da177e4SLinus Torvalds 		atkbd->set = 2;
10781da177e4SLinus Torvalds 		atkbd->id = 0xab00;
10791da177e4SLinus Torvalds 	}
10801da177e4SLinus Torvalds 
10811da177e4SLinus Torvalds 	atkbd_set_keycode_table(atkbd);
10821da177e4SLinus Torvalds 	atkbd_set_device_attrs(atkbd);
10831da177e4SLinus Torvalds 
10842b03b60eSDmitry Torokhov 	err = sysfs_create_group(&serio->dev.kobj, &atkbd_attribute_group);
10852b03b60eSDmitry Torokhov 	if (err)
10862b03b60eSDmitry Torokhov 		goto fail3;
10871da177e4SLinus Torvalds 
10881da177e4SLinus Torvalds 	atkbd_enable(atkbd);
10891da177e4SLinus Torvalds 
10902b03b60eSDmitry Torokhov 	err = input_register_device(atkbd->dev);
10912b03b60eSDmitry Torokhov 	if (err)
10922b03b60eSDmitry Torokhov 		goto fail4;
10931da177e4SLinus Torvalds 
10941da177e4SLinus Torvalds 	return 0;
10953c42f0c3SDmitry Torokhov 
10962b03b60eSDmitry Torokhov  fail4: sysfs_remove_group(&serio->dev.kobj, &atkbd_attribute_group);
10972b03b60eSDmitry Torokhov  fail3:	serio_close(serio);
10982b03b60eSDmitry Torokhov  fail2:	serio_set_drvdata(serio, NULL);
10992b03b60eSDmitry Torokhov  fail1:	input_free_device(dev);
11003c42f0c3SDmitry Torokhov 	kfree(atkbd);
11013c42f0c3SDmitry Torokhov 	return err;
11021da177e4SLinus Torvalds }
11031da177e4SLinus Torvalds 
11041da177e4SLinus Torvalds /*
11051da177e4SLinus Torvalds  * atkbd_reconnect() tries to restore keyboard into a sane state and is
11061da177e4SLinus Torvalds  * most likely called on resume.
11071da177e4SLinus Torvalds  */
11081da177e4SLinus Torvalds 
11091da177e4SLinus Torvalds static int atkbd_reconnect(struct serio *serio)
11101da177e4SLinus Torvalds {
11111da177e4SLinus Torvalds 	struct atkbd *atkbd = serio_get_drvdata(serio);
11121da177e4SLinus Torvalds 	struct serio_driver *drv = serio->drv;
11131da177e4SLinus Torvalds 
11141da177e4SLinus Torvalds 	if (!atkbd || !drv) {
11151da177e4SLinus Torvalds 		printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");
11161da177e4SLinus Torvalds 		return -1;
11171da177e4SLinus Torvalds 	}
11181da177e4SLinus Torvalds 
11191da177e4SLinus Torvalds 	atkbd_disable(atkbd);
11201da177e4SLinus Torvalds 
11211da177e4SLinus Torvalds 	if (atkbd->write) {
11221da177e4SLinus Torvalds 		if (atkbd_probe(atkbd))
11231da177e4SLinus Torvalds 			return -1;
11241da177e4SLinus Torvalds 		if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))
11251da177e4SLinus Torvalds 			return -1;
11261da177e4SLinus Torvalds 
11271da177e4SLinus Torvalds 		atkbd_activate(atkbd);
11281da177e4SLinus Torvalds 
11293d0f0fa0SDmitry Torokhov /*
11303d0f0fa0SDmitry Torokhov  * Restore repeat rate and LEDs (that were reset by atkbd_activate)
11313d0f0fa0SDmitry Torokhov  * to pre-resume state
11323d0f0fa0SDmitry Torokhov  */
11333d0f0fa0SDmitry Torokhov 		if (!atkbd->softrepeat)
11343d0f0fa0SDmitry Torokhov 			atkbd_set_repeat_rate(atkbd);
11353d0f0fa0SDmitry Torokhov 		atkbd_set_leds(atkbd);
11361da177e4SLinus Torvalds 	}
11371da177e4SLinus Torvalds 
11381da177e4SLinus Torvalds 	atkbd_enable(atkbd);
11391da177e4SLinus Torvalds 
11401da177e4SLinus Torvalds 	return 0;
11411da177e4SLinus Torvalds }
11421da177e4SLinus Torvalds 
11431da177e4SLinus Torvalds static struct serio_device_id atkbd_serio_ids[] = {
11441da177e4SLinus Torvalds 	{
11451da177e4SLinus Torvalds 		.type	= SERIO_8042,
11461da177e4SLinus Torvalds 		.proto	= SERIO_ANY,
11471da177e4SLinus Torvalds 		.id	= SERIO_ANY,
11481da177e4SLinus Torvalds 		.extra	= SERIO_ANY,
11491da177e4SLinus Torvalds 	},
11501da177e4SLinus Torvalds 	{
11511da177e4SLinus Torvalds 		.type	= SERIO_8042_XL,
11521da177e4SLinus Torvalds 		.proto	= SERIO_ANY,
11531da177e4SLinus Torvalds 		.id	= SERIO_ANY,
11541da177e4SLinus Torvalds 		.extra	= SERIO_ANY,
11551da177e4SLinus Torvalds 	},
11561da177e4SLinus Torvalds 	{
11571da177e4SLinus Torvalds 		.type	= SERIO_RS232,
11581da177e4SLinus Torvalds 		.proto	= SERIO_PS2SER,
11591da177e4SLinus Torvalds 		.id	= SERIO_ANY,
11601da177e4SLinus Torvalds 		.extra	= SERIO_ANY,
11611da177e4SLinus Torvalds 	},
11621da177e4SLinus Torvalds 	{ 0 }
11631da177e4SLinus Torvalds };
11641da177e4SLinus Torvalds 
11651da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);
11661da177e4SLinus Torvalds 
11671da177e4SLinus Torvalds static struct serio_driver atkbd_drv = {
11681da177e4SLinus Torvalds 	.driver		= {
11691da177e4SLinus Torvalds 		.name	= "atkbd",
11701da177e4SLinus Torvalds 	},
11711da177e4SLinus Torvalds 	.description	= DRIVER_DESC,
11721da177e4SLinus Torvalds 	.id_table	= atkbd_serio_ids,
11731da177e4SLinus Torvalds 	.interrupt	= atkbd_interrupt,
11741da177e4SLinus Torvalds 	.connect	= atkbd_connect,
11751da177e4SLinus Torvalds 	.reconnect	= atkbd_reconnect,
11761da177e4SLinus Torvalds 	.disconnect	= atkbd_disconnect,
11771da177e4SLinus Torvalds 	.cleanup	= atkbd_cleanup,
11781da177e4SLinus Torvalds };
11791da177e4SLinus Torvalds 
11801da177e4SLinus Torvalds static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
11811da177e4SLinus Torvalds 				ssize_t (*handler)(struct atkbd *, char *))
11821da177e4SLinus Torvalds {
11831da177e4SLinus Torvalds 	struct serio *serio = to_serio_port(dev);
11841da177e4SLinus Torvalds 	int retval;
11851da177e4SLinus Torvalds 
11861da177e4SLinus Torvalds 	retval = serio_pin_driver(serio);
11871da177e4SLinus Torvalds 	if (retval)
11881da177e4SLinus Torvalds 		return retval;
11891da177e4SLinus Torvalds 
11901da177e4SLinus Torvalds 	if (serio->drv != &atkbd_drv) {
11911da177e4SLinus Torvalds 		retval = -ENODEV;
11921da177e4SLinus Torvalds 		goto out;
11931da177e4SLinus Torvalds 	}
11941da177e4SLinus Torvalds 
11951da177e4SLinus Torvalds 	retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);
11961da177e4SLinus Torvalds 
11971da177e4SLinus Torvalds out:
11981da177e4SLinus Torvalds 	serio_unpin_driver(serio);
11991da177e4SLinus Torvalds 	return retval;
12001da177e4SLinus Torvalds }
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
12031da177e4SLinus Torvalds 				ssize_t (*handler)(struct atkbd *, const char *, size_t))
12041da177e4SLinus Torvalds {
12051da177e4SLinus Torvalds 	struct serio *serio = to_serio_port(dev);
12061da177e4SLinus Torvalds 	struct atkbd *atkbd;
12071da177e4SLinus Torvalds 	int retval;
12081da177e4SLinus Torvalds 
12091da177e4SLinus Torvalds 	retval = serio_pin_driver(serio);
12101da177e4SLinus Torvalds 	if (retval)
12111da177e4SLinus Torvalds 		return retval;
12121da177e4SLinus Torvalds 
12131da177e4SLinus Torvalds 	if (serio->drv != &atkbd_drv) {
12141da177e4SLinus Torvalds 		retval = -ENODEV;
12151da177e4SLinus Torvalds 		goto out;
12161da177e4SLinus Torvalds 	}
12171da177e4SLinus Torvalds 
12181da177e4SLinus Torvalds 	atkbd = serio_get_drvdata(serio);
12191da177e4SLinus Torvalds 	atkbd_disable(atkbd);
12201da177e4SLinus Torvalds 	retval = handler(atkbd, buf, count);
12211da177e4SLinus Torvalds 	atkbd_enable(atkbd);
12221da177e4SLinus Torvalds 
12231da177e4SLinus Torvalds out:
12241da177e4SLinus Torvalds 	serio_unpin_driver(serio);
12251da177e4SLinus Torvalds 	return retval;
12261da177e4SLinus Torvalds }
12271da177e4SLinus Torvalds 
12281da177e4SLinus Torvalds static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf)
12291da177e4SLinus Torvalds {
12301da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);
12311da177e4SLinus Torvalds }
12321da177e4SLinus Torvalds 
12331da177e4SLinus Torvalds static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count)
12341da177e4SLinus Torvalds {
12352b03b60eSDmitry Torokhov 	struct input_dev *old_dev, *new_dev;
12361da177e4SLinus Torvalds 	unsigned long value;
12372b03b60eSDmitry Torokhov 	int err;
12382b03b60eSDmitry Torokhov 	unsigned char old_extra, old_set;
12391da177e4SLinus Torvalds 
12401da177e4SLinus Torvalds 	if (!atkbd->write)
12411da177e4SLinus Torvalds 		return -EIO;
12421da177e4SLinus Torvalds 
1243160f1fefSJoe Rouvier 	if (strict_strtoul(buf, 10, &value) || value > 1)
12441da177e4SLinus Torvalds 		return -EINVAL;
12451da177e4SLinus Torvalds 
12461da177e4SLinus Torvalds 	if (atkbd->extra != value) {
12473c42f0c3SDmitry Torokhov 		/*
12483c42f0c3SDmitry Torokhov 		 * Since device's properties will change we need to
12492b03b60eSDmitry Torokhov 		 * unregister old device. But allocate and register
12502b03b60eSDmitry Torokhov 		 * new one first to make sure we have it.
12513c42f0c3SDmitry Torokhov 		 */
12522b03b60eSDmitry Torokhov 		old_dev = atkbd->dev;
12532b03b60eSDmitry Torokhov 		old_extra = atkbd->extra;
12542b03b60eSDmitry Torokhov 		old_set = atkbd->set;
12552b03b60eSDmitry Torokhov 
12562b03b60eSDmitry Torokhov 		new_dev = input_allocate_device();
12572b03b60eSDmitry Torokhov 		if (!new_dev)
12583c42f0c3SDmitry Torokhov 			return -ENOMEM;
12592b03b60eSDmitry Torokhov 
12603c42f0c3SDmitry Torokhov 		atkbd->dev = new_dev;
12611da177e4SLinus Torvalds 		atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);
12621da177e4SLinus Torvalds 		atkbd_activate(atkbd);
12632b03b60eSDmitry Torokhov 		atkbd_set_keycode_table(atkbd);
12641da177e4SLinus Torvalds 		atkbd_set_device_attrs(atkbd);
12652b03b60eSDmitry Torokhov 
12662b03b60eSDmitry Torokhov 		err = input_register_device(atkbd->dev);
12672b03b60eSDmitry Torokhov 		if (err) {
12682b03b60eSDmitry Torokhov 			input_free_device(new_dev);
12692b03b60eSDmitry Torokhov 
12702b03b60eSDmitry Torokhov 			atkbd->dev = old_dev;
12712b03b60eSDmitry Torokhov 			atkbd->set = atkbd_select_set(atkbd, old_set, old_extra);
12722b03b60eSDmitry Torokhov 			atkbd_set_keycode_table(atkbd);
12732b03b60eSDmitry Torokhov 			atkbd_set_device_attrs(atkbd);
12742b03b60eSDmitry Torokhov 
12752b03b60eSDmitry Torokhov 			return err;
12762b03b60eSDmitry Torokhov 		}
12772b03b60eSDmitry Torokhov 		input_unregister_device(old_dev);
12782b03b60eSDmitry Torokhov 
12791da177e4SLinus Torvalds 	}
12801da177e4SLinus Torvalds 	return count;
12811da177e4SLinus Torvalds }
12821da177e4SLinus Torvalds 
12831da177e4SLinus Torvalds static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf)
12841da177e4SLinus Torvalds {
12851da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);
12861da177e4SLinus Torvalds }
12871da177e4SLinus Torvalds 
12881da177e4SLinus Torvalds static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count)
12891da177e4SLinus Torvalds {
12902b03b60eSDmitry Torokhov 	struct input_dev *old_dev, *new_dev;
12911da177e4SLinus Torvalds 	unsigned long value;
12922b03b60eSDmitry Torokhov 	int err;
12932b03b60eSDmitry Torokhov 	unsigned char old_scroll;
12941da177e4SLinus Torvalds 
1295160f1fefSJoe Rouvier 	if (strict_strtoul(buf, 10, &value) || value > 1)
12961da177e4SLinus Torvalds 		return -EINVAL;
12971da177e4SLinus Torvalds 
12981da177e4SLinus Torvalds 	if (atkbd->scroll != value) {
12992b03b60eSDmitry Torokhov 		old_dev = atkbd->dev;
13002b03b60eSDmitry Torokhov 		old_scroll = atkbd->scroll;
13012b03b60eSDmitry Torokhov 
13022b03b60eSDmitry Torokhov 		new_dev = input_allocate_device();
13032b03b60eSDmitry Torokhov 		if (!new_dev)
13043c42f0c3SDmitry Torokhov 			return -ENOMEM;
13052b03b60eSDmitry Torokhov 
13063c42f0c3SDmitry Torokhov 		atkbd->dev = new_dev;
13071da177e4SLinus Torvalds 		atkbd->scroll = value;
13081da177e4SLinus Torvalds 		atkbd_set_keycode_table(atkbd);
13091da177e4SLinus Torvalds 		atkbd_set_device_attrs(atkbd);
13102b03b60eSDmitry Torokhov 
13112b03b60eSDmitry Torokhov 		err = input_register_device(atkbd->dev);
13122b03b60eSDmitry Torokhov 		if (err) {
13132b03b60eSDmitry Torokhov 			input_free_device(new_dev);
13142b03b60eSDmitry Torokhov 
13152b03b60eSDmitry Torokhov 			atkbd->scroll = old_scroll;
13162b03b60eSDmitry Torokhov 			atkbd->dev = old_dev;
13172b03b60eSDmitry Torokhov 			atkbd_set_keycode_table(atkbd);
13182b03b60eSDmitry Torokhov 			atkbd_set_device_attrs(atkbd);
13192b03b60eSDmitry Torokhov 
13202b03b60eSDmitry Torokhov 			return err;
13212b03b60eSDmitry Torokhov 		}
13222b03b60eSDmitry Torokhov 		input_unregister_device(old_dev);
13231da177e4SLinus Torvalds 	}
13241da177e4SLinus Torvalds 	return count;
13251da177e4SLinus Torvalds }
13261da177e4SLinus Torvalds 
13271da177e4SLinus Torvalds static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf)
13281da177e4SLinus Torvalds {
13291da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", atkbd->set);
13301da177e4SLinus Torvalds }
13311da177e4SLinus Torvalds 
13321da177e4SLinus Torvalds static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count)
13331da177e4SLinus Torvalds {
13342b03b60eSDmitry Torokhov 	struct input_dev *old_dev, *new_dev;
13351da177e4SLinus Torvalds 	unsigned long value;
13362b03b60eSDmitry Torokhov 	int err;
13372b03b60eSDmitry Torokhov 	unsigned char old_set, old_extra;
13381da177e4SLinus Torvalds 
13391da177e4SLinus Torvalds 	if (!atkbd->write)
13401da177e4SLinus Torvalds 		return -EIO;
13411da177e4SLinus Torvalds 
1342160f1fefSJoe Rouvier 	if (strict_strtoul(buf, 10, &value) || (value != 2 && value != 3))
13431da177e4SLinus Torvalds 		return -EINVAL;
13441da177e4SLinus Torvalds 
13451da177e4SLinus Torvalds 	if (atkbd->set != value) {
13462b03b60eSDmitry Torokhov 		old_dev = atkbd->dev;
13472b03b60eSDmitry Torokhov 		old_extra = atkbd->extra;
13482b03b60eSDmitry Torokhov 		old_set = atkbd->set;
13492b03b60eSDmitry Torokhov 
13502b03b60eSDmitry Torokhov 		new_dev = input_allocate_device();
13512b03b60eSDmitry Torokhov 		if (!new_dev)
13523c42f0c3SDmitry Torokhov 			return -ENOMEM;
13532b03b60eSDmitry Torokhov 
13543c42f0c3SDmitry Torokhov 		atkbd->dev = new_dev;
13551da177e4SLinus Torvalds 		atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);
13561da177e4SLinus Torvalds 		atkbd_activate(atkbd);
13571da177e4SLinus Torvalds 		atkbd_set_keycode_table(atkbd);
13581da177e4SLinus Torvalds 		atkbd_set_device_attrs(atkbd);
13592b03b60eSDmitry Torokhov 
13602b03b60eSDmitry Torokhov 		err = input_register_device(atkbd->dev);
13612b03b60eSDmitry Torokhov 		if (err) {
13622b03b60eSDmitry Torokhov 			input_free_device(new_dev);
13632b03b60eSDmitry Torokhov 
13642b03b60eSDmitry Torokhov 			atkbd->dev = old_dev;
13652b03b60eSDmitry Torokhov 			atkbd->set = atkbd_select_set(atkbd, old_set, old_extra);
13662b03b60eSDmitry Torokhov 			atkbd_set_keycode_table(atkbd);
13672b03b60eSDmitry Torokhov 			atkbd_set_device_attrs(atkbd);
13682b03b60eSDmitry Torokhov 
13692b03b60eSDmitry Torokhov 			return err;
13702b03b60eSDmitry Torokhov 		}
13712b03b60eSDmitry Torokhov 		input_unregister_device(old_dev);
13721da177e4SLinus Torvalds 	}
13731da177e4SLinus Torvalds 	return count;
13741da177e4SLinus Torvalds }
13751da177e4SLinus Torvalds 
13761da177e4SLinus Torvalds static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf)
13771da177e4SLinus Torvalds {
13781da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);
13791da177e4SLinus Torvalds }
13801da177e4SLinus Torvalds 
13811da177e4SLinus Torvalds static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count)
13821da177e4SLinus Torvalds {
13832b03b60eSDmitry Torokhov 	struct input_dev *old_dev, *new_dev;
13841da177e4SLinus Torvalds 	unsigned long value;
13852b03b60eSDmitry Torokhov 	int err;
13862b03b60eSDmitry Torokhov 	unsigned char old_softrepeat, old_softraw;
13871da177e4SLinus Torvalds 
13881da177e4SLinus Torvalds 	if (!atkbd->write)
13891da177e4SLinus Torvalds 		return -EIO;
13901da177e4SLinus Torvalds 
1391160f1fefSJoe Rouvier 	if (strict_strtoul(buf, 10, &value) || value > 1)
13921da177e4SLinus Torvalds 		return -EINVAL;
13931da177e4SLinus Torvalds 
13941da177e4SLinus Torvalds 	if (atkbd->softrepeat != value) {
13952b03b60eSDmitry Torokhov 		old_dev = atkbd->dev;
13962b03b60eSDmitry Torokhov 		old_softrepeat = atkbd->softrepeat;
13972b03b60eSDmitry Torokhov 		old_softraw = atkbd->softraw;
13982b03b60eSDmitry Torokhov 
13992b03b60eSDmitry Torokhov 		new_dev = input_allocate_device();
14002b03b60eSDmitry Torokhov 		if (!new_dev)
14013c42f0c3SDmitry Torokhov 			return -ENOMEM;
14022b03b60eSDmitry Torokhov 
14033c42f0c3SDmitry Torokhov 		atkbd->dev = new_dev;
14041da177e4SLinus Torvalds 		atkbd->softrepeat = value;
14051da177e4SLinus Torvalds 		if (atkbd->softrepeat)
14061da177e4SLinus Torvalds 			atkbd->softraw = 1;
14071da177e4SLinus Torvalds 		atkbd_set_device_attrs(atkbd);
14082b03b60eSDmitry Torokhov 
14092b03b60eSDmitry Torokhov 		err = input_register_device(atkbd->dev);
14102b03b60eSDmitry Torokhov 		if (err) {
14112b03b60eSDmitry Torokhov 			input_free_device(new_dev);
14122b03b60eSDmitry Torokhov 
14132b03b60eSDmitry Torokhov 			atkbd->dev = old_dev;
14142b03b60eSDmitry Torokhov 			atkbd->softrepeat = old_softrepeat;
14152b03b60eSDmitry Torokhov 			atkbd->softraw = old_softraw;
14162b03b60eSDmitry Torokhov 			atkbd_set_device_attrs(atkbd);
14172b03b60eSDmitry Torokhov 
14182b03b60eSDmitry Torokhov 			return err;
14192b03b60eSDmitry Torokhov 		}
14202b03b60eSDmitry Torokhov 		input_unregister_device(old_dev);
14211da177e4SLinus Torvalds 	}
14221da177e4SLinus Torvalds 	return count;
14231da177e4SLinus Torvalds }
14241da177e4SLinus Torvalds 
14251da177e4SLinus Torvalds 
14261da177e4SLinus Torvalds static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf)
14271da177e4SLinus Torvalds {
14281da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);
14291da177e4SLinus Torvalds }
14301da177e4SLinus Torvalds 
14311da177e4SLinus Torvalds static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count)
14321da177e4SLinus Torvalds {
14332b03b60eSDmitry Torokhov 	struct input_dev *old_dev, *new_dev;
14341da177e4SLinus Torvalds 	unsigned long value;
14352b03b60eSDmitry Torokhov 	int err;
14362b03b60eSDmitry Torokhov 	unsigned char old_softraw;
14371da177e4SLinus Torvalds 
1438160f1fefSJoe Rouvier 	if (strict_strtoul(buf, 10, &value) || value > 1)
14391da177e4SLinus Torvalds 		return -EINVAL;
14401da177e4SLinus Torvalds 
14411da177e4SLinus Torvalds 	if (atkbd->softraw != value) {
14422b03b60eSDmitry Torokhov 		old_dev = atkbd->dev;
14432b03b60eSDmitry Torokhov 		old_softraw = atkbd->softraw;
14442b03b60eSDmitry Torokhov 
14452b03b60eSDmitry Torokhov 		new_dev = input_allocate_device();
14462b03b60eSDmitry Torokhov 		if (!new_dev)
14473c42f0c3SDmitry Torokhov 			return -ENOMEM;
14482b03b60eSDmitry Torokhov 
14493c42f0c3SDmitry Torokhov 		atkbd->dev = new_dev;
14501da177e4SLinus Torvalds 		atkbd->softraw = value;
14511da177e4SLinus Torvalds 		atkbd_set_device_attrs(atkbd);
14522b03b60eSDmitry Torokhov 
14532b03b60eSDmitry Torokhov 		err = input_register_device(atkbd->dev);
14542b03b60eSDmitry Torokhov 		if (err) {
14552b03b60eSDmitry Torokhov 			input_free_device(new_dev);
14562b03b60eSDmitry Torokhov 
14572b03b60eSDmitry Torokhov 			atkbd->dev = old_dev;
14582b03b60eSDmitry Torokhov 			atkbd->softraw = old_softraw;
14592b03b60eSDmitry Torokhov 			atkbd_set_device_attrs(atkbd);
14602b03b60eSDmitry Torokhov 
14612b03b60eSDmitry Torokhov 			return err;
14622b03b60eSDmitry Torokhov 		}
14632b03b60eSDmitry Torokhov 		input_unregister_device(old_dev);
14641da177e4SLinus Torvalds 	}
14651da177e4SLinus Torvalds 	return count;
14661da177e4SLinus Torvalds }
14671da177e4SLinus Torvalds 
146886255d9dSDmitry Torokhov static ssize_t atkbd_show_err_count(struct atkbd *atkbd, char *buf)
146986255d9dSDmitry Torokhov {
147086255d9dSDmitry Torokhov 	return sprintf(buf, "%lu\n", atkbd->err_count);
147186255d9dSDmitry Torokhov }
147286255d9dSDmitry Torokhov 
147339191698SDaniel Mierswa static int __init atkbd_setup_forced_release(const struct dmi_system_id *id)
1474554101e3SGiel de Nijs {
147539191698SDaniel Mierswa 	atkbd_platform_fixup = atkbd_apply_forced_release_keylist;
147639191698SDaniel Mierswa 	atkbd_platform_fixup_data = id->driver_data;
147739191698SDaniel Mierswa 
1478554101e3SGiel de Nijs 	return 0;
1479554101e3SGiel de Nijs }
1480554101e3SGiel de Nijs 
1481554101e3SGiel de Nijs static struct dmi_system_id atkbd_dmi_quirk_table[] __initdata = {
1482554101e3SGiel de Nijs 	{
148361579ba8SMatthew Garrett 		.ident = "Dell Laptop",
1484554101e3SGiel de Nijs 		.matches = {
1485554101e3SGiel de Nijs 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
148661579ba8SMatthew Garrett 			DMI_MATCH(DMI_CHASSIS_TYPE, "8"), /* Portable */
1487554101e3SGiel de Nijs 		},
148839191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
148939191698SDaniel Mierswa 		.driver_data = atkbd_dell_laptop_forced_release_keys,
1490554101e3SGiel de Nijs 	},
14915a54c011SJiri Kosina 	{
14922a3ec326SMatthew Garrett 		.ident = "Dell Laptop",
14932a3ec326SMatthew Garrett 		.matches = {
14942a3ec326SMatthew Garrett 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Computer Corporation"),
14952a3ec326SMatthew Garrett 			DMI_MATCH(DMI_CHASSIS_TYPE, "8"), /* Portable */
14962a3ec326SMatthew Garrett 		},
149739191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
149839191698SDaniel Mierswa 		.driver_data = atkbd_dell_laptop_forced_release_keys,
14992a3ec326SMatthew Garrett 	},
15002a3ec326SMatthew Garrett 	{
15015a54c011SJiri Kosina 		.ident = "HP 2133",
15025a54c011SJiri Kosina 		.matches = {
15035a54c011SJiri Kosina 			DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
15045a54c011SJiri Kosina 			DMI_MATCH(DMI_PRODUCT_NAME, "HP 2133"),
15055a54c011SJiri Kosina 		},
150639191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
150739191698SDaniel Mierswa 		.driver_data = atkbd_hp_forced_release_keys,
15085a54c011SJiri Kosina 	},
1509a8215b81SMatthew Garrett 	{
1510181f6382SRikard Ljungstrand 		.ident = "HP Pavilion ZV6100",
1511181f6382SRikard Ljungstrand 		.matches = {
1512181f6382SRikard Ljungstrand 			DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
1513181f6382SRikard Ljungstrand 			DMI_MATCH(DMI_PRODUCT_NAME, "Pavilion ZV6100"),
1514181f6382SRikard Ljungstrand 		},
151539191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
151639191698SDaniel Mierswa 		.driver_data = atkbd_hp_zv6100_forced_release_keys,
1517181f6382SRikard Ljungstrand 	},
1518181f6382SRikard Ljungstrand 	{
1519a8215b81SMatthew Garrett 		.ident = "Inventec Symphony",
1520a8215b81SMatthew Garrett 		.matches = {
1521a8215b81SMatthew Garrett 			DMI_MATCH(DMI_SYS_VENDOR, "INVENTEC"),
1522a8215b81SMatthew Garrett 			DMI_MATCH(DMI_PRODUCT_NAME, "SYMPHONY 6.0/7.0"),
1523a8215b81SMatthew Garrett 		},
152439191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
152539191698SDaniel Mierswa 		.driver_data = atkbd_inventec_forced_release_keys,
1526a8215b81SMatthew Garrett 	},
15274200844bSStuart Hopkins 	{
15284200844bSStuart Hopkins 		.ident = "Samsung NC10",
15294200844bSStuart Hopkins 		.matches = {
15304200844bSStuart Hopkins 			DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
15314200844bSStuart Hopkins 			DMI_MATCH(DMI_PRODUCT_NAME, "NC10"),
15324200844bSStuart Hopkins 		},
153339191698SDaniel Mierswa 		.callback = atkbd_setup_forced_release,
153439191698SDaniel Mierswa 		.driver_data = atkbd_samsung_forced_release_keys,
15354200844bSStuart Hopkins 	},
1536*adcb523eSDaniel Mierswa 	{
1537*adcb523eSDaniel Mierswa 		.ident = "Fujitsu Amilo PA 1510",
1538*adcb523eSDaniel Mierswa 		.matches = {
1539*adcb523eSDaniel Mierswa 			DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
1540*adcb523eSDaniel Mierswa 			DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pa 1510"),
1541*adcb523eSDaniel Mierswa 		},
1542*adcb523eSDaniel Mierswa 		.callback = atkbd_setup_forced_release,
1543*adcb523eSDaniel Mierswa 		.driver_data = atkbd_amilo_pa1510_forced_release_keys,
1544*adcb523eSDaniel Mierswa 	},
1545554101e3SGiel de Nijs 	{ }
1546554101e3SGiel de Nijs };
15471da177e4SLinus Torvalds 
15481da177e4SLinus Torvalds static int __init atkbd_init(void)
15491da177e4SLinus Torvalds {
1550554101e3SGiel de Nijs 	dmi_check_system(atkbd_dmi_quirk_table);
1551554101e3SGiel de Nijs 
1552153a9df0SAkinobu Mita 	return serio_register_driver(&atkbd_drv);
15531da177e4SLinus Torvalds }
15541da177e4SLinus Torvalds 
15551da177e4SLinus Torvalds static void __exit atkbd_exit(void)
15561da177e4SLinus Torvalds {
15571da177e4SLinus Torvalds 	serio_unregister_driver(&atkbd_drv);
15581da177e4SLinus Torvalds }
15591da177e4SLinus Torvalds 
15601da177e4SLinus Torvalds module_init(atkbd_init);
15611da177e4SLinus Torvalds module_exit(atkbd_exit);
1562