Version:  2.0.40 2.2.26 2.4.37 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17

Linux/drivers/input/serio/ct82c710.c

  1 /*
  2  *  Copyright (c) 1999-2001 Vojtech Pavlik
  3  */
  4 
  5 /*
  6  *  82C710 C&T mouse port chip driver for Linux
  7  */
  8 
  9 /*
 10  * This program is free software; you can redistribute it and/or modify
 11  * it under the terms of the GNU General Public License as published by
 12  * the Free Software Foundation; either version 2 of the License, or
 13  * (at your option) any later version.
 14  *
 15  * This program is distributed in the hope that it will be useful,
 16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 18  * GNU General Public License for more details.
 19  *
 20  * You should have received a copy of the GNU General Public License
 21  * along with this program; if not, write to the Free Software
 22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 23  *
 24  * Should you need to contact me, the author, you can do so either by
 25  * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
 26  * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
 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 
 42 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
 43 MODULE_DESCRIPTION("82C710 C&T mouse port chip driver");
 44 MODULE_LICENSE("GPL");
 45 
 46 /*
 47  * ct82c710 interface
 48  */
 49 
 50 #define CT82C710_DEV_IDLE     0x01              /* Device Idle */
 51 #define CT82C710_RX_FULL      0x02              /* Device Char received */
 52 #define CT82C710_TX_IDLE      0x04              /* Device XMIT Idle */
 53 #define CT82C710_RESET        0x08              /* Device Reset */
 54 #define CT82C710_INTS_ON      0x10              /* Device Interrupt On */
 55 #define CT82C710_ERROR_FLAG   0x20              /* Device Error */
 56 #define CT82C710_CLEAR        0x40              /* Device Clear */
 57 #define CT82C710_ENABLE       0x80              /* Device Enable */
 58 
 59 #define CT82C710_IRQ          12
 60 
 61 #define CT82C710_DATA         ct82c710_iores.start
 62 #define CT82C710_STATUS       (ct82c710_iores.start + 1)
 63 
 64 static struct serio *ct82c710_port;
 65 static struct platform_device *ct82c710_device;
 66 static struct resource ct82c710_iores;
 67 
 68 /*
 69  * Interrupt handler for the 82C710 mouse port. A character
 70  * is waiting in the 82C710.
 71  */
 72 
 73 static irqreturn_t ct82c710_interrupt(int cpl, void *dev_id)
 74 {
 75         return serio_interrupt(ct82c710_port, inb(CT82C710_DATA), 0);
 76 }
 77 
 78 /*
 79  * Wait for device to send output char and flush any input char.
 80  */
 81 
 82 static 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 
 98 static 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 
111 static 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);        /* Enable interrupts */
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  * Write to the 82C710 mouse device.
144  */
145 
146 static 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  * See if we can find a 82C710 device. Read mouse address.
155  */
156 
157 static int __init ct82c710_detect(void)
158 {
159         outb_p(0x55, 0x2fa);                            /* Any value except 9, ff or 36 */
160         outb_p(0xaa, 0x3fa);                            /* Inverse of 55 */
161         outb_p(0x36, 0x3fa);                            /* Address the chip */
162         outb_p(0xe4, 0x3fa);                            /* 390/4; 390 = config address */
163         outb_p(0x1b, 0x2fa);                            /* Inverse of e4 */
164         outb_p(0x0f, 0x390);                            /* Write index */
165         if (inb_p(0x391) != 0xe4)                       /* Config address found? */
166                 return -ENODEV;                         /* No: no 82C710 here */
167 
168         outb_p(0x0d, 0x390);                            /* Write index */
169         ct82c710_iores.start = inb_p(0x391) << 2;       /* Get mouse I/O address */
170         ct82c710_iores.end = ct82c710_iores.start + 1;
171         ct82c710_iores.flags = IORESOURCE_IO;
172         outb_p(0x0f, 0x390);
173         outb_p(0x0f, 0x391);                            /* Close config mode */
174 
175         return 0;
176 }
177 
178 static 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 
202 static int ct82c710_remove(struct platform_device *dev)
203 {
204         serio_unregister_port(ct82c710_port);
205 
206         return 0;
207 }
208 
209 static struct platform_driver ct82c710_driver = {
210         .driver         = {
211                 .name   = "ct82c710",
212                 .owner  = THIS_MODULE,
213         },
214         .probe          = ct82c710_probe,
215         .remove         = ct82c710_remove,
216 };
217 
218 
219 static int __init ct82c710_init(void)
220 {
221         int error;
222 
223         error = ct82c710_detect();
224         if (error)
225                 return error;
226 
227         error = platform_driver_register(&ct82c710_driver);
228         if (error)
229                 return error;
230 
231         ct82c710_device = platform_device_alloc("ct82c710", -1);
232         if (!ct82c710_device) {
233                 error = -ENOMEM;
234                 goto err_unregister_driver;
235         }
236 
237         error = platform_device_add_resources(ct82c710_device, &ct82c710_iores, 1);
238         if (error)
239                 goto err_free_device;
240 
241         error = platform_device_add(ct82c710_device);
242         if (error)
243                 goto err_free_device;
244 
245         return 0;
246 
247  err_free_device:
248         platform_device_put(ct82c710_device);
249  err_unregister_driver:
250         platform_driver_unregister(&ct82c710_driver);
251         return error;
252 }
253 
254 static void __exit ct82c710_exit(void)
255 {
256         platform_device_unregister(ct82c710_device);
257         platform_driver_unregister(&ct82c710_driver);
258 }
259 
260 module_init(ct82c710_init);
261 module_exit(ct82c710_exit);
262 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us