PageRenderTime 28ms CodeModel.GetById 9ms app.highlight 14ms RepoModel.GetById 1ms app.codeStats 1ms

/drivers/input/mouse/logibm.c

http://github.com/mirrors/linux
C | 169 lines | 120 code | 33 blank | 16 comment | 6 complexity | 924e64fc5fa717769a321669788d0649 MD5 | raw file
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 *  Copyright (c) 1999-2001 Vojtech Pavlik
  4 *
  5 *  Based on the work of:
  6 *	James Banks		Matthew Dillon
  7 *	David Giller		Nathan Laredo
  8 *	Linus Torvalds		Johan Myreen
  9 *	Cliff Matthews		Philip Blundell
 10 *	Russell King
 11 */
 12
 13/*
 14 * Logitech Bus Mouse Driver for Linux
 15 */
 16
 17/*
 18 */
 19
 20#include <linux/module.h>
 21#include <linux/delay.h>
 22#include <linux/ioport.h>
 23#include <linux/init.h>
 24#include <linux/input.h>
 25#include <linux/interrupt.h>
 26
 27#include <asm/io.h>
 28#include <asm/irq.h>
 29
 30MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
 31MODULE_DESCRIPTION("Logitech busmouse driver");
 32MODULE_LICENSE("GPL");
 33
 34#define	LOGIBM_BASE		0x23c
 35#define	LOGIBM_EXTENT		4
 36
 37#define	LOGIBM_DATA_PORT	LOGIBM_BASE + 0
 38#define	LOGIBM_SIGNATURE_PORT	LOGIBM_BASE + 1
 39#define	LOGIBM_CONTROL_PORT	LOGIBM_BASE + 2
 40#define	LOGIBM_CONFIG_PORT	LOGIBM_BASE + 3
 41
 42#define	LOGIBM_ENABLE_IRQ	0x00
 43#define	LOGIBM_DISABLE_IRQ	0x10
 44#define	LOGIBM_READ_X_LOW	0x80
 45#define	LOGIBM_READ_X_HIGH	0xa0
 46#define	LOGIBM_READ_Y_LOW	0xc0
 47#define	LOGIBM_READ_Y_HIGH	0xe0
 48
 49#define LOGIBM_DEFAULT_MODE	0x90
 50#define LOGIBM_CONFIG_BYTE	0x91
 51#define LOGIBM_SIGNATURE_BYTE	0xa5
 52
 53#define LOGIBM_IRQ		5
 54
 55static int logibm_irq = LOGIBM_IRQ;
 56module_param_hw_named(irq, logibm_irq, uint, irq, 0);
 57MODULE_PARM_DESC(irq, "IRQ number (5=default)");
 58
 59static struct input_dev *logibm_dev;
 60
 61static irqreturn_t logibm_interrupt(int irq, void *dev_id)
 62{
 63	char dx, dy;
 64	unsigned char buttons;
 65
 66	outb(LOGIBM_READ_X_LOW, LOGIBM_CONTROL_PORT);
 67	dx = (inb(LOGIBM_DATA_PORT) & 0xf);
 68	outb(LOGIBM_READ_X_HIGH, LOGIBM_CONTROL_PORT);
 69	dx |= (inb(LOGIBM_DATA_PORT) & 0xf) << 4;
 70	outb(LOGIBM_READ_Y_LOW, LOGIBM_CONTROL_PORT);
 71	dy = (inb(LOGIBM_DATA_PORT) & 0xf);
 72	outb(LOGIBM_READ_Y_HIGH, LOGIBM_CONTROL_PORT);
 73	buttons = inb(LOGIBM_DATA_PORT);
 74	dy |= (buttons & 0xf) << 4;
 75	buttons = ~buttons >> 5;
 76
 77	input_report_rel(logibm_dev, REL_X, dx);
 78	input_report_rel(logibm_dev, REL_Y, dy);
 79	input_report_key(logibm_dev, BTN_RIGHT,  buttons & 1);
 80	input_report_key(logibm_dev, BTN_MIDDLE, buttons & 2);
 81	input_report_key(logibm_dev, BTN_LEFT,   buttons & 4);
 82	input_sync(logibm_dev);
 83
 84	outb(LOGIBM_ENABLE_IRQ, LOGIBM_CONTROL_PORT);
 85	return IRQ_HANDLED;
 86}
 87
 88static int logibm_open(struct input_dev *dev)
 89{
 90	if (request_irq(logibm_irq, logibm_interrupt, 0, "logibm", NULL)) {
 91		printk(KERN_ERR "logibm.c: Can't allocate irq %d\n", logibm_irq);
 92		return -EBUSY;
 93	}
 94	outb(LOGIBM_ENABLE_IRQ, LOGIBM_CONTROL_PORT);
 95	return 0;
 96}
 97
 98static void logibm_close(struct input_dev *dev)
 99{
100	outb(LOGIBM_DISABLE_IRQ, LOGIBM_CONTROL_PORT);
101	free_irq(logibm_irq, NULL);
102}
103
104static int __init logibm_init(void)
105{
106	int err;
107
108	if (!request_region(LOGIBM_BASE, LOGIBM_EXTENT, "logibm")) {
109		printk(KERN_ERR "logibm.c: Can't allocate ports at %#x\n", LOGIBM_BASE);
110		return -EBUSY;
111	}
112
113	outb(LOGIBM_CONFIG_BYTE, LOGIBM_CONFIG_PORT);
114	outb(LOGIBM_SIGNATURE_BYTE, LOGIBM_SIGNATURE_PORT);
115	udelay(100);
116
117	if (inb(LOGIBM_SIGNATURE_PORT) != LOGIBM_SIGNATURE_BYTE) {
118		printk(KERN_INFO "logibm.c: Didn't find Logitech busmouse at %#x\n", LOGIBM_BASE);
119		err = -ENODEV;
120		goto err_release_region;
121	}
122
123	outb(LOGIBM_DEFAULT_MODE, LOGIBM_CONFIG_PORT);
124	outb(LOGIBM_DISABLE_IRQ, LOGIBM_CONTROL_PORT);
125
126	logibm_dev = input_allocate_device();
127	if (!logibm_dev) {
128		printk(KERN_ERR "logibm.c: Not enough memory for input device\n");
129		err = -ENOMEM;
130		goto err_release_region;
131	}
132
133	logibm_dev->name = "Logitech bus mouse";
134	logibm_dev->phys = "isa023c/input0";
135	logibm_dev->id.bustype = BUS_ISA;
136	logibm_dev->id.vendor  = 0x0003;
137	logibm_dev->id.product = 0x0001;
138	logibm_dev->id.version = 0x0100;
139
140	logibm_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
141	logibm_dev->keybit[BIT_WORD(BTN_LEFT)] = BIT_MASK(BTN_LEFT) |
142		BIT_MASK(BTN_MIDDLE) | BIT_MASK(BTN_RIGHT);
143	logibm_dev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
144
145	logibm_dev->open  = logibm_open;
146	logibm_dev->close = logibm_close;
147
148	err = input_register_device(logibm_dev);
149	if (err)
150		goto err_free_dev;
151
152	return 0;
153
154 err_free_dev:
155	input_free_device(logibm_dev);
156 err_release_region:
157	release_region(LOGIBM_BASE, LOGIBM_EXTENT);
158
159	return err;
160}
161
162static void __exit logibm_exit(void)
163{
164	input_unregister_device(logibm_dev);
165	release_region(LOGIBM_BASE, LOGIBM_EXTENT);
166}
167
168module_init(logibm_init);
169module_exit(logibm_exit);