2 * linux/drivers/input/serio/ambakmi.c
4 * Copyright (C) 2000-2003 Deep Blue Solutions Ltd.
5 * Copyright (C) 2002 Russell King.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 #include <linux/module.h>
13 #include <linux/init.h>
14 #include <linux/serio.h>
15 #include <linux/errno.h>
16 #include <linux/interrupt.h>
17 #include <linux/ioport.h>
18 #include <linux/device.h>
19 #include <linux/delay.h>
20 #include <linux/slab.h>
24 #include <asm/hardware/amba.h>
25 #include <asm/hardware/amba_kmi.h>
27 #define KMI_BASE (kmi->base)
29 struct amba_kmi_port {
31 struct amba_kmi_port *next;
38 static irqreturn_t amba_kmi_int(int irq, void *dev_id, struct pt_regs *regs)
40 struct amba_kmi_port *kmi = dev_id;
41 unsigned int status = readb(KMIIR);
42 int handled = IRQ_NONE;
44 while (status & KMIIR_RXINTR) {
45 serio_interrupt(&kmi->io, readb(KMIDATA), 0, regs);
46 status = readb(KMIIR);
47 handled = IRQ_HANDLED;
53 static int amba_kmi_write(struct serio *io, unsigned char val)
55 struct amba_kmi_port *kmi = io->driver;
56 unsigned int timeleft = 10000; /* timeout in 100ms */
58 while ((readb(KMISTAT) & KMISTAT_TXEMPTY) == 0 && timeleft--)
64 return timeleft ? 0 : SERIO_TIMEOUT;
67 static int amba_kmi_open(struct serio *io)
69 struct amba_kmi_port *kmi = io->driver;
72 writeb(kmi->divisor, KMICLKDIV);
73 writeb(KMICR_EN, KMICR);
75 ret = request_irq(kmi->irq, amba_kmi_int, 0, "kmi-pl050", kmi);
77 printk(KERN_ERR "kmi: failed to claim IRQ%d\n", kmi->irq);
82 writeb(KMICR_EN | KMICR_RXINTREN, KMICR);
87 static void amba_kmi_close(struct serio *io)
89 struct amba_kmi_port *kmi = io->driver;
93 free_irq(kmi->irq, kmi);
96 static int amba_kmi_probe(struct amba_device *dev, void *id)
98 struct amba_kmi_port *kmi;
101 ret = amba_request_regions(dev, NULL);
105 kmi = kmalloc(sizeof(struct amba_kmi_port), GFP_KERNEL);
111 memset(kmi, 0, sizeof(struct amba_kmi_port));
113 kmi->io.type = SERIO_8042;
114 kmi->io.write = amba_kmi_write;
115 kmi->io.open = amba_kmi_open;
116 kmi->io.close = amba_kmi_close;
117 kmi->io.name = dev->dev.bus_id;
118 kmi->io.phys = dev->dev.bus_id;
119 kmi->io.driver = kmi;
121 kmi->base = ioremap(dev->res.start, KMI_SIZE);
127 kmi->irq = dev->irq[0];
128 kmi->divisor = 24 / 8 - 1;
130 amba_set_drvdata(dev, kmi);
132 serio_register_port(&kmi->io);
137 amba_release_regions(dev);
141 static int amba_kmi_remove(struct amba_device *dev)
143 struct amba_kmi_port *kmi = amba_get_drvdata(dev);
145 amba_set_drvdata(dev, NULL);
147 serio_unregister_port(&kmi->io);
150 amba_release_regions(dev);
154 static int amba_kmi_resume(struct amba_device *dev)
156 struct amba_kmi_port *kmi = amba_get_drvdata(dev);
158 /* kick the serio layer to rescan this port */
159 serio_rescan(&kmi->io);
164 static struct amba_id amba_kmi_idtable[] = {
172 static struct amba_driver ambakmi_driver = {
176 .id_table = amba_kmi_idtable,
177 .probe = amba_kmi_probe,
178 .remove = amba_kmi_remove,
179 .resume = amba_kmi_resume,
182 static int __init amba_kmi_init(void)
184 return amba_driver_register(&ambakmi_driver);
187 static void __exit amba_kmi_exit(void)
189 return amba_driver_unregister(&ambakmi_driver);
192 module_init(amba_kmi_init);
193 module_exit(amba_kmi_exit);
195 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
196 MODULE_DESCRIPTION("AMBA KMI controller driver");
197 MODULE_LICENSE("GPL");