This source file includes following definitions.
- pcips2_write
- pcips2_interrupt
- pcips2_flush_input
- pcips2_open
- pcips2_close
- pcips2_probe
- pcips2_remove
1
2
3
4
5
6
7
8
9
10 #include <linux/module.h>
11 #include <linux/interrupt.h>
12 #include <linux/ioport.h>
13 #include <linux/input.h>
14 #include <linux/pci.h>
15 #include <linux/slab.h>
16 #include <linux/serio.h>
17 #include <linux/delay.h>
18 #include <asm/io.h>
19
20 #define PS2_CTRL (0)
21 #define PS2_STATUS (1)
22 #define PS2_DATA (2)
23
24 #define PS2_CTRL_CLK (1<<0)
25 #define PS2_CTRL_DAT (1<<1)
26 #define PS2_CTRL_TXIRQ (1<<2)
27 #define PS2_CTRL_ENABLE (1<<3)
28 #define PS2_CTRL_RXIRQ (1<<4)
29
30 #define PS2_STAT_CLK (1<<0)
31 #define PS2_STAT_DAT (1<<1)
32 #define PS2_STAT_PARITY (1<<2)
33 #define PS2_STAT_RXFULL (1<<5)
34 #define PS2_STAT_TXBUSY (1<<6)
35 #define PS2_STAT_TXEMPTY (1<<7)
36
37 struct pcips2_data {
38 struct serio *io;
39 unsigned int base;
40 struct pci_dev *dev;
41 };
42
43 static int pcips2_write(struct serio *io, unsigned char val)
44 {
45 struct pcips2_data *ps2if = io->port_data;
46 unsigned int stat;
47
48 do {
49 stat = inb(ps2if->base + PS2_STATUS);
50 cpu_relax();
51 } while (!(stat & PS2_STAT_TXEMPTY));
52
53 outb(val, ps2if->base + PS2_DATA);
54
55 return 0;
56 }
57
58 static irqreturn_t pcips2_interrupt(int irq, void *devid)
59 {
60 struct pcips2_data *ps2if = devid;
61 unsigned char status, scancode;
62 int handled = 0;
63
64 do {
65 unsigned int flag;
66
67 status = inb(ps2if->base + PS2_STATUS);
68 if (!(status & PS2_STAT_RXFULL))
69 break;
70 handled = 1;
71 scancode = inb(ps2if->base + PS2_DATA);
72 if (status == 0xff && scancode == 0xff)
73 break;
74
75 flag = (status & PS2_STAT_PARITY) ? 0 : SERIO_PARITY;
76
77 if (hweight8(scancode) & 1)
78 flag ^= SERIO_PARITY;
79
80 serio_interrupt(ps2if->io, scancode, flag);
81 } while (1);
82 return IRQ_RETVAL(handled);
83 }
84
85 static void pcips2_flush_input(struct pcips2_data *ps2if)
86 {
87 unsigned char status, scancode;
88
89 do {
90 status = inb(ps2if->base + PS2_STATUS);
91 if (!(status & PS2_STAT_RXFULL))
92 break;
93 scancode = inb(ps2if->base + PS2_DATA);
94 if (status == 0xff && scancode == 0xff)
95 break;
96 } while (1);
97 }
98
99 static int pcips2_open(struct serio *io)
100 {
101 struct pcips2_data *ps2if = io->port_data;
102 int ret, val = 0;
103
104 outb(PS2_CTRL_ENABLE, ps2if->base);
105 pcips2_flush_input(ps2if);
106
107 ret = request_irq(ps2if->dev->irq, pcips2_interrupt, IRQF_SHARED,
108 "pcips2", ps2if);
109 if (ret == 0)
110 val = PS2_CTRL_ENABLE | PS2_CTRL_RXIRQ;
111
112 outb(val, ps2if->base);
113
114 return ret;
115 }
116
117 static void pcips2_close(struct serio *io)
118 {
119 struct pcips2_data *ps2if = io->port_data;
120
121 outb(0, ps2if->base);
122
123 free_irq(ps2if->dev->irq, ps2if);
124 }
125
126 static int pcips2_probe(struct pci_dev *dev, const struct pci_device_id *id)
127 {
128 struct pcips2_data *ps2if;
129 struct serio *serio;
130 int ret;
131
132 ret = pci_enable_device(dev);
133 if (ret)
134 goto out;
135
136 ret = pci_request_regions(dev, "pcips2");
137 if (ret)
138 goto disable;
139
140 ps2if = kzalloc(sizeof(struct pcips2_data), GFP_KERNEL);
141 serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
142 if (!ps2if || !serio) {
143 ret = -ENOMEM;
144 goto release;
145 }
146
147
148 serio->id.type = SERIO_8042;
149 serio->write = pcips2_write;
150 serio->open = pcips2_open;
151 serio->close = pcips2_close;
152 strlcpy(serio->name, pci_name(dev), sizeof(serio->name));
153 strlcpy(serio->phys, dev_name(&dev->dev), sizeof(serio->phys));
154 serio->port_data = ps2if;
155 serio->dev.parent = &dev->dev;
156 ps2if->io = serio;
157 ps2if->dev = dev;
158 ps2if->base = pci_resource_start(dev, 0);
159
160 pci_set_drvdata(dev, ps2if);
161
162 serio_register_port(ps2if->io);
163 return 0;
164
165 release:
166 kfree(ps2if);
167 kfree(serio);
168 pci_release_regions(dev);
169 disable:
170 pci_disable_device(dev);
171 out:
172 return ret;
173 }
174
175 static void pcips2_remove(struct pci_dev *dev)
176 {
177 struct pcips2_data *ps2if = pci_get_drvdata(dev);
178
179 serio_unregister_port(ps2if->io);
180 kfree(ps2if);
181 pci_release_regions(dev);
182 pci_disable_device(dev);
183 }
184
185 static const struct pci_device_id pcips2_ids[] = {
186 {
187 .vendor = 0x14f2,
188 .device = 0x0123,
189 .subvendor = PCI_ANY_ID,
190 .subdevice = PCI_ANY_ID,
191 .class = PCI_CLASS_INPUT_KEYBOARD << 8,
192 .class_mask = 0xffff00,
193 },
194 {
195 .vendor = 0x14f2,
196 .device = 0x0124,
197 .subvendor = PCI_ANY_ID,
198 .subdevice = PCI_ANY_ID,
199 .class = PCI_CLASS_INPUT_MOUSE << 8,
200 .class_mask = 0xffff00,
201 },
202 { 0, }
203 };
204 MODULE_DEVICE_TABLE(pci, pcips2_ids);
205
206 static struct pci_driver pcips2_driver = {
207 .name = "pcips2",
208 .id_table = pcips2_ids,
209 .probe = pcips2_probe,
210 .remove = pcips2_remove,
211 };
212
213 module_pci_driver(pcips2_driver);
214
215 MODULE_LICENSE("GPL");
216 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
217 MODULE_DESCRIPTION("PCI PS/2 keyboard/mouse driver");