Release 4.7 drivers/input/serio/pcips2.c

/*
 * linux/drivers/input/serio/pcips2.c
 *
 *  Copyright (C) 2003 Russell King, All Rights Reserved.
 *
 * 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.
 *
 *  I'm not sure if this is a generic PS/2 PCI interface or specific to
 *  the Mobility Electronics docking station.
 */
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/ioport.h>
#include <linux/input.h>
#include <linux/pci.h>
#include <linux/slab.h>
#include <linux/serio.h>
#include <linux/delay.h>
#include <asm/io.h>


#define PS2_CTRL		(0)

#define PS2_STATUS		(1)

#define PS2_DATA		(2)


#define PS2_CTRL_CLK		(1<<0)

#define PS2_CTRL_DAT		(1<<1)

#define PS2_CTRL_TXIRQ		(1<<2)

#define PS2_CTRL_ENABLE		(1<<3)

#define PS2_CTRL_RXIRQ		(1<<4)


#define PS2_STAT_CLK		(1<<0)

#define PS2_STAT_DAT		(1<<1)

#define PS2_STAT_PARITY		(1<<2)

#define PS2_STAT_RXFULL		(1<<5)

#define PS2_STAT_TXBUSY		(1<<6)

#define PS2_STAT_TXEMPTY	(1<<7)


struct pcips2_data {
	
struct serio	*io;
	
unsigned int	base;
	
struct pci_dev	*dev;
};



static int pcips2_write(struct serio *io, unsigned char val)
{
	struct pcips2_data *ps2if = io->port_data;
	unsigned int stat;

	do {
		stat = inb(ps2if->base + PS2_STATUS);
		cpu_relax();
	} while (!(stat & PS2_STAT_TXEMPTY));

	outb(val, ps2if->base + PS2_DATA);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
68
98.55%
1
50.00%
dmitry torokhov
dmitry torokhov
1
1.45%
1
50.00%
Total
69
100.00%
2
100.00%



static irqreturn_t pcips2_interrupt(int irq, void *devid)
{
	struct pcips2_data *ps2if = devid;
	unsigned char status, scancode;
	int handled = 0;

	do {
		unsigned int flag;

		status = inb(ps2if->base + PS2_STATUS);
		if (!(status & PS2_STAT_RXFULL))
			break;
		handled = 1;
		scancode = inb(ps2if->base + PS2_DATA);
		if (status == 0xff && scancode == 0xff)
			break;

		flag = (status & PS2_STAT_PARITY) ? 0 : SERIO_PARITY;

		if (hweight8(scancode) & 1)
			flag ^= SERIO_PARITY;

		serio_interrupt(ps2if->io, scancode, flag);
	} while (1);
	return IRQ_RETVAL(handled);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
116
87.88%
1
50.00%
andrew morton
andrew morton
16
12.12%
1
50.00%
Total
132
100.00%
2
100.00%



static void pcips2_flush_input(struct pcips2_data *ps2if)
{
	unsigned char status, scancode;

	do {
		status = inb(ps2if->base + PS2_STATUS);
		if (!(status & PS2_STAT_RXFULL))
			break;
		scancode = inb(ps2if->base + PS2_DATA);
		if (status == 0xff && scancode == 0xff)
			break;
	} while (1);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
68
100.00%
1
100.00%
Total
68
100.00%
1
100.00%



static int pcips2_open(struct serio *io)
{
	struct pcips2_data *ps2if = io->port_data;
	int ret, val = 0;

	outb(PS2_CTRL_ENABLE, ps2if->base);
	pcips2_flush_input(ps2if);

	ret = request_irq(ps2if->dev->irq, pcips2_interrupt, IRQF_SHARED,
			  "pcips2", ps2if);
	if (ret == 0)
		val = PS2_CTRL_ENABLE | PS2_CTRL_RXIRQ;

	outb(val, ps2if->base);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
82
97.62%
1
33.33%
thomas gleixner
thomas gleixner
1
1.19%
1
33.33%
dmitry torokhov
dmitry torokhov
1
1.19%
1
33.33%
Total
84
100.00%
3
100.00%



static void pcips2_close(struct serio *io)
{
	struct pcips2_data *ps2if = io->port_data;

	outb(0, ps2if->base);

	free_irq(ps2if->dev->irq, ps2if);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
39
97.50%
1
50.00%
dmitry torokhov
dmitry torokhov
1
2.50%
1
50.00%
Total
40
100.00%
2
100.00%



static int pcips2_probe(struct pci_dev *dev, const struct pci_device_id *id)
{
	struct pcips2_data *ps2if;
	struct serio *serio;
	int ret;

	ret = pci_enable_device(dev);
	if (ret)
		goto out;

	ret = pci_request_regions(dev, "pcips2");
	if (ret)
		goto disable;

	ps2if = kzalloc(sizeof(struct pcips2_data), GFP_KERNEL);
	serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
	if (!ps2if || !serio) {
		ret = -ENOMEM;
		goto release;
	}


	serio->id.type		= SERIO_8042;
	serio->write		= pcips2_write;
	serio->open		= pcips2_open;
	serio->close		= pcips2_close;
	strlcpy(serio->name, pci_name(dev), sizeof(serio->name));
	strlcpy(serio->phys, dev_name(&dev->dev), sizeof(serio->phys));
	serio->port_data	= ps2if;
	serio->dev.parent	= &dev->dev;
	ps2if->io		= serio;
	ps2if->dev		= dev;
	ps2if->base		= pci_resource_start(dev, 0);

	pci_set_drvdata(dev, ps2if);

	serio_register_port(ps2if->io);
	return 0;

 release:
	kfree(ps2if);
	kfree(serio);
	pci_release_regions(dev);
 disable:
	pci_disable_device(dev);
 out:
	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
169
65.76%
2
22.22%
dmitry torokhov
dmitry torokhov
79
30.74%
4
44.44%
kay sievers
kay sievers
4
1.56%
1
11.11%
david s. miller
david s. miller
3
1.17%
1
11.11%
yoann padioleau
yoann padioleau
2
0.78%
1
11.11%
Total
257
100.00%
9
100.00%



static void pcips2_remove(struct pci_dev *dev)
{
	struct pcips2_data *ps2if = pci_get_drvdata(dev);

	serio_unregister_port(ps2if->io);
	kfree(ps2if);
	pci_release_regions(dev);
	pci_disable_device(dev);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
43
100.00%
2
100.00%
Total
43
100.00%
2
100.00%


static const struct pci_device_id pcips2_ids[] = {
	{
		.vendor		= 0x14f2,	/* MOBILITY */
		.device		= 0x0123,	/* Keyboard */
		.subvendor	= PCI_ANY_ID,
		.subdevice	= PCI_ANY_ID,
		.class		= PCI_CLASS_INPUT_KEYBOARD << 8,
		.class_mask	= 0xffff00,
        },
	{
		.vendor		= 0x14f2,	/* MOBILITY */
		.device		= 0x0124,	/* Mouse */
		.subvendor	= PCI_ANY_ID,
		.subdevice	= PCI_ANY_ID,
		.class		= PCI_CLASS_INPUT_MOUSE << 8,
		.class_mask	= 0xffff00,
        },
	{ 0, }
};
MODULE_DEVICE_TABLE(pci, pcips2_ids);


static struct pci_driver pcips2_driver = {
	.name			= "pcips2",
	.id_table		= pcips2_ids,
	.probe			= pcips2_probe,
	.remove			= pcips2_remove,
};


module_pci_driver(pcips2_driver);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
MODULE_DESCRIPTION("PCI PS/2 keyboard/mouse driver");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
russell king
russell king
813
86.95%
2
14.29%
dmitry torokhov
dmitry torokhov
83
8.88%
4
28.57%
andrew morton
andrew morton
16
1.71%
1
7.14%
axel lin
axel lin
9
0.96%
1
7.14%
kay sievers
kay sievers
4
0.43%
1
7.14%
david s. miller
david s. miller
3
0.32%
1
7.14%
tejun heo
tejun heo
3
0.32%
1
7.14%
yoann padioleau
yoann padioleau
2
0.21%
1
7.14%
thomas gleixner
thomas gleixner
1
0.11%
1
7.14%
marton nemeth
marton nemeth
1
0.11%
1
7.14%
Total
935
100.00%
14
100.00%
  
Directory: drivers/input/serio

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.