xref: /openbmc/linux/drivers/input/keyboard/sunkbd.c (revision 1966e005)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *  Copyright (c) 1999-2001 Vojtech Pavlik
31da177e4SLinus Torvalds  */
41da177e4SLinus Torvalds 
51da177e4SLinus Torvalds /*
61da177e4SLinus Torvalds  * Sun keyboard driver for Linux
71da177e4SLinus Torvalds  */
81da177e4SLinus Torvalds 
91da177e4SLinus Torvalds /*
101da177e4SLinus Torvalds  * This program is free software; you can redistribute it and/or modify
111da177e4SLinus Torvalds  * it under the terms of the GNU General Public License as published by
121da177e4SLinus Torvalds  * the Free Software Foundation; either version 2 of the License, or
131da177e4SLinus Torvalds  * (at your option) any later version.
141da177e4SLinus Torvalds  *
151da177e4SLinus Torvalds  * This program is distributed in the hope that it will be useful,
161da177e4SLinus Torvalds  * but WITHOUT ANY WARRANTY; without even the implied warranty of
171da177e4SLinus Torvalds  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
181da177e4SLinus Torvalds  * GNU General Public License for more details.
191da177e4SLinus Torvalds  *
201da177e4SLinus Torvalds  * You should have received a copy of the GNU General Public License
211da177e4SLinus Torvalds  * along with this program; if not, write to the Free Software
221da177e4SLinus Torvalds  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
231da177e4SLinus Torvalds  *
241da177e4SLinus Torvalds  * Should you need to contact me, the author, you can do so either by
251da177e4SLinus Torvalds  * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
261da177e4SLinus Torvalds  * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
271da177e4SLinus Torvalds  */
281da177e4SLinus Torvalds 
291da177e4SLinus Torvalds #include <linux/delay.h>
30d43c36dcSAlexey Dobriyan #include <linux/sched.h>
311da177e4SLinus Torvalds #include <linux/slab.h>
321da177e4SLinus Torvalds #include <linux/module.h>
331da177e4SLinus Torvalds #include <linux/interrupt.h>
341da177e4SLinus Torvalds #include <linux/input.h>
351da177e4SLinus Torvalds #include <linux/serio.h>
361da177e4SLinus Torvalds #include <linux/workqueue.h>
371da177e4SLinus Torvalds 
381da177e4SLinus Torvalds #define DRIVER_DESC	"Sun keyboard driver"
391da177e4SLinus Torvalds 
401da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
411da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC);
421da177e4SLinus Torvalds MODULE_LICENSE("GPL");
431da177e4SLinus Torvalds 
441da177e4SLinus Torvalds static unsigned char sunkbd_keycode[128] = {
458d9a9ae3SVojtech Pavlik 	  0,128,114,129,115, 59, 60, 68, 61, 87, 62, 88, 63,100, 64,112,
461da177e4SLinus Torvalds 	 65, 66, 67, 56,103,119, 99, 70,105,130,131,108,106,  1,  2,  3,
471da177e4SLinus Torvalds 	  4,  5,  6,  7,  8,  9, 10, 11, 12, 13, 41, 14,110,113, 98, 55,
481da177e4SLinus Torvalds 	116,132, 83,133,102, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25,
491da177e4SLinus Torvalds 	 26, 27,111,127, 71, 72, 73, 74,134,135,107,  0, 29, 30, 31, 32,
501da177e4SLinus Torvalds 	 33, 34, 35, 36, 37, 38, 39, 40, 43, 28, 96, 75, 76, 77, 82,136,
511da177e4SLinus Torvalds 	104,137, 69, 42, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54,101,
521da177e4SLinus Torvalds 	 79, 80, 81,  0,  0,  0,138, 58,125, 57,126,109, 86, 78
531da177e4SLinus Torvalds };
541da177e4SLinus Torvalds 
551da177e4SLinus Torvalds #define SUNKBD_CMD_RESET	0x1
561da177e4SLinus Torvalds #define SUNKBD_CMD_BELLON	0x2
571da177e4SLinus Torvalds #define SUNKBD_CMD_BELLOFF	0x3
581da177e4SLinus Torvalds #define SUNKBD_CMD_CLICK	0xa
591da177e4SLinus Torvalds #define SUNKBD_CMD_NOCLICK	0xb
601da177e4SLinus Torvalds #define SUNKBD_CMD_SETLED	0xe
611da177e4SLinus Torvalds #define SUNKBD_CMD_LAYOUT	0xf
621da177e4SLinus Torvalds 
631da177e4SLinus Torvalds #define SUNKBD_RET_RESET	0xff
641da177e4SLinus Torvalds #define SUNKBD_RET_ALLUP	0x7f
651da177e4SLinus Torvalds #define SUNKBD_RET_LAYOUT	0xfe
661da177e4SLinus Torvalds 
671da177e4SLinus Torvalds #define SUNKBD_LAYOUT_5_MASK	0x20
681da177e4SLinus Torvalds #define SUNKBD_RELEASE		0x80
691da177e4SLinus Torvalds #define SUNKBD_KEY		0x7f
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds /*
721da177e4SLinus Torvalds  * Per-keyboard data.
731da177e4SLinus Torvalds  */
741da177e4SLinus Torvalds 
751da177e4SLinus Torvalds struct sunkbd {
767cac9cd9SDmitry Torokhov 	unsigned char keycode[ARRAY_SIZE(sunkbd_keycode)];
773c42f0c3SDmitry Torokhov 	struct input_dev *dev;
781da177e4SLinus Torvalds 	struct serio *serio;
791da177e4SLinus Torvalds 	struct work_struct tq;
801da177e4SLinus Torvalds 	wait_queue_head_t wait;
811da177e4SLinus Torvalds 	char name[64];
821da177e4SLinus Torvalds 	char phys[32];
831da177e4SLinus Torvalds 	char type;
847cac9cd9SDmitry Torokhov 	bool enabled;
851da177e4SLinus Torvalds 	volatile s8 reset;
861da177e4SLinus Torvalds 	volatile s8 layout;
871da177e4SLinus Torvalds };
881da177e4SLinus Torvalds 
891da177e4SLinus Torvalds /*
901da177e4SLinus Torvalds  * sunkbd_interrupt() is called by the low level driver when a character
911da177e4SLinus Torvalds  * is received.
921da177e4SLinus Torvalds  */
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds static irqreturn_t sunkbd_interrupt(struct serio *serio,
957d12e780SDavid Howells 		unsigned char data, unsigned int flags)
961da177e4SLinus Torvalds {
971da177e4SLinus Torvalds 	struct sunkbd *sunkbd = serio_get_drvdata(serio);
981da177e4SLinus Torvalds 
997cac9cd9SDmitry Torokhov 	if (sunkbd->reset <= -1) {
1007cac9cd9SDmitry Torokhov 		/*
1017cac9cd9SDmitry Torokhov 		 * If cp[i] is 0xff, sunkbd->reset will stay -1.
1027cac9cd9SDmitry Torokhov 		 * The keyboard sends 0xff 0xff 0xID on powerup.
1037cac9cd9SDmitry Torokhov 		 */
1047cac9cd9SDmitry Torokhov 		sunkbd->reset = data;
1051da177e4SLinus Torvalds 		wake_up_interruptible(&sunkbd->wait);
1061da177e4SLinus Torvalds 		goto out;
1071da177e4SLinus Torvalds 	}
1081da177e4SLinus Torvalds 
1091da177e4SLinus Torvalds 	if (sunkbd->layout == -1) {
1101da177e4SLinus Torvalds 		sunkbd->layout = data;
1111da177e4SLinus Torvalds 		wake_up_interruptible(&sunkbd->wait);
1121da177e4SLinus Torvalds 		goto out;
1131da177e4SLinus Torvalds 	}
1141da177e4SLinus Torvalds 
1151da177e4SLinus Torvalds 	switch (data) {
1161da177e4SLinus Torvalds 
1171da177e4SLinus Torvalds 	case SUNKBD_RET_RESET:
1181da177e4SLinus Torvalds 		schedule_work(&sunkbd->tq);
1191da177e4SLinus Torvalds 		sunkbd->reset = -1;
1201da177e4SLinus Torvalds 		break;
1211da177e4SLinus Torvalds 
1221da177e4SLinus Torvalds 	case SUNKBD_RET_LAYOUT:
1231da177e4SLinus Torvalds 		sunkbd->layout = -1;
1241da177e4SLinus Torvalds 		break;
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds 	case SUNKBD_RET_ALLUP: /* All keys released */
1271da177e4SLinus Torvalds 		break;
1281da177e4SLinus Torvalds 
1291da177e4SLinus Torvalds 	default:
1303c42f0c3SDmitry Torokhov 		if (!sunkbd->enabled)
1313c42f0c3SDmitry Torokhov 			break;
1323c42f0c3SDmitry Torokhov 
1331da177e4SLinus Torvalds 		if (sunkbd->keycode[data & SUNKBD_KEY]) {
1347cac9cd9SDmitry Torokhov 			input_report_key(sunkbd->dev,
1357cac9cd9SDmitry Torokhov 					 sunkbd->keycode[data & SUNKBD_KEY],
1367cac9cd9SDmitry Torokhov 					 !(data & SUNKBD_RELEASE));
1373c42f0c3SDmitry Torokhov 			input_sync(sunkbd->dev);
1381da177e4SLinus Torvalds 		} else {
1397cac9cd9SDmitry Torokhov 			printk(KERN_WARNING
1407cac9cd9SDmitry Torokhov 				"sunkbd.c: Unknown key (scancode %#x) %s.\n",
1417cac9cd9SDmitry Torokhov 				data & SUNKBD_KEY,
1427cac9cd9SDmitry Torokhov 				data & SUNKBD_RELEASE ? "released" : "pressed");
1431da177e4SLinus Torvalds 		}
1441da177e4SLinus Torvalds 	}
1451da177e4SLinus Torvalds out:
1461da177e4SLinus Torvalds 	return IRQ_HANDLED;
1471da177e4SLinus Torvalds }
1481da177e4SLinus Torvalds 
1491da177e4SLinus Torvalds /*
1501da177e4SLinus Torvalds  * sunkbd_event() handles events from the input module.
1511da177e4SLinus Torvalds  */
1521da177e4SLinus Torvalds 
1537cac9cd9SDmitry Torokhov static int sunkbd_event(struct input_dev *dev,
1547cac9cd9SDmitry Torokhov 			unsigned int type, unsigned int code, int value)
1551da177e4SLinus Torvalds {
156b356872fSDmitry Torokhov 	struct sunkbd *sunkbd = input_get_drvdata(dev);
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds 	switch (type) {
1591da177e4SLinus Torvalds 
1601da177e4SLinus Torvalds 	case EV_LED:
1611da177e4SLinus Torvalds 
162dd0d5443SDmitry Torokhov 		serio_write(sunkbd->serio, SUNKBD_CMD_SETLED);
163dd0d5443SDmitry Torokhov 		serio_write(sunkbd->serio,
1647cac9cd9SDmitry Torokhov 			(!!test_bit(LED_CAPSL,   dev->led) << 3) |
1657cac9cd9SDmitry Torokhov 			(!!test_bit(LED_SCROLLL, dev->led) << 2) |
1667cac9cd9SDmitry Torokhov 			(!!test_bit(LED_COMPOSE, dev->led) << 1) |
1677cac9cd9SDmitry Torokhov 			 !!test_bit(LED_NUML,    dev->led));
1681da177e4SLinus Torvalds 		return 0;
1691da177e4SLinus Torvalds 
1701da177e4SLinus Torvalds 	case EV_SND:
1711da177e4SLinus Torvalds 
1721da177e4SLinus Torvalds 		switch (code) {
1731da177e4SLinus Torvalds 
1741da177e4SLinus Torvalds 		case SND_CLICK:
175dd0d5443SDmitry Torokhov 			serio_write(sunkbd->serio, SUNKBD_CMD_NOCLICK - value);
1761da177e4SLinus Torvalds 			return 0;
1771da177e4SLinus Torvalds 
1781da177e4SLinus Torvalds 		case SND_BELL:
179dd0d5443SDmitry Torokhov 			serio_write(sunkbd->serio, SUNKBD_CMD_BELLOFF - value);
1801da177e4SLinus Torvalds 			return 0;
1811da177e4SLinus Torvalds 		}
1821da177e4SLinus Torvalds 
1831da177e4SLinus Torvalds 		break;
1841da177e4SLinus Torvalds 	}
1851da177e4SLinus Torvalds 
1861da177e4SLinus Torvalds 	return -1;
1871da177e4SLinus Torvalds }
1881da177e4SLinus Torvalds 
1891da177e4SLinus Torvalds /*
1901da177e4SLinus Torvalds  * sunkbd_initialize() checks for a Sun keyboard attached, and determines
1911da177e4SLinus Torvalds  * its type.
1921da177e4SLinus Torvalds  */
1931da177e4SLinus Torvalds 
1941da177e4SLinus Torvalds static int sunkbd_initialize(struct sunkbd *sunkbd)
1951da177e4SLinus Torvalds {
1961da177e4SLinus Torvalds 	sunkbd->reset = -2;
197dd0d5443SDmitry Torokhov 	serio_write(sunkbd->serio, SUNKBD_CMD_RESET);
1981da177e4SLinus Torvalds 	wait_event_interruptible_timeout(sunkbd->wait, sunkbd->reset >= 0, HZ);
1991da177e4SLinus Torvalds 	if (sunkbd->reset < 0)
2001da177e4SLinus Torvalds 		return -1;
2011da177e4SLinus Torvalds 
2021da177e4SLinus Torvalds 	sunkbd->type = sunkbd->reset;
2031da177e4SLinus Torvalds 
2041da177e4SLinus Torvalds 	if (sunkbd->type == 4) {	/* Type 4 keyboard */
2051da177e4SLinus Torvalds 		sunkbd->layout = -2;
206dd0d5443SDmitry Torokhov 		serio_write(sunkbd->serio, SUNKBD_CMD_LAYOUT);
2077cac9cd9SDmitry Torokhov 		wait_event_interruptible_timeout(sunkbd->wait,
2087cac9cd9SDmitry Torokhov 						 sunkbd->layout >= 0, HZ / 4);
2097cac9cd9SDmitry Torokhov 		if (sunkbd->layout < 0)
2107cac9cd9SDmitry Torokhov 			return -1;
2117cac9cd9SDmitry Torokhov 		if (sunkbd->layout & SUNKBD_LAYOUT_5_MASK)
2127cac9cd9SDmitry Torokhov 			sunkbd->type = 5;
2131da177e4SLinus Torvalds 	}
2141da177e4SLinus Torvalds 
2151da177e4SLinus Torvalds 	return 0;
2161da177e4SLinus Torvalds }
2171da177e4SLinus Torvalds 
2181da177e4SLinus Torvalds /*
2191da177e4SLinus Torvalds  * sunkbd_reinit() sets leds and beeps to a state the computer remembers they
2201da177e4SLinus Torvalds  * were in.
2211da177e4SLinus Torvalds  */
2221da177e4SLinus Torvalds 
223c4028958SDavid Howells static void sunkbd_reinit(struct work_struct *work)
2241da177e4SLinus Torvalds {
225c4028958SDavid Howells 	struct sunkbd *sunkbd = container_of(work, struct sunkbd, tq);
2261da177e4SLinus Torvalds 
2271da177e4SLinus Torvalds 	wait_event_interruptible_timeout(sunkbd->wait, sunkbd->reset >= 0, HZ);
2281da177e4SLinus Torvalds 
229dd0d5443SDmitry Torokhov 	serio_write(sunkbd->serio, SUNKBD_CMD_SETLED);
230dd0d5443SDmitry Torokhov 	serio_write(sunkbd->serio,
231dd0d5443SDmitry Torokhov 		(!!test_bit(LED_CAPSL,   sunkbd->dev->led) << 3) |
232dd0d5443SDmitry Torokhov 		(!!test_bit(LED_SCROLLL, sunkbd->dev->led) << 2) |
233dd0d5443SDmitry Torokhov 		(!!test_bit(LED_COMPOSE, sunkbd->dev->led) << 1) |
234dd0d5443SDmitry Torokhov 		 !!test_bit(LED_NUML,    sunkbd->dev->led));
2357cac9cd9SDmitry Torokhov 	serio_write(sunkbd->serio,
2367cac9cd9SDmitry Torokhov 		SUNKBD_CMD_NOCLICK - !!test_bit(SND_CLICK, sunkbd->dev->snd));
2377cac9cd9SDmitry Torokhov 	serio_write(sunkbd->serio,
2387cac9cd9SDmitry Torokhov 		SUNKBD_CMD_BELLOFF - !!test_bit(SND_BELL, sunkbd->dev->snd));
2393c42f0c3SDmitry Torokhov }
2403c42f0c3SDmitry Torokhov 
2417cac9cd9SDmitry Torokhov static void sunkbd_enable(struct sunkbd *sunkbd, bool enable)
2423c42f0c3SDmitry Torokhov {
2433c42f0c3SDmitry Torokhov 	serio_pause_rx(sunkbd->serio);
2449bc83dcfSFabrice Knevez 	sunkbd->enabled = enable;
2453c42f0c3SDmitry Torokhov 	serio_continue_rx(sunkbd->serio);
2461da177e4SLinus Torvalds }
2471da177e4SLinus Torvalds 
2481da177e4SLinus Torvalds /*
2497cac9cd9SDmitry Torokhov  * sunkbd_connect() probes for a Sun keyboard and fills the necessary
2507cac9cd9SDmitry Torokhov  * structures.
2511da177e4SLinus Torvalds  */
2521da177e4SLinus Torvalds 
2531da177e4SLinus Torvalds static int sunkbd_connect(struct serio *serio, struct serio_driver *drv)
2541da177e4SLinus Torvalds {
2551da177e4SLinus Torvalds 	struct sunkbd *sunkbd;
2563c42f0c3SDmitry Torokhov 	struct input_dev *input_dev;
2573c42f0c3SDmitry Torokhov 	int err = -ENOMEM;
2581da177e4SLinus Torvalds 	int i;
2591da177e4SLinus Torvalds 
2603c42f0c3SDmitry Torokhov 	sunkbd = kzalloc(sizeof(struct sunkbd), GFP_KERNEL);
2613c42f0c3SDmitry Torokhov 	input_dev = input_allocate_device();
2623c42f0c3SDmitry Torokhov 	if (!sunkbd || !input_dev)
2632b03b60eSDmitry Torokhov 		goto fail1;
2641da177e4SLinus Torvalds 
2651da177e4SLinus Torvalds 	sunkbd->serio = serio;
2663c42f0c3SDmitry Torokhov 	sunkbd->dev = input_dev;
2673c42f0c3SDmitry Torokhov 	init_waitqueue_head(&sunkbd->wait);
268c4028958SDavid Howells 	INIT_WORK(&sunkbd->tq, sunkbd_reinit);
2693c42f0c3SDmitry Torokhov 	snprintf(sunkbd->phys, sizeof(sunkbd->phys), "%s/input0", serio->phys);
2701da177e4SLinus Torvalds 
2711da177e4SLinus Torvalds 	serio_set_drvdata(serio, sunkbd);
2721da177e4SLinus Torvalds 
2731da177e4SLinus Torvalds 	err = serio_open(serio, drv);
2743c42f0c3SDmitry Torokhov 	if (err)
2752b03b60eSDmitry Torokhov 		goto fail2;
2761da177e4SLinus Torvalds 
2771da177e4SLinus Torvalds 	if (sunkbd_initialize(sunkbd) < 0) {
2782b03b60eSDmitry Torokhov 		err = -ENODEV;
2792b03b60eSDmitry Torokhov 		goto fail3;
2801da177e4SLinus Torvalds 	}
2811da177e4SLinus Torvalds 
2827cac9cd9SDmitry Torokhov 	snprintf(sunkbd->name, sizeof(sunkbd->name),
2837cac9cd9SDmitry Torokhov 		 "Sun Type %d keyboard", sunkbd->type);
2841da177e4SLinus Torvalds 	memcpy(sunkbd->keycode, sunkbd_keycode, sizeof(sunkbd->keycode));
2853c42f0c3SDmitry Torokhov 
2863c42f0c3SDmitry Torokhov 	input_dev->name = sunkbd->name;
2873c42f0c3SDmitry Torokhov 	input_dev->phys = sunkbd->phys;
2883c42f0c3SDmitry Torokhov 	input_dev->id.bustype = BUS_RS232;
2893c42f0c3SDmitry Torokhov 	input_dev->id.vendor  = SERIO_SUNKBD;
2903c42f0c3SDmitry Torokhov 	input_dev->id.product = sunkbd->type;
2913c42f0c3SDmitry Torokhov 	input_dev->id.version = 0x0100;
292469ba4dfSDmitry Torokhov 	input_dev->dev.parent = &serio->dev;
293b356872fSDmitry Torokhov 
294b356872fSDmitry Torokhov 	input_set_drvdata(input_dev, sunkbd);
295b356872fSDmitry Torokhov 
2963c42f0c3SDmitry Torokhov 	input_dev->event = sunkbd_event;
2973c42f0c3SDmitry Torokhov 
2987b19ada2SJiri Slaby 	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_LED) |
2997b19ada2SJiri Slaby 		BIT_MASK(EV_SND) | BIT_MASK(EV_REP);
3007b19ada2SJiri Slaby 	input_dev->ledbit[0] = BIT_MASK(LED_CAPSL) | BIT_MASK(LED_COMPOSE) |
3017b19ada2SJiri Slaby 		BIT_MASK(LED_SCROLLL) | BIT_MASK(LED_NUML);
3027b19ada2SJiri Slaby 	input_dev->sndbit[0] = BIT_MASK(SND_CLICK) | BIT_MASK(SND_BELL);
3033c42f0c3SDmitry Torokhov 
3043c42f0c3SDmitry Torokhov 	input_dev->keycode = sunkbd->keycode;
3053c42f0c3SDmitry Torokhov 	input_dev->keycodesize = sizeof(unsigned char);
3063c42f0c3SDmitry Torokhov 	input_dev->keycodemax = ARRAY_SIZE(sunkbd_keycode);
3077cac9cd9SDmitry Torokhov 	for (i = 0; i < ARRAY_SIZE(sunkbd_keycode); i++)
3087cac9cd9SDmitry Torokhov 		__set_bit(sunkbd->keycode[i], input_dev->keybit);
3097cac9cd9SDmitry Torokhov 	__clear_bit(KEY_RESERVED, input_dev->keybit);
3101da177e4SLinus Torvalds 
3117cac9cd9SDmitry Torokhov 	sunkbd_enable(sunkbd, true);
3122b03b60eSDmitry Torokhov 
3132b03b60eSDmitry Torokhov 	err = input_register_device(sunkbd->dev);
3142b03b60eSDmitry Torokhov 	if (err)
3152b03b60eSDmitry Torokhov 		goto fail4;
3162b03b60eSDmitry Torokhov 
3171da177e4SLinus Torvalds 	return 0;
3183c42f0c3SDmitry Torokhov 
3197cac9cd9SDmitry Torokhov  fail4:	sunkbd_enable(sunkbd, false);
3202b03b60eSDmitry Torokhov  fail3:	serio_close(serio);
3212b03b60eSDmitry Torokhov  fail2:	serio_set_drvdata(serio, NULL);
3222b03b60eSDmitry Torokhov  fail1:	input_free_device(input_dev);
3233c42f0c3SDmitry Torokhov 	kfree(sunkbd);
3243c42f0c3SDmitry Torokhov 	return err;
3251da177e4SLinus Torvalds }
3261da177e4SLinus Torvalds 
3271da177e4SLinus Torvalds /*
3281da177e4SLinus Torvalds  * sunkbd_disconnect() unregisters and closes behind us.
3291da177e4SLinus Torvalds  */
3301da177e4SLinus Torvalds 
3311da177e4SLinus Torvalds static void sunkbd_disconnect(struct serio *serio)
3321da177e4SLinus Torvalds {
3331da177e4SLinus Torvalds 	struct sunkbd *sunkbd = serio_get_drvdata(serio);
3343c42f0c3SDmitry Torokhov 
3357cac9cd9SDmitry Torokhov 	sunkbd_enable(sunkbd, false);
3363c42f0c3SDmitry Torokhov 	input_unregister_device(sunkbd->dev);
3371da177e4SLinus Torvalds 	serio_close(serio);
3381da177e4SLinus Torvalds 	serio_set_drvdata(serio, NULL);
3391da177e4SLinus Torvalds 	kfree(sunkbd);
3401da177e4SLinus Torvalds }
3411da177e4SLinus Torvalds 
3421966e005SArvind Yadav static const struct serio_device_id sunkbd_serio_ids[] = {
3431da177e4SLinus Torvalds 	{
3441da177e4SLinus Torvalds 		.type	= SERIO_RS232,
3451da177e4SLinus Torvalds 		.proto	= SERIO_SUNKBD,
3461da177e4SLinus Torvalds 		.id	= SERIO_ANY,
3471da177e4SLinus Torvalds 		.extra	= SERIO_ANY,
3481da177e4SLinus Torvalds 	},
3491da177e4SLinus Torvalds 	{
3501da177e4SLinus Torvalds 		.type	= SERIO_RS232,
3511da177e4SLinus Torvalds 		.proto	= SERIO_UNKNOWN, /* sunkbd does probe */
3521da177e4SLinus Torvalds 		.id	= SERIO_ANY,
3531da177e4SLinus Torvalds 		.extra	= SERIO_ANY,
3541da177e4SLinus Torvalds 	},
3551da177e4SLinus Torvalds 	{ 0 }
3561da177e4SLinus Torvalds };
3571da177e4SLinus Torvalds 
3581da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, sunkbd_serio_ids);
3591da177e4SLinus Torvalds 
3601da177e4SLinus Torvalds static struct serio_driver sunkbd_drv = {
3611da177e4SLinus Torvalds 	.driver		= {
3621da177e4SLinus Torvalds 		.name	= "sunkbd",
3631da177e4SLinus Torvalds 	},
3641da177e4SLinus Torvalds 	.description	= DRIVER_DESC,
3651da177e4SLinus Torvalds 	.id_table	= sunkbd_serio_ids,
3661da177e4SLinus Torvalds 	.interrupt	= sunkbd_interrupt,
3671da177e4SLinus Torvalds 	.connect	= sunkbd_connect,
3681da177e4SLinus Torvalds 	.disconnect	= sunkbd_disconnect,
3691da177e4SLinus Torvalds };
3701da177e4SLinus Torvalds 
37165ac9f7aSAxel Lin module_serio_driver(sunkbd_drv);
372