* For known special keyboards we can go ahead and set the correct set. * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards. */	if (atkbd->translated)		return 2;	if (atkbd->id == 0xaca1) {		param[0] = 3;		ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);		return 3;	}	if (allow_extra) {		param[0] = 0x71;		if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {			atkbd->extra = 1;			return 2;		}	}	if (target_set != 3)		return 2;	if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {		atkbd->id = param[0] << 8 | param[1];		return 2;	}	param[0] = 3;	if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))		return 2;	param[0] = 0;	if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))		return 2;	if (param[0] != 3) {		param[0] = 2;		if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))		return 2;	}	ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);	return 3;}static int atkbd_activate(struct atkbd *atkbd){	struct ps2dev *ps2dev = &atkbd->ps2dev;	unsigned char param[1];/* * Set the LEDs to a defined state. */	param[0] = 0;	if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))		return -1;/* * Set autorepeat to fastest possible. */	param[0] = 0;	if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))		return -1;/* * Enable the keyboard to receive keystrokes. */	if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {		printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",			ps2dev->serio->phys);		return -1;	}	return 0;}/* * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a * reboot. */static void atkbd_cleanup(struct serio *serio){	struct atkbd *atkbd = serio_get_drvdata(serio);	ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);}/* * atkbd_disconnect() closes and frees. */static void atkbd_disconnect(struct serio *serio){	struct atkbd *atkbd = serio_get_drvdata(serio);	atkbd_disable(atkbd);	/* make sure we don't have a command in flight */	synchronize_sched();  /* Allow atkbd_interrupt()s to complete. */	flush_scheduled_work();	device_remove_file(&serio->dev, &atkbd_attr_extra);	device_remove_file(&serio->dev, &atkbd_attr_scroll);	device_remove_file(&serio->dev, &atkbd_attr_set);	device_remove_file(&serio->dev, &atkbd_attr_softrepeat);	device_remove_file(&serio->dev, &atkbd_attr_softraw);	input_unregister_device(&atkbd->dev);	serio_close(serio);	serio_set_drvdata(serio, NULL);	kfree(atkbd);}/* * atkbd_set_device_attrs() initializes keyboard's keycode table * according to the selected scancode set */static void atkbd_set_keycode_table(struct atkbd *atkbd){	int i, j;	memset(atkbd->keycode, 0, sizeof(atkbd->keycode));	if (atkbd->translated) {		for (i = 0; i < 128; i++) {			atkbd->keycode[i] = atkbd_set2_keycode[atkbd_unxlate_table[i]];			atkbd->keycode[i | 0x80] = atkbd_set2_keycode[atkbd_unxlate_table[i] | 0x80];			if (atkbd->scroll)				for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)					if ((atkbd_unxlate_table[i] | 0x80) == atkbd_scroll_keys[j].set2)						atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;		}	} else if (atkbd->set == 3) {		memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));	} else {		memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));		if (atkbd->scroll)			for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++)				atkbd->keycode[atkbd_scroll_keys[i].set2] = atkbd_scroll_keys[i].keycode;	}}/* * atkbd_set_device_attrs() sets up keyboard's input device structure */static void atkbd_set_device_attrs(struct atkbd *atkbd){	int i;	memset(&atkbd->dev, 0, sizeof(struct input_dev));	init_input_dev(&atkbd->dev);	atkbd->dev.name = atkbd->name;	atkbd->dev.phys = atkbd->phys;	atkbd->dev.id.bustype = BUS_I8042;	atkbd->dev.id.vendor = 0x0001;	atkbd->dev.id.product = atkbd->translated ? 1 : atkbd->set;	atkbd->dev.id.version = atkbd->id;	atkbd->dev.event = atkbd_event;	atkbd->dev.private = atkbd;	atkbd->dev.dev = &atkbd->ps2dev.serio->dev;	atkbd->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC);	if (atkbd->write) {		atkbd->dev.evbit[0] |= BIT(EV_LED);		atkbd->dev.ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL);	}	if (atkbd->extra)		atkbd->dev.ledbit[0] |= BIT(LED_COMPOSE) | BIT(LED_SUSPEND) |					BIT(LED_SLEEP) | BIT(LED_MUTE) | BIT(LED_MISC);	if (!atkbd->softrepeat) {		atkbd->dev.rep[REP_DELAY] = 250;		atkbd->dev.rep[REP_PERIOD] = 33;	}	atkbd->dev.mscbit[0] = atkbd->softraw ? BIT(MSC_SCAN) : BIT(MSC_RAW) | BIT(MSC_SCAN);	if (atkbd->scroll) {		atkbd->dev.evbit[0] |= BIT(EV_REL);		atkbd->dev.relbit[0] = BIT(REL_WHEEL) | BIT(REL_HWHEEL);		set_bit(BTN_MIDDLE, atkbd->dev.keybit);	}	atkbd->dev.keycode = atkbd->keycode;	atkbd->dev.keycodesize = sizeof(unsigned char);	atkbd->dev.keycodemax = ARRAY_SIZE(atkbd_set2_keycode);	for (i = 0; i < 512; i++)		if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)			set_bit(atkbd->keycode[i], atkbd->dev.keybit);}/* * atkbd_connect() is called when the serio module finds an interface * that isn't handled yet by an appropriate device driver. We check if * there is an AT keyboard out there and if yes, we register ourselves * to the input module. */static int atkbd_connect(struct serio *serio, struct serio_driver *drv){	struct atkbd *atkbd;	int err;	if (!(atkbd = kmalloc(sizeof(struct atkbd), GFP_KERNEL)))		return - ENOMEM;	memset(atkbd, 0, sizeof(struct atkbd));	ps2_init(&atkbd->ps2dev, serio);	switch (serio->id.type) {		case SERIO_8042_XL:			atkbd->translated = 1;		case SERIO_8042:			if (serio->write)				atkbd->write = 1;			break;	}	atkbd->softraw = atkbd_softraw;	atkbd->softrepeat = atkbd_softrepeat;	atkbd->scroll = atkbd_scroll;	if (!atkbd->write)		atkbd->softrepeat = 1;	if (atkbd->softrepeat)		atkbd->softraw = 1;	serio_set_drvdata(serio, atkbd);	err = serio_open(serio, drv);	if (err) {		serio_set_drvdata(serio, NULL);		kfree(atkbd);		return err;	}	if (atkbd->write) {		if (atkbd_probe(atkbd)) {			serio_close(serio);			serio_set_drvdata(serio, NULL);			kfree(atkbd);			return -ENODEV;		}		atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);		atkbd_activate(atkbd);	} else {		atkbd->set = 2;		atkbd->id = 0xab00;	}	if (atkbd->extra)		sprintf(atkbd->name, "AT Set 2 Extra keyboard");	else		sprintf(atkbd->name, "AT %s Set %d keyboard",			atkbd->translated ? "Translated" : "Raw", atkbd->set);	sprintf(atkbd->phys, "%s/input0", serio->phys);	atkbd_set_keycode_table(atkbd);	atkbd_set_device_attrs(atkbd);	input_register_device(&atkbd->dev);	device_create_file(&serio->dev, &atkbd_attr_extra);	device_create_file(&serio->dev, &atkbd_attr_scroll);	device_create_file(&serio->dev, &atkbd_attr_set);	device_create_file(&serio->dev, &atkbd_attr_softrepeat);	device_create_file(&serio->dev, &atkbd_attr_softraw);	atkbd_enable(atkbd);	printk(KERN_INFO "input: %s on %s\n", atkbd->name, serio->phys);	return 0;}/* * atkbd_reconnect() tries to restore keyboard into a sane state and is * most likely called on resume. */static int atkbd_reconnect(struct serio *serio){	struct atkbd *atkbd = serio_get_drvdata(serio);	struct serio_driver *drv = serio->drv;	unsigned char param[1];	if (!atkbd || !drv) {		printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");		return -1;	}	atkbd_disable(atkbd);	if (atkbd->write) {		param[0] = (test_bit(LED_SCROLLL, atkbd->dev.led) ? 1 : 0)		         | (test_bit(LED_NUML,    atkbd->dev.led) ? 2 : 0)		         | (test_bit(LED_CAPSL,   atkbd->dev.led) ? 4 : 0);		if (atkbd_probe(atkbd))			return -1;		if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))			return -1;		atkbd_activate(atkbd);		if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))			return -1;	}	atkbd_enable(atkbd);	return 0;}static struct serio_device_id atkbd_serio_ids[] = {	{		.type	= SERIO_8042,		.proto	= SERIO_ANY,		.id	= SERIO_ANY,		.extra	= SERIO_ANY,	},	{		.type	= SERIO_8042_XL,		.proto	= SERIO_ANY,		.id	= SERIO_ANY,		.extra	= SERIO_ANY,	},	{		.type	= SERIO_RS232,		.proto	= SERIO_PS2SER,		.id	= SERIO_ANY,		.extra	= SERIO_ANY,	},	{ 0 }};MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);static struct serio_driver atkbd_drv = {	.driver		= {		.name	= "atkbd",	},	.description	= DRIVER_DESC,	.id_table	= atkbd_serio_ids,	.interrupt	= atkbd_interrupt,	.connect	= atkbd_connect,	.reconnect	= atkbd_reconnect,	.disconnect	= atkbd_disconnect,	.cleanup	= atkbd_cleanup,};static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,				ssize_t (*handler)(struct atkbd *, char *)){	struct serio *serio = to_serio_port(dev);	int retval;	retval = serio_pin_driver(serio);	if (retval)		return retval;	if (serio->drv != &atkbd_drv) {		retval = -ENODEV;		goto out;	}	retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);out:	serio_unpin_driver(serio);	return retval;}static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,				ssize_t (*handler)(struct atkbd *, const char *, size_t)){	struct serio *serio = to_serio_port(dev);	struct atkbd *atkbd;	int retval;	retval = serio_pin_driver(serio);	if (retval)		return retval;	if (serio->drv != &atkbd_drv) {		retval = -ENODEV;		goto out;	}	atkbd = serio_get_drvdata(serio);	atkbd_disable(atkbd);	retval = handler(atkbd, buf, count);	atkbd_enable(atkbd);out:	serio_unpin_driver(serio);	return retval;}static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf){	return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);}static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count){	unsigned long value;	char *rest;	if (!atkbd->write)		return -EIO;	value = simple_strtoul(buf, &rest, 10);	if (*rest || value > 1)		return -EINVAL;	if (atkbd->extra != value) {		/* unregister device as it's properties will change */		input_unregister_device(&atkbd->dev);		atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);		atkbd_activate(atkbd);		atkbd_set_device_attrs(atkbd);		input_register_device(&atkbd->dev);	}	return count;}static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf){	return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);}static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count){	unsigned long value;	char *rest;	value = simple_strtoul(buf, &rest, 10);	if (*rest || value > 1)		return -EINVAL;	if (atkbd->scroll != value) {		/* unregister device as it's properties will change */		input_unregister_device(&atkbd->dev);		atkbd->scroll = value;		atkbd_set_keycode_table(atkbd);		atkbd_set_device_attrs(atkbd);		input_register_device(&atkbd->dev);	}	return count;}static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf){	return sprintf(buf, "%d\n", atkbd->set);}static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count){	unsigned long value;	char *rest;	if (!atkbd->write)		return -EIO;	value = simple_strtoul(buf, &rest, 10);	if (*rest || (value != 2 && value != 3))		return -EINVAL;	if (atkbd->set != value) {		/* unregister device as it's properties will change */		input_unregister_device(&atkbd->dev);		atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);		atkbd_activate(atkbd);		atkbd_set_keycode_table(atkbd);		atkbd_set_device_attrs(atkbd);		input_register_device(&atkbd->dev);	}	return count;}static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf){	return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);}static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count){	unsigned long value;	char *rest;	if (!atkbd->write)		return -EIO;	value = simple_strtoul(buf, &rest, 10);	if (*rest || value > 1)		return -EINVAL;	if (atkbd->softrepeat != value) {		/* unregister device as it's properties will change */		input_unregister_device(&atkbd->dev);		atkbd->softrepeat = value;		if (atkbd->softrepeat)			atkbd->softraw = 1;		atkbd_set_device_attrs(atkbd);		input_register_device(&atkbd->dev);	}	return count;}static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf){	return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);}static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count){	unsigned long value;	char *rest;	value = simple_strtoul(buf, &rest, 10);	if (*rest || value > 1)		return -EINVAL;	if (atkbd->softraw != value) {		/* unregister device as it's properties will change */		input_unregister_device(&atkbd->dev);		atkbd->softraw = value;		atkbd_set_device_attrs(atkbd);		input_register_device(&atkbd->dev);	}	return count;}static int __init atkbd_init(void){	serio_register_driver(&atkbd_drv);	return 0;}static void __exit atkbd_exit(void){	serio_unregister_driver(&atkbd_drv);}module_init(atkbd_init);module_exit(atkbd_exit);