drm/i915: Release and unlock on mmap_gtt error path.
[linux-2.6] / drivers / input / serio / i8042-sparcio.h
1 #ifndef _I8042_SPARCIO_H
2 #define _I8042_SPARCIO_H
3
4 #include <linux/of_device.h>
5
6 #include <asm/io.h>
7 #include <asm/oplib.h>
8 #include <asm/prom.h>
9
10 static int i8042_kbd_irq = -1;
11 static int i8042_aux_irq = -1;
12 #define I8042_KBD_IRQ i8042_kbd_irq
13 #define I8042_AUX_IRQ i8042_aux_irq
14
15 #define I8042_KBD_PHYS_DESC "sparcps2/serio0"
16 #define I8042_AUX_PHYS_DESC "sparcps2/serio1"
17 #define I8042_MUX_PHYS_DESC "sparcps2/serio%d"
18
19 static void __iomem *kbd_iobase;
20 static struct resource *kbd_res;
21
22 #define I8042_COMMAND_REG       (kbd_iobase + 0x64UL)
23 #define I8042_DATA_REG          (kbd_iobase + 0x60UL)
24
25 static inline int i8042_read_data(void)
26 {
27         return readb(kbd_iobase + 0x60UL);
28 }
29
30 static inline int i8042_read_status(void)
31 {
32         return readb(kbd_iobase + 0x64UL);
33 }
34
35 static inline void i8042_write_data(int val)
36 {
37         writeb(val, kbd_iobase + 0x60UL);
38 }
39
40 static inline void i8042_write_command(int val)
41 {
42         writeb(val, kbd_iobase + 0x64UL);
43 }
44
45 #ifdef CONFIG_PCI
46
47 #define OBP_PS2KBD_NAME1        "kb_ps2"
48 #define OBP_PS2KBD_NAME2        "keyboard"
49 #define OBP_PS2MS_NAME1         "kdmouse"
50 #define OBP_PS2MS_NAME2         "mouse"
51
52 static int __devinit sparc_i8042_probe(struct of_device *op, const struct of_device_id *match)
53 {
54         struct device_node *dp = op->node;
55
56         dp = dp->child;
57         while (dp) {
58                 if (!strcmp(dp->name, OBP_PS2KBD_NAME1) ||
59                     !strcmp(dp->name, OBP_PS2KBD_NAME2)) {
60                         struct of_device *kbd = of_find_device_by_node(dp);
61                         unsigned int irq = kbd->irqs[0];
62                         if (irq == 0xffffffff)
63                                 irq = op->irqs[0];
64                         i8042_kbd_irq = irq;
65                         kbd_iobase = of_ioremap(&kbd->resource[0],
66                                                 0, 8, "kbd");
67                         kbd_res = &kbd->resource[0];
68                 } else if (!strcmp(dp->name, OBP_PS2MS_NAME1) ||
69                            !strcmp(dp->name, OBP_PS2MS_NAME2)) {
70                         struct of_device *ms = of_find_device_by_node(dp);
71                         unsigned int irq = ms->irqs[0];
72                         if (irq == 0xffffffff)
73                                 irq = op->irqs[0];
74                         i8042_aux_irq = irq;
75                 }
76
77                 dp = dp->sibling;
78         }
79
80         return 0;
81 }
82
83 static int __devexit sparc_i8042_remove(struct of_device *op)
84 {
85         of_iounmap(kbd_res, kbd_iobase, 8);
86
87         return 0;
88 }
89
90 static const struct of_device_id sparc_i8042_match[] = {
91         {
92                 .name = "8042",
93         },
94         {},
95 };
96 MODULE_DEVICE_TABLE(of, sparc_i8042_match);
97
98 static struct of_platform_driver sparc_i8042_driver = {
99         .name           = "i8042",
100         .match_table    = sparc_i8042_match,
101         .probe          = sparc_i8042_probe,
102         .remove         = __devexit_p(sparc_i8042_remove),
103 };
104
105 static int __init i8042_platform_init(void)
106 {
107         struct device_node *root = of_find_node_by_path("/");
108
109         if (!strcmp(root->name, "SUNW,JavaStation-1")) {
110                 /* Hardcoded values for MrCoffee.  */
111                 i8042_kbd_irq = i8042_aux_irq = 13 | 0x20;
112                 kbd_iobase = ioremap(0x71300060, 8);
113                 if (!kbd_iobase)
114                         return -ENODEV;
115         } else {
116                 int err = of_register_driver(&sparc_i8042_driver,
117                                              &of_bus_type);
118                 if (err)
119                         return err;
120
121                 if (i8042_kbd_irq == -1 ||
122                     i8042_aux_irq == -1) {
123                         if (kbd_iobase) {
124                                 of_iounmap(kbd_res, kbd_iobase, 8);
125                                 kbd_iobase = (void __iomem *) NULL;
126                         }
127                         return -ENODEV;
128                 }
129         }
130
131         i8042_reset = 1;
132
133         return 0;
134 }
135
136 static inline void i8042_platform_exit(void)
137 {
138         struct device_node *root = of_find_node_by_path("/");
139
140         if (strcmp(root->name, "SUNW,JavaStation-1"))
141                 of_unregister_driver(&sparc_i8042_driver);
142 }
143
144 #else /* !CONFIG_PCI */
145 static int __init i8042_platform_init(void)
146 {
147         return -ENODEV;
148 }
149
150 static inline void i8042_platform_exit(void)
151 {
152 }
153 #endif /* !CONFIG_PCI */
154
155 #endif /* _I8042_SPARCIO_H */