提交 f57caaef 编写于 作者: D David S. Miller 提交者: David S. Miller

[SERIO] i8042-sparcio.h: Convert to of_driver framework.

Signed-off-by: NDavid S. Miller <davem@davemloft.net>
上级 ff0d2fc6
...@@ -3,11 +3,9 @@ ...@@ -3,11 +3,9 @@
#include <linux/config.h> #include <linux/config.h>
#include <asm/io.h> #include <asm/io.h>
#ifdef CONFIG_PCI
#include <asm/oplib.h> #include <asm/oplib.h>
#include <asm/ebus.h> #include <asm/prom.h>
#endif #include <asm/of_device.h>
static int i8042_kbd_irq = -1; static int i8042_kbd_irq = -1;
static int i8042_aux_irq = -1; static int i8042_aux_irq = -1;
...@@ -48,54 +46,83 @@ static inline void i8042_write_command(int val) ...@@ -48,54 +46,83 @@ static inline void i8042_write_command(int val)
#define OBP_PS2MS_NAME1 "kdmouse" #define OBP_PS2MS_NAME1 "kdmouse"
#define OBP_PS2MS_NAME2 "mouse" #define OBP_PS2MS_NAME2 "mouse"
static int __devinit sparc_i8042_probe(struct of_device *op, const struct of_device_id *match)
{
struct device_node *dp = op->node;
dp = dp->child;
while (dp) {
if (!strcmp(dp->name, OBP_PS2KBD_NAME1) ||
!strcmp(dp->name, OBP_PS2KBD_NAME2)) {
struct of_device *kbd = of_find_device_by_node(dp);
unsigned int irq = kbd->irqs[0];
if (irq == 0xffffffff)
irq = op->irqs[0];
i8042_kbd_irq = irq;
kbd_iobase = of_ioremap(&kbd->resource[0],
0, 8, "kbd");
} else if (!strcmp(dp->name, OBP_PS2MS_NAME1) ||
!strcmp(dp->name, OBP_PS2MS_NAME2)) {
struct of_device *ms = of_find_device_by_node(dp);
unsigned int irq = ms->irqs[0];
if (irq == 0xffffffff)
irq = op->irqs[0];
i8042_aux_irq = irq;
}
dp = dp->sibling;
}
return 0;
}
static int __devexit sparc_i8042_remove(struct of_device *op)
{
of_iounmap(kbd_iobase, 8);
return 0;
}
static struct of_device_id sparc_i8042_match[] = {
{
.name = "8042",
},
{},
};
MODULE_DEVICE_TABLE(of, i8042_match);
static struct of_platform_driver sparc_i8042_driver = {
.name = "i8042",
.match_table = sparc_i8042_match,
.probe = sparc_i8042_probe,
.remove = __devexit_p(sparc_i8042_remove),
};
static int __init i8042_platform_init(void) static int __init i8042_platform_init(void)
{ {
#ifndef CONFIG_PCI #ifndef CONFIG_PCI
return -ENODEV; return -ENODEV;
#else #else
char prop[128]; struct device_node *root = of_find_node_by_path("/");
int len;
len = prom_getproperty(prom_root_node, "name", prop, sizeof(prop)); if (!strcmp(root->name, "SUNW,JavaStation-1")) {
if (len < 0) {
printk("i8042: Cannot get name property of root OBP node.\n");
return -ENODEV;
}
if (strncmp(prop, "SUNW,JavaStation-1", len) == 0) {
/* Hardcoded values for MrCoffee. */ /* Hardcoded values for MrCoffee. */
i8042_kbd_irq = i8042_aux_irq = 13 | 0x20; i8042_kbd_irq = i8042_aux_irq = 13 | 0x20;
kbd_iobase = ioremap(0x71300060, 8); kbd_iobase = ioremap(0x71300060, 8);
if (!kbd_iobase) if (!kbd_iobase)
return -ENODEV; return -ENODEV;
} else { } else {
struct linux_ebus *ebus; int err = of_register_driver(&sparc_i8042_driver,
struct linux_ebus_device *edev; &of_bus_type);
struct linux_ebus_child *child; if (err)
return err;
for_each_ebus(ebus) {
for_each_ebusdev(edev, ebus) {
if (!strcmp(edev->prom_node->name, "8042"))
goto edev_found;
}
}
return -ENODEV;
edev_found:
for_each_edevchild(edev, child) {
if (!strcmp(child->prom_node->name, OBP_PS2KBD_NAME1) ||
!strcmp(child->prom_node->name, OBP_PS2KBD_NAME2)) {
i8042_kbd_irq = child->irqs[0];
kbd_iobase =
ioremap(child->resource[0].start, 8);
}
if (!strcmp(child->prom_node->name, OBP_PS2MS_NAME1) ||
!strcmp(child->prom_node->name, OBP_PS2MS_NAME2))
i8042_aux_irq = child->irqs[0];
}
if (i8042_kbd_irq == -1 || if (i8042_kbd_irq == -1 ||
i8042_aux_irq == -1) { i8042_aux_irq == -1) {
printk("i8042: Error, 8042 device lacks both kbd and " if (kbd_iobase) {
"mouse nodes.\n"); of_iounmap(kbd_iobase, 8);
kbd_iobase = (void __iomem *) NULL;
}
return -ENODEV; return -ENODEV;
} }
} }
...@@ -109,7 +136,10 @@ static int __init i8042_platform_init(void) ...@@ -109,7 +136,10 @@ static int __init i8042_platform_init(void)
static inline void i8042_platform_exit(void) static inline void i8042_platform_exit(void)
{ {
#ifdef CONFIG_PCI #ifdef CONFIG_PCI
iounmap(kbd_iobase); struct device_node *root = of_find_node_by_path("/");
if (strcmp(root->name, "SUNW,JavaStation-1"))
of_unregister_driver(&sparc_i8042_driver);
#endif #endif
} }
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册