diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/input/serio/ct82c710.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/input/serio/ct82c710.c')
-rw-r--r-- | drivers/input/serio/ct82c710.c | 225 |
1 files changed, 225 insertions, 0 deletions
diff --git a/drivers/input/serio/ct82c710.c b/drivers/input/serio/ct82c710.c new file mode 100644 index 000000000000..dd0f5bd90241 --- /dev/null +++ b/drivers/input/serio/ct82c710.c | |||
@@ -0,0 +1,225 @@ | |||
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> | ||
34 | #include <linux/config.h> | ||
35 | #include <linux/init.h> | ||
36 | #include <linux/interrupt.h> | ||
37 | #include <linux/serio.h> | ||
38 | #include <linux/errno.h> | ||
39 | #include <linux/err.h> | ||
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 | |||
74 | static irqreturn_t ct82c710_interrupt(int cpl, void *dev_id, struct pt_regs * regs) | ||
75 | { | ||
76 | return serio_interrupt(ct82c710_port, inb(CT82C710_DATA), 0, regs); | ||
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 | |||
156 | static int __init ct82c710_probe(void) | ||
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? */ | ||
165 | return -1; /* No: no 82C710 here */ | ||
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 | |||
177 | static struct serio * __init ct82c710_allocate_port(void) | ||
178 | { | ||
179 | struct serio *serio; | ||
180 | |||
181 | serio = kmalloc(sizeof(struct serio), GFP_KERNEL); | ||
182 | if (serio) { | ||
183 | memset(serio, 0, sizeof(struct serio)); | ||
184 | serio->id.type = SERIO_8042; | ||
185 | serio->open = ct82c710_open; | ||
186 | serio->close = ct82c710_close; | ||
187 | serio->write = ct82c710_write; | ||
188 | serio->dev.parent = &ct82c710_device->dev; | ||
189 | strlcpy(serio->name, "C&T 82c710 mouse port", sizeof(serio->name)); | ||
190 | snprintf(serio->phys, sizeof(serio->phys), "isa%04lx/serio0", CT82C710_DATA); | ||
191 | } | ||
192 | |||
193 | return serio; | ||
194 | } | ||
195 | |||
196 | static int __init ct82c710_init(void) | ||
197 | { | ||
198 | if (ct82c710_probe()) | ||
199 | return -ENODEV; | ||
200 | |||
201 | ct82c710_device = platform_device_register_simple("ct82c710", -1, &ct82c710_iores, 1); | ||
202 | if (IS_ERR(ct82c710_device)) | ||
203 | return PTR_ERR(ct82c710_device); | ||
204 | |||
205 | if (!(ct82c710_port = ct82c710_allocate_port())) { | ||
206 | platform_device_unregister(ct82c710_device); | ||
207 | return -ENOMEM; | ||
208 | } | ||
209 | |||
210 | serio_register_port(ct82c710_port); | ||
211 | |||
212 | printk(KERN_INFO "serio: C&T 82c710 mouse port at %#lx irq %d\n", | ||
213 | CT82C710_DATA, CT82C710_IRQ); | ||
214 | |||
215 | return 0; | ||
216 | } | ||
217 | |||
218 | static void __exit ct82c710_exit(void) | ||
219 | { | ||
220 | serio_unregister_port(ct82c710_port); | ||
221 | platform_device_unregister(ct82c710_device); | ||
222 | } | ||
223 | |||
224 | module_init(ct82c710_init); | ||
225 | module_exit(ct82c710_exit); | ||