1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <linux/delay.h>
30#include <linux/module.h>
31#include <linux/ioport.h>
32#include <linux/init.h>
33#include <linux/interrupt.h>
34#include <linux/serio.h>
35#include <linux/errno.h>
36#include <linux/err.h>
37#include <linux/platform_device.h>
38#include <linux/slab.h>
39
40#include <asm/io.h>
41
42MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
43MODULE_DESCRIPTION("82C710 C&T mouse port chip driver");
44MODULE_LICENSE("GPL");
45
46
47
48
49
50#define CT82C710_DEV_IDLE 0x01
51#define CT82C710_RX_FULL 0x02
52#define CT82C710_TX_IDLE 0x04
53#define CT82C710_RESET 0x08
54#define CT82C710_INTS_ON 0x10
55#define CT82C710_ERROR_FLAG 0x20
56#define CT82C710_CLEAR 0x40
57#define CT82C710_ENABLE 0x80
58
59#define CT82C710_IRQ 12
60
61#define CT82C710_DATA ct82c710_iores.start
62#define CT82C710_STATUS (ct82c710_iores.start + 1)
63
64static struct serio *ct82c710_port;
65static struct platform_device *ct82c710_device;
66static struct resource ct82c710_iores;
67
68
69
70
71
72
73static irqreturn_t ct82c710_interrupt(int cpl, void *dev_id)
74{
75 return serio_interrupt(ct82c710_port, inb(CT82C710_DATA), 0);
76}
77
78
79
80
81
82static int ct82c170_wait(void)
83{
84 int timeout = 60000;
85
86 while ((inb(CT82C710_STATUS) & (CT82C710_RX_FULL | CT82C710_TX_IDLE | CT82C710_DEV_IDLE))
87 != (CT82C710_DEV_IDLE | CT82C710_TX_IDLE) && timeout) {
88
89 if (inb_p(CT82C710_STATUS) & CT82C710_RX_FULL) inb_p(CT82C710_DATA);
90
91 udelay(1);
92 timeout--;
93 }
94
95 return !timeout;
96}
97
98static void ct82c710_close(struct serio *serio)
99{
100 if (ct82c170_wait())
101 printk(KERN_WARNING "ct82c710.c: Device busy in close()\n");
102
103 outb_p(inb_p(CT82C710_STATUS) & ~(CT82C710_ENABLE | CT82C710_INTS_ON), CT82C710_STATUS);
104
105 if (ct82c170_wait())
106 printk(KERN_WARNING "ct82c710.c: Device busy in close()\n");
107
108 free_irq(CT82C710_IRQ, NULL);
109}
110
111static int ct82c710_open(struct serio *serio)
112{
113 unsigned char status;
114 int err;
115
116 err = request_irq(CT82C710_IRQ, ct82c710_interrupt, 0, "ct82c710", NULL);
117 if (err)
118 return err;
119
120 status = inb_p(CT82C710_STATUS);
121
122 status |= (CT82C710_ENABLE | CT82C710_RESET);
123 outb_p(status, CT82C710_STATUS);
124
125 status &= ~(CT82C710_RESET);
126 outb_p(status, CT82C710_STATUS);
127
128 status |= CT82C710_INTS_ON;
129 outb_p(status, CT82C710_STATUS);
130
131 while (ct82c170_wait()) {
132 printk(KERN_ERR "ct82c710: Device busy in open()\n");
133 status &= ~(CT82C710_ENABLE | CT82C710_INTS_ON);
134 outb_p(status, CT82C710_STATUS);
135 free_irq(CT82C710_IRQ, NULL);
136 return -EBUSY;
137 }
138
139 return 0;
140}
141
142
143
144
145
146static int ct82c710_write(struct serio *port, unsigned char c)
147{
148 if (ct82c170_wait()) return -1;
149 outb_p(c, CT82C710_DATA);
150 return 0;
151}
152
153
154
155
156
157static int __init ct82c710_detect(void)
158{
159 outb_p(0x55, 0x2fa);
160 outb_p(0xaa, 0x3fa);
161 outb_p(0x36, 0x3fa);
162 outb_p(0xe4, 0x3fa);
163 outb_p(0x1b, 0x2fa);
164 outb_p(0x0f, 0x390);
165 if (inb_p(0x391) != 0xe4)
166 return -ENODEV;
167
168 outb_p(0x0d, 0x390);
169 ct82c710_iores.start = inb_p(0x391) << 2;
170 ct82c710_iores.end = ct82c710_iores.start + 1;
171 ct82c710_iores.flags = IORESOURCE_IO;
172 outb_p(0x0f, 0x390);
173 outb_p(0x0f, 0x391);
174
175 return 0;
176}
177
178static int ct82c710_probe(struct platform_device *dev)
179{
180 ct82c710_port = kzalloc(sizeof(struct serio), GFP_KERNEL);
181 if (!ct82c710_port)
182 return -ENOMEM;
183
184 ct82c710_port->id.type = SERIO_8042;
185 ct82c710_port->dev.parent = &dev->dev;
186 ct82c710_port->open = ct82c710_open;
187 ct82c710_port->close = ct82c710_close;
188 ct82c710_port->write = ct82c710_write;
189 strlcpy(ct82c710_port->name, "C&T 82c710 mouse port",
190 sizeof(ct82c710_port->name));
191 snprintf(ct82c710_port->phys, sizeof(ct82c710_port->phys),
192 "isa%16llx/serio0", (unsigned long long)CT82C710_DATA);
193
194 serio_register_port(ct82c710_port);
195
196 printk(KERN_INFO "serio: C&T 82c710 mouse port at %#llx irq %d\n",
197 (unsigned long long)CT82C710_DATA, CT82C710_IRQ);
198
199 return 0;
200}
201
202static int ct82c710_remove(struct platform_device *dev)
203{
204 serio_unregister_port(ct82c710_port);
205
206 return 0;
207}
208
209static struct platform_driver ct82c710_driver = {
210 .driver = {
211 .name = "ct82c710",
212 },
213 .probe = ct82c710_probe,
214 .remove = ct82c710_remove,
215};
216
217
218static int __init ct82c710_init(void)
219{
220 int error;
221
222 error = ct82c710_detect();
223 if (error)
224 return error;
225
226 error = platform_driver_register(&ct82c710_driver);
227 if (error)
228 return error;
229
230 ct82c710_device = platform_device_alloc("ct82c710", -1);
231 if (!ct82c710_device) {
232 error = -ENOMEM;
233 goto err_unregister_driver;
234 }
235
236 error = platform_device_add_resources(ct82c710_device, &ct82c710_iores, 1);
237 if (error)
238 goto err_free_device;
239
240 error = platform_device_add(ct82c710_device);
241 if (error)
242 goto err_free_device;
243
244 return 0;
245
246 err_free_device:
247 platform_device_put(ct82c710_device);
248 err_unregister_driver:
249 platform_driver_unregister(&ct82c710_driver);
250 return error;
251}
252
253static void __exit ct82c710_exit(void)
254{
255 platform_device_unregister(ct82c710_device);
256 platform_driver_unregister(&ct82c710_driver);
257}
258
259module_init(ct82c710_init);
260module_exit(ct82c710_exit);
261