ea08c6faa0
Change all sprintfs into snprintfs to make sure we won't stomp on data adjacent to our buffers. Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
361 lines
9.3 KiB
C
361 lines
9.3 KiB
C
/*
|
|
* $Id: sunkbd.c,v 1.14 2001/09/25 10:12:07 vojtech Exp $
|
|
*
|
|
* Copyright (c) 1999-2001 Vojtech Pavlik
|
|
*/
|
|
|
|
/*
|
|
* Sun keyboard driver for Linux
|
|
*/
|
|
|
|
/*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
* Should you need to contact me, the author, you can do so either by
|
|
* e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
|
|
* Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/init.h>
|
|
#include <linux/input.h>
|
|
#include <linux/serio.h>
|
|
#include <linux/workqueue.h>
|
|
|
|
#define DRIVER_DESC "Sun keyboard driver"
|
|
|
|
MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static unsigned char sunkbd_keycode[128] = {
|
|
0,128,114,129,115, 59, 60, 68, 61, 87, 62, 88, 63,100, 64,112,
|
|
65, 66, 67, 56,103,119, 99, 70,105,130,131,108,106, 1, 2, 3,
|
|
4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 41, 14,110,113, 98, 55,
|
|
116,132, 83,133,102, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25,
|
|
26, 27,111,127, 71, 72, 73, 74,134,135,107, 0, 29, 30, 31, 32,
|
|
33, 34, 35, 36, 37, 38, 39, 40, 43, 28, 96, 75, 76, 77, 82,136,
|
|
104,137, 69, 42, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54,101,
|
|
79, 80, 81, 0, 0, 0,138, 58,125, 57,126,109, 86, 78
|
|
};
|
|
|
|
#define SUNKBD_CMD_RESET 0x1
|
|
#define SUNKBD_CMD_BELLON 0x2
|
|
#define SUNKBD_CMD_BELLOFF 0x3
|
|
#define SUNKBD_CMD_CLICK 0xa
|
|
#define SUNKBD_CMD_NOCLICK 0xb
|
|
#define SUNKBD_CMD_SETLED 0xe
|
|
#define SUNKBD_CMD_LAYOUT 0xf
|
|
|
|
#define SUNKBD_RET_RESET 0xff
|
|
#define SUNKBD_RET_ALLUP 0x7f
|
|
#define SUNKBD_RET_LAYOUT 0xfe
|
|
|
|
#define SUNKBD_LAYOUT_5_MASK 0x20
|
|
#define SUNKBD_RELEASE 0x80
|
|
#define SUNKBD_KEY 0x7f
|
|
|
|
/*
|
|
* Per-keyboard data.
|
|
*/
|
|
|
|
struct sunkbd {
|
|
unsigned char keycode[128];
|
|
struct input_dev *dev;
|
|
struct serio *serio;
|
|
struct work_struct tq;
|
|
wait_queue_head_t wait;
|
|
char name[64];
|
|
char phys[32];
|
|
char type;
|
|
unsigned char enabled;
|
|
volatile s8 reset;
|
|
volatile s8 layout;
|
|
};
|
|
|
|
/*
|
|
* sunkbd_interrupt() is called by the low level driver when a character
|
|
* is received.
|
|
*/
|
|
|
|
static irqreturn_t sunkbd_interrupt(struct serio *serio,
|
|
unsigned char data, unsigned int flags, struct pt_regs *regs)
|
|
{
|
|
struct sunkbd* sunkbd = serio_get_drvdata(serio);
|
|
|
|
if (sunkbd->reset <= -1) { /* If cp[i] is 0xff, sunkbd->reset will stay -1. */
|
|
sunkbd->reset = data; /* The keyboard sends 0xff 0xff 0xID on powerup */
|
|
wake_up_interruptible(&sunkbd->wait);
|
|
goto out;
|
|
}
|
|
|
|
if (sunkbd->layout == -1) {
|
|
sunkbd->layout = data;
|
|
wake_up_interruptible(&sunkbd->wait);
|
|
goto out;
|
|
}
|
|
|
|
switch (data) {
|
|
|
|
case SUNKBD_RET_RESET:
|
|
schedule_work(&sunkbd->tq);
|
|
sunkbd->reset = -1;
|
|
break;
|
|
|
|
case SUNKBD_RET_LAYOUT:
|
|
sunkbd->layout = -1;
|
|
break;
|
|
|
|
case SUNKBD_RET_ALLUP: /* All keys released */
|
|
break;
|
|
|
|
default:
|
|
if (!sunkbd->enabled)
|
|
break;
|
|
|
|
if (sunkbd->keycode[data & SUNKBD_KEY]) {
|
|
input_regs(sunkbd->dev, regs);
|
|
input_report_key(sunkbd->dev, sunkbd->keycode[data & SUNKBD_KEY], !(data & SUNKBD_RELEASE));
|
|
input_sync(sunkbd->dev);
|
|
} else {
|
|
printk(KERN_WARNING "sunkbd.c: Unknown key (scancode %#x) %s.\n",
|
|
data & SUNKBD_KEY, data & SUNKBD_RELEASE ? "released" : "pressed");
|
|
}
|
|
}
|
|
out:
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/*
|
|
* sunkbd_event() handles events from the input module.
|
|
*/
|
|
|
|
static int sunkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
|
{
|
|
struct sunkbd *sunkbd = dev->private;
|
|
|
|
switch (type) {
|
|
|
|
case EV_LED:
|
|
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_SETLED);
|
|
sunkbd->serio->write(sunkbd->serio,
|
|
(!!test_bit(LED_CAPSL, dev->led) << 3) | (!!test_bit(LED_SCROLLL, dev->led) << 2) |
|
|
(!!test_bit(LED_COMPOSE, dev->led) << 1) | !!test_bit(LED_NUML, dev->led));
|
|
return 0;
|
|
|
|
case EV_SND:
|
|
|
|
switch (code) {
|
|
|
|
case SND_CLICK:
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_NOCLICK - value);
|
|
return 0;
|
|
|
|
case SND_BELL:
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_BELLOFF - value);
|
|
return 0;
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
/*
|
|
* sunkbd_initialize() checks for a Sun keyboard attached, and determines
|
|
* its type.
|
|
*/
|
|
|
|
static int sunkbd_initialize(struct sunkbd *sunkbd)
|
|
{
|
|
sunkbd->reset = -2;
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_RESET);
|
|
wait_event_interruptible_timeout(sunkbd->wait, sunkbd->reset >= 0, HZ);
|
|
if (sunkbd->reset < 0)
|
|
return -1;
|
|
|
|
sunkbd->type = sunkbd->reset;
|
|
|
|
if (sunkbd->type == 4) { /* Type 4 keyboard */
|
|
sunkbd->layout = -2;
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_LAYOUT);
|
|
wait_event_interruptible_timeout(sunkbd->wait, sunkbd->layout >= 0, HZ/4);
|
|
if (sunkbd->layout < 0) return -1;
|
|
if (sunkbd->layout & SUNKBD_LAYOUT_5_MASK) sunkbd->type = 5;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* sunkbd_reinit() sets leds and beeps to a state the computer remembers they
|
|
* were in.
|
|
*/
|
|
|
|
static void sunkbd_reinit(void *data)
|
|
{
|
|
struct sunkbd *sunkbd = data;
|
|
|
|
wait_event_interruptible_timeout(sunkbd->wait, sunkbd->reset >= 0, HZ);
|
|
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_SETLED);
|
|
sunkbd->serio->write(sunkbd->serio,
|
|
(!!test_bit(LED_CAPSL, sunkbd->dev->led) << 3) | (!!test_bit(LED_SCROLLL, sunkbd->dev->led) << 2) |
|
|
(!!test_bit(LED_COMPOSE, sunkbd->dev->led) << 1) | !!test_bit(LED_NUML, sunkbd->dev->led));
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_NOCLICK - !!test_bit(SND_CLICK, sunkbd->dev->snd));
|
|
sunkbd->serio->write(sunkbd->serio, SUNKBD_CMD_BELLOFF - !!test_bit(SND_BELL, sunkbd->dev->snd));
|
|
}
|
|
|
|
static void sunkbd_enable(struct sunkbd *sunkbd, int enable)
|
|
{
|
|
serio_pause_rx(sunkbd->serio);
|
|
sunkbd->enabled = 1;
|
|
serio_continue_rx(sunkbd->serio);
|
|
}
|
|
|
|
/*
|
|
* sunkbd_connect() probes for a Sun keyboard and fills the necessary structures.
|
|
*/
|
|
|
|
static int sunkbd_connect(struct serio *serio, struct serio_driver *drv)
|
|
{
|
|
struct sunkbd *sunkbd;
|
|
struct input_dev *input_dev;
|
|
int err = -ENOMEM;
|
|
int i;
|
|
|
|
sunkbd = kzalloc(sizeof(struct sunkbd), GFP_KERNEL);
|
|
input_dev = input_allocate_device();
|
|
if (!sunkbd || !input_dev)
|
|
goto fail;
|
|
|
|
sunkbd->serio = serio;
|
|
sunkbd->dev = input_dev;
|
|
init_waitqueue_head(&sunkbd->wait);
|
|
INIT_WORK(&sunkbd->tq, sunkbd_reinit, sunkbd);
|
|
snprintf(sunkbd->phys, sizeof(sunkbd->phys), "%s/input0", serio->phys);
|
|
|
|
serio_set_drvdata(serio, sunkbd);
|
|
|
|
err = serio_open(serio, drv);
|
|
if (err)
|
|
goto fail;
|
|
|
|
if (sunkbd_initialize(sunkbd) < 0) {
|
|
serio_close(serio);
|
|
goto fail;
|
|
}
|
|
|
|
snprintf(sunkbd->name, sizeof(sunkbd->name), "Sun Type %d keyboard", sunkbd->type);
|
|
memcpy(sunkbd->keycode, sunkbd_keycode, sizeof(sunkbd->keycode));
|
|
|
|
input_dev->name = sunkbd->name;
|
|
input_dev->phys = sunkbd->phys;
|
|
input_dev->id.bustype = BUS_RS232;
|
|
input_dev->id.vendor = SERIO_SUNKBD;
|
|
input_dev->id.product = sunkbd->type;
|
|
input_dev->id.version = 0x0100;
|
|
input_dev->cdev.dev = &serio->dev;
|
|
input_dev->private = sunkbd;
|
|
input_dev->event = sunkbd_event;
|
|
|
|
input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_LED) | BIT(EV_SND) | BIT(EV_REP);
|
|
input_dev->ledbit[0] = BIT(LED_CAPSL) | BIT(LED_COMPOSE) | BIT(LED_SCROLLL) | BIT(LED_NUML);
|
|
input_dev->sndbit[0] = BIT(SND_CLICK) | BIT(SND_BELL);
|
|
|
|
input_dev->keycode = sunkbd->keycode;
|
|
input_dev->keycodesize = sizeof(unsigned char);
|
|
input_dev->keycodemax = ARRAY_SIZE(sunkbd_keycode);
|
|
for (i = 0; i < 128; i++)
|
|
set_bit(sunkbd->keycode[i], input_dev->keybit);
|
|
clear_bit(0, input_dev->keybit);
|
|
|
|
sunkbd_enable(sunkbd, 1);
|
|
input_register_device(sunkbd->dev);
|
|
return 0;
|
|
|
|
fail: serio_set_drvdata(serio, NULL);
|
|
input_free_device(input_dev);
|
|
kfree(sunkbd);
|
|
return err;
|
|
}
|
|
|
|
/*
|
|
* sunkbd_disconnect() unregisters and closes behind us.
|
|
*/
|
|
|
|
static void sunkbd_disconnect(struct serio *serio)
|
|
{
|
|
struct sunkbd *sunkbd = serio_get_drvdata(serio);
|
|
|
|
sunkbd_enable(sunkbd, 0);
|
|
input_unregister_device(sunkbd->dev);
|
|
serio_close(serio);
|
|
serio_set_drvdata(serio, NULL);
|
|
kfree(sunkbd);
|
|
}
|
|
|
|
static struct serio_device_id sunkbd_serio_ids[] = {
|
|
{
|
|
.type = SERIO_RS232,
|
|
.proto = SERIO_SUNKBD,
|
|
.id = SERIO_ANY,
|
|
.extra = SERIO_ANY,
|
|
},
|
|
{
|
|
.type = SERIO_RS232,
|
|
.proto = SERIO_UNKNOWN, /* sunkbd does probe */
|
|
.id = SERIO_ANY,
|
|
.extra = SERIO_ANY,
|
|
},
|
|
{ 0 }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(serio, sunkbd_serio_ids);
|
|
|
|
static struct serio_driver sunkbd_drv = {
|
|
.driver = {
|
|
.name = "sunkbd",
|
|
},
|
|
.description = DRIVER_DESC,
|
|
.id_table = sunkbd_serio_ids,
|
|
.interrupt = sunkbd_interrupt,
|
|
.connect = sunkbd_connect,
|
|
.disconnect = sunkbd_disconnect,
|
|
};
|
|
|
|
/*
|
|
* The functions for insering/removing us as a module.
|
|
*/
|
|
|
|
static int __init sunkbd_init(void)
|
|
{
|
|
serio_register_driver(&sunkbd_drv);
|
|
return 0;
|
|
}
|
|
|
|
static void __exit sunkbd_exit(void)
|
|
{
|
|
serio_unregister_driver(&sunkbd_drv);
|
|
}
|
|
|
|
module_init(sunkbd_init);
|
|
module_exit(sunkbd_exit);
|