Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * $Id: ct82c710.c,v 1.11 2001/09/25 10:12:07 vojtech Exp $ | |
3 | * | |
4 | * Copyright (c) 1999-2001 Vojtech Pavlik | |
5 | */ | |
6 | ||
7 | /* | |
8 | * 82C710 C&T mouse port chip driver for Linux | |
9 | */ | |
10 | ||
11 | /* | |
12 | * This program is free software; you can redistribute it and/or modify | |
13 | * it under the terms of the GNU General Public License as published by | |
14 | * the Free Software Foundation; either version 2 of the License, or | |
15 | * (at your option) any later version. | |
16 | * | |
17 | * This program is distributed in the hope that it will be useful, | |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
20 | * GNU General Public License for more details. | |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with this program; if not, write to the Free Software | |
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
25 | * | |
26 | * Should you need to contact me, the author, you can do so either by | |
27 | * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: | |
28 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic | |
29 | */ | |
30 | ||
31 | #include <linux/delay.h> | |
32 | #include <linux/module.h> | |
33 | #include <linux/ioport.h> | |
1da177e4 LT |
34 | #include <linux/init.h> |
35 | #include <linux/interrupt.h> | |
36 | #include <linux/serio.h> | |
37 | #include <linux/errno.h> | |
38 | #include <linux/err.h> | |
d052d1be | 39 | #include <linux/platform_device.h> |
1da177e4 LT |
40 | |
41 | #include <asm/io.h> | |
42 | ||
43 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
44 | MODULE_DESCRIPTION("82C710 C&T mouse port chip driver"); | |
45 | MODULE_LICENSE("GPL"); | |
46 | ||
47 | /* | |
48 | * ct82c710 interface | |
49 | */ | |
50 | ||
51 | #define CT82C710_DEV_IDLE 0x01 /* Device Idle */ | |
52 | #define CT82C710_RX_FULL 0x02 /* Device Char received */ | |
53 | #define CT82C710_TX_IDLE 0x04 /* Device XMIT Idle */ | |
54 | #define CT82C710_RESET 0x08 /* Device Reset */ | |
55 | #define CT82C710_INTS_ON 0x10 /* Device Interrupt On */ | |
56 | #define CT82C710_ERROR_FLAG 0x20 /* Device Error */ | |
57 | #define CT82C710_CLEAR 0x40 /* Device Clear */ | |
58 | #define CT82C710_ENABLE 0x80 /* Device Enable */ | |
59 | ||
60 | #define CT82C710_IRQ 12 | |
61 | ||
62 | #define CT82C710_DATA ct82c710_iores.start | |
63 | #define CT82C710_STATUS (ct82c710_iores.start + 1) | |
64 | ||
65 | static struct serio *ct82c710_port; | |
66 | static struct platform_device *ct82c710_device; | |
67 | static struct resource ct82c710_iores; | |
68 | ||
69 | /* | |
70 | * Interrupt handler for the 82C710 mouse port. A character | |
71 | * is waiting in the 82C710. | |
72 | */ | |
73 | ||
7d12e780 | 74 | static irqreturn_t ct82c710_interrupt(int cpl, void *dev_id) |
1da177e4 | 75 | { |
7d12e780 | 76 | return serio_interrupt(ct82c710_port, inb(CT82C710_DATA), 0); |
1da177e4 LT |
77 | } |
78 | ||
79 | /* | |
80 | * Wait for device to send output char and flush any input char. | |
81 | */ | |
82 | ||
83 | static int ct82c170_wait(void) | |
84 | { | |
85 | int timeout = 60000; | |
86 | ||
87 | while ((inb(CT82C710_STATUS) & (CT82C710_RX_FULL | CT82C710_TX_IDLE | CT82C710_DEV_IDLE)) | |
88 | != (CT82C710_DEV_IDLE | CT82C710_TX_IDLE) && timeout) { | |
89 | ||
90 | if (inb_p(CT82C710_STATUS) & CT82C710_RX_FULL) inb_p(CT82C710_DATA); | |
91 | ||
92 | udelay(1); | |
93 | timeout--; | |
94 | } | |
95 | ||
96 | return !timeout; | |
97 | } | |
98 | ||
99 | static void ct82c710_close(struct serio *serio) | |
100 | { | |
101 | if (ct82c170_wait()) | |
102 | printk(KERN_WARNING "ct82c710.c: Device busy in close()\n"); | |
103 | ||
104 | outb_p(inb_p(CT82C710_STATUS) & ~(CT82C710_ENABLE | CT82C710_INTS_ON), CT82C710_STATUS); | |
105 | ||
106 | if (ct82c170_wait()) | |
107 | printk(KERN_WARNING "ct82c710.c: Device busy in close()\n"); | |
108 | ||
109 | free_irq(CT82C710_IRQ, NULL); | |
110 | } | |
111 | ||
112 | static int ct82c710_open(struct serio *serio) | |
113 | { | |
114 | unsigned char status; | |
115 | ||
116 | if (request_irq(CT82C710_IRQ, ct82c710_interrupt, 0, "ct82c710", NULL)) | |
117 | return -1; | |
118 | ||
119 | status = inb_p(CT82C710_STATUS); | |
120 | ||
121 | status |= (CT82C710_ENABLE | CT82C710_RESET); | |
122 | outb_p(status, CT82C710_STATUS); | |
123 | ||
124 | status &= ~(CT82C710_RESET); | |
125 | outb_p(status, CT82C710_STATUS); | |
126 | ||
127 | status |= CT82C710_INTS_ON; | |
128 | outb_p(status, CT82C710_STATUS); /* Enable interrupts */ | |
129 | ||
130 | while (ct82c170_wait()) { | |
131 | printk(KERN_ERR "ct82c710: Device busy in open()\n"); | |
132 | status &= ~(CT82C710_ENABLE | CT82C710_INTS_ON); | |
133 | outb_p(status, CT82C710_STATUS); | |
134 | free_irq(CT82C710_IRQ, NULL); | |
135 | return -1; | |
136 | } | |
137 | ||
138 | return 0; | |
139 | } | |
140 | ||
141 | /* | |
142 | * Write to the 82C710 mouse device. | |
143 | */ | |
144 | ||
145 | static int ct82c710_write(struct serio *port, unsigned char c) | |
146 | { | |
147 | if (ct82c170_wait()) return -1; | |
148 | outb_p(c, CT82C710_DATA); | |
149 | return 0; | |
150 | } | |
151 | ||
152 | /* | |
153 | * See if we can find a 82C710 device. Read mouse address. | |
154 | */ | |
155 | ||
916d83cf | 156 | static int __init ct82c710_detect(void) |
1da177e4 LT |
157 | { |
158 | outb_p(0x55, 0x2fa); /* Any value except 9, ff or 36 */ | |
159 | outb_p(0xaa, 0x3fa); /* Inverse of 55 */ | |
160 | outb_p(0x36, 0x3fa); /* Address the chip */ | |
161 | outb_p(0xe4, 0x3fa); /* 390/4; 390 = config address */ | |
162 | outb_p(0x1b, 0x2fa); /* Inverse of e4 */ | |
163 | outb_p(0x0f, 0x390); /* Write index */ | |
164 | if (inb_p(0x391) != 0xe4) /* Config address found? */ | |
916d83cf | 165 | return -ENODEV; /* No: no 82C710 here */ |
1da177e4 LT |
166 | |
167 | outb_p(0x0d, 0x390); /* Write index */ | |
168 | ct82c710_iores.start = inb_p(0x391) << 2; /* Get mouse I/O address */ | |
169 | ct82c710_iores.end = ct82c710_iores.start + 1; | |
170 | ct82c710_iores.flags = IORESOURCE_IO; | |
171 | outb_p(0x0f, 0x390); | |
172 | outb_p(0x0f, 0x391); /* Close config mode */ | |
173 | ||
174 | return 0; | |
175 | } | |
176 | ||
916d83cf | 177 | static int __devinit ct82c710_probe(struct platform_device *dev) |
1da177e4 | 178 | { |
916d83cf DT |
179 | ct82c710_port = kzalloc(sizeof(struct serio), GFP_KERNEL); |
180 | if (!ct82c710_port) | |
181 | return -ENOMEM; | |
182 | ||
183 | ct82c710_port->id.type = SERIO_8042; | |
184 | ct82c710_port->dev.parent = &dev->dev; | |
185 | ct82c710_port->open = ct82c710_open; | |
186 | ct82c710_port->close = ct82c710_close; | |
187 | ct82c710_port->write = ct82c710_write; | |
188 | strlcpy(ct82c710_port->name, "C&T 82c710 mouse port", | |
189 | sizeof(ct82c710_port->name)); | |
190 | snprintf(ct82c710_port->phys, sizeof(ct82c710_port->phys), | |
e29419ff | 191 | "isa%16llx/serio0", (unsigned long long)CT82C710_DATA); |
916d83cf DT |
192 | |
193 | serio_register_port(ct82c710_port); | |
194 | ||
195 | return 0; | |
196 | } | |
197 | ||
198 | static int __devexit ct82c710_remove(struct platform_device *dev) | |
199 | { | |
200 | serio_unregister_port(ct82c710_port); | |
1da177e4 | 201 | |
916d83cf | 202 | return 0; |
1da177e4 LT |
203 | } |
204 | ||
916d83cf DT |
205 | static struct platform_driver ct82c710_driver = { |
206 | .driver = { | |
207 | .name = "ct82c710", | |
208 | .owner = THIS_MODULE, | |
209 | }, | |
210 | .probe = ct82c710_probe, | |
211 | .remove = __devexit_p(ct82c710_remove), | |
212 | }; | |
213 | ||
214 | ||
1da177e4 LT |
215 | static int __init ct82c710_init(void) |
216 | { | |
916d83cf | 217 | int error; |
1da177e4 | 218 | |
916d83cf DT |
219 | error = ct82c710_detect(); |
220 | if (error) | |
221 | return error; | |
1da177e4 | 222 | |
916d83cf DT |
223 | error = platform_driver_register(&ct82c710_driver); |
224 | if (error) | |
225 | return error; | |
226 | ||
227 | ct82c710_device = platform_device_alloc("ct82c710", -1); | |
228 | if (!ct82c710_device) { | |
229 | error = -ENOMEM; | |
230 | goto err_unregister_driver; | |
1da177e4 LT |
231 | } |
232 | ||
916d83cf DT |
233 | error = platform_device_add_resources(ct82c710_device, &ct82c710_iores, 1); |
234 | if (error) | |
235 | goto err_free_device; | |
236 | ||
237 | error = platform_device_add(ct82c710_device); | |
238 | if (error) | |
239 | goto err_free_device; | |
240 | ||
1da177e4 LT |
241 | serio_register_port(ct82c710_port); |
242 | ||
e29419ff GKH |
243 | printk(KERN_INFO "serio: C&T 82c710 mouse port at %#llx irq %d\n", |
244 | (unsigned long long)CT82C710_DATA, CT82C710_IRQ); | |
1da177e4 LT |
245 | |
246 | return 0; | |
916d83cf DT |
247 | |
248 | err_free_device: | |
249 | platform_device_put(ct82c710_device); | |
250 | err_unregister_driver: | |
251 | platform_driver_unregister(&ct82c710_driver); | |
252 | return error; | |
1da177e4 LT |
253 | } |
254 | ||
255 | static void __exit ct82c710_exit(void) | |
256 | { | |
1da177e4 | 257 | platform_device_unregister(ct82c710_device); |
916d83cf | 258 | platform_driver_unregister(&ct82c710_driver); |
1da177e4 LT |
259 | } |
260 | ||
261 | module_init(ct82c710_init); | |
262 | module_exit(ct82c710_exit); |