Commit | Line | Data |
---|---|---|
4c75a6f4 BH |
1 | /* |
2 | * (c) Copyright 2006 Benjamin Herrenschmidt, IBM Corp. | |
3 | * <benh@kernel.crashing.org> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License as published by | |
7 | * the Free Software Foundation; either version 2 of the License, or | |
8 | * (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See | |
13 | * the GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
18 | */ | |
19 | ||
20 | #undef DEBUG | |
21 | ||
22 | #include <linux/kernel.h> | |
66b15db6 | 23 | #include <linux/export.h> |
4c75a6f4 BH |
24 | #include <asm/prom.h> |
25 | #include <asm/dcr.h> | |
26 | ||
0723abd0 | 27 | #ifdef CONFIG_PPC_DCR_MMIO |
b786af11 SN |
28 | static struct device_node *find_dcr_parent(struct device_node *node) |
29 | { | |
30 | struct device_node *par, *tmp; | |
31 | const u32 *p; | |
32 | ||
33 | for (par = of_node_get(node); par;) { | |
34 | if (of_get_property(par, "dcr-controller", NULL)) | |
35 | break; | |
36 | p = of_get_property(par, "dcr-parent", NULL); | |
37 | tmp = par; | |
38 | if (p == NULL) | |
39 | par = of_get_parent(par); | |
40 | else | |
41 | par = of_find_node_by_phandle(*p); | |
42 | of_node_put(tmp); | |
43 | } | |
44 | return par; | |
45 | } | |
0723abd0 | 46 | #endif |
b786af11 SN |
47 | |
48 | #if defined(CONFIG_PPC_DCR_NATIVE) && defined(CONFIG_PPC_DCR_MMIO) | |
49 | ||
50 | bool dcr_map_ok_generic(dcr_host_t host) | |
51 | { | |
52 | if (host.type == DCR_HOST_NATIVE) | |
53 | return dcr_map_ok_native(host.host.native); | |
54 | else if (host.type == DCR_HOST_MMIO) | |
55 | return dcr_map_ok_mmio(host.host.mmio); | |
56 | else | |
acdb6685 | 57 | return false; |
b786af11 SN |
58 | } |
59 | EXPORT_SYMBOL_GPL(dcr_map_ok_generic); | |
60 | ||
61 | dcr_host_t dcr_map_generic(struct device_node *dev, | |
62 | unsigned int dcr_n, | |
63 | unsigned int dcr_c) | |
64 | { | |
65 | dcr_host_t host; | |
66 | struct device_node *dp; | |
67 | const char *prop; | |
68 | ||
69 | host.type = DCR_HOST_INVALID; | |
70 | ||
71 | dp = find_dcr_parent(dev); | |
72 | if (dp == NULL) | |
73 | return host; | |
74 | ||
75 | prop = of_get_property(dp, "dcr-access-method", NULL); | |
76 | ||
77 | pr_debug("dcr_map_generic(dcr-access-method = %s)\n", prop); | |
78 | ||
79 | if (!strcmp(prop, "native")) { | |
80 | host.type = DCR_HOST_NATIVE; | |
81 | host.host.native = dcr_map_native(dev, dcr_n, dcr_c); | |
82 | } else if (!strcmp(prop, "mmio")) { | |
83 | host.type = DCR_HOST_MMIO; | |
84 | host.host.mmio = dcr_map_mmio(dev, dcr_n, dcr_c); | |
85 | } | |
86 | ||
87 | of_node_put(dp); | |
88 | return host; | |
89 | } | |
90 | EXPORT_SYMBOL_GPL(dcr_map_generic); | |
91 | ||
92 | void dcr_unmap_generic(dcr_host_t host, unsigned int dcr_c) | |
93 | { | |
94 | if (host.type == DCR_HOST_NATIVE) | |
95 | dcr_unmap_native(host.host.native, dcr_c); | |
96 | else if (host.type == DCR_HOST_MMIO) | |
97 | dcr_unmap_mmio(host.host.mmio, dcr_c); | |
98 | else /* host.type == DCR_HOST_INVALID */ | |
99 | WARN_ON(true); | |
100 | } | |
101 | EXPORT_SYMBOL_GPL(dcr_unmap_generic); | |
102 | ||
103 | u32 dcr_read_generic(dcr_host_t host, unsigned int dcr_n) | |
104 | { | |
105 | if (host.type == DCR_HOST_NATIVE) | |
106 | return dcr_read_native(host.host.native, dcr_n); | |
107 | else if (host.type == DCR_HOST_MMIO) | |
108 | return dcr_read_mmio(host.host.mmio, dcr_n); | |
109 | else /* host.type == DCR_HOST_INVALID */ | |
110 | WARN_ON(true); | |
111 | return 0; | |
112 | } | |
113 | EXPORT_SYMBOL_GPL(dcr_read_generic); | |
114 | ||
115 | void dcr_write_generic(dcr_host_t host, unsigned int dcr_n, u32 value) | |
116 | { | |
117 | if (host.type == DCR_HOST_NATIVE) | |
118 | dcr_write_native(host.host.native, dcr_n, value); | |
119 | else if (host.type == DCR_HOST_MMIO) | |
120 | dcr_write_mmio(host.host.mmio, dcr_n, value); | |
121 | else /* host.type == DCR_HOST_INVALID */ | |
122 | WARN_ON(true); | |
123 | } | |
124 | EXPORT_SYMBOL_GPL(dcr_write_generic); | |
125 | ||
126 | #endif /* defined(CONFIG_PPC_DCR_NATIVE) && defined(CONFIG_PPC_DCR_MMIO) */ | |
127 | ||
e14d7749 GE |
128 | unsigned int dcr_resource_start(const struct device_node *np, |
129 | unsigned int index) | |
4c75a6f4 BH |
130 | { |
131 | unsigned int ds; | |
e2eb6392 | 132 | const u32 *dr = of_get_property(np, "dcr-reg", &ds); |
4c75a6f4 BH |
133 | |
134 | if (dr == NULL || ds & 1 || index >= (ds / 8)) | |
135 | return 0; | |
136 | ||
137 | return dr[index * 2]; | |
138 | } | |
96b952dd | 139 | EXPORT_SYMBOL_GPL(dcr_resource_start); |
4c75a6f4 | 140 | |
e14d7749 | 141 | unsigned int dcr_resource_len(const struct device_node *np, unsigned int index) |
4c75a6f4 BH |
142 | { |
143 | unsigned int ds; | |
e2eb6392 | 144 | const u32 *dr = of_get_property(np, "dcr-reg", &ds); |
4c75a6f4 BH |
145 | |
146 | if (dr == NULL || ds & 1 || index >= (ds / 8)) | |
147 | return 0; | |
148 | ||
149 | return dr[index * 2 + 1]; | |
150 | } | |
96b952dd | 151 | EXPORT_SYMBOL_GPL(dcr_resource_len); |
4c75a6f4 | 152 | |
b786af11 | 153 | #ifdef CONFIG_PPC_DCR_MMIO |
4c75a6f4 | 154 | |
ba52464a GL |
155 | static u64 of_translate_dcr_address(struct device_node *dev, |
156 | unsigned int dcr_n, | |
157 | unsigned int *out_stride) | |
4c75a6f4 BH |
158 | { |
159 | struct device_node *dp; | |
160 | const u32 *p; | |
161 | unsigned int stride; | |
b786af11 | 162 | u64 ret = OF_BAD_ADDR; |
4c75a6f4 BH |
163 | |
164 | dp = find_dcr_parent(dev); | |
165 | if (dp == NULL) | |
166 | return OF_BAD_ADDR; | |
167 | ||
168 | /* Stride is not properly defined yet, default to 0x10 for Axon */ | |
e2eb6392 | 169 | p = of_get_property(dp, "dcr-mmio-stride", NULL); |
4c75a6f4 BH |
170 | stride = (p == NULL) ? 0x10 : *p; |
171 | ||
172 | /* XXX FIXME: Which property name is to use of the 2 following ? */ | |
e2eb6392 | 173 | p = of_get_property(dp, "dcr-mmio-range", NULL); |
4c75a6f4 | 174 | if (p == NULL) |
e2eb6392 | 175 | p = of_get_property(dp, "dcr-mmio-space", NULL); |
4c75a6f4 | 176 | if (p == NULL) |
b786af11 | 177 | goto done; |
4c75a6f4 BH |
178 | |
179 | /* Maybe could do some better range checking here */ | |
180 | ret = of_translate_address(dp, p); | |
181 | if (ret != OF_BAD_ADDR) | |
182 | ret += (u64)(stride) * (u64)dcr_n; | |
183 | if (out_stride) | |
184 | *out_stride = stride; | |
b786af11 SN |
185 | |
186 | done: | |
187 | of_node_put(dp); | |
4c75a6f4 BH |
188 | return ret; |
189 | } | |
190 | ||
b786af11 SN |
191 | dcr_host_mmio_t dcr_map_mmio(struct device_node *dev, |
192 | unsigned int dcr_n, | |
193 | unsigned int dcr_c) | |
4c75a6f4 | 194 | { |
b786af11 | 195 | dcr_host_mmio_t ret = { .token = NULL, .stride = 0, .base = dcr_n }; |
4c75a6f4 BH |
196 | u64 addr; |
197 | ||
198 | pr_debug("dcr_map(%s, 0x%x, 0x%x)\n", | |
199 | dev->full_name, dcr_n, dcr_c); | |
200 | ||
201 | addr = of_translate_dcr_address(dev, dcr_n, &ret.stride); | |
b786af11 SN |
202 | pr_debug("translates to addr: 0x%llx, stride: 0x%x\n", |
203 | (unsigned long long) addr, ret.stride); | |
4c75a6f4 BH |
204 | if (addr == OF_BAD_ADDR) |
205 | return ret; | |
206 | pr_debug("mapping 0x%x bytes\n", dcr_c * ret.stride); | |
207 | ret.token = ioremap(addr, dcr_c * ret.stride); | |
208 | if (ret.token == NULL) | |
209 | return ret; | |
210 | pr_debug("mapped at 0x%p -> base is 0x%p\n", | |
211 | ret.token, ret.token - dcr_n * ret.stride); | |
212 | ret.token -= dcr_n * ret.stride; | |
213 | return ret; | |
214 | } | |
b786af11 | 215 | EXPORT_SYMBOL_GPL(dcr_map_mmio); |
4c75a6f4 | 216 | |
b786af11 | 217 | void dcr_unmap_mmio(dcr_host_mmio_t host, unsigned int dcr_c) |
4c75a6f4 | 218 | { |
b786af11 | 219 | dcr_host_mmio_t h = host; |
4c75a6f4 BH |
220 | |
221 | if (h.token == NULL) | |
222 | return; | |
cdbd3865 | 223 | h.token += host.base * h.stride; |
4c75a6f4 BH |
224 | iounmap(h.token); |
225 | h.token = NULL; | |
226 | } | |
b786af11 SN |
227 | EXPORT_SYMBOL_GPL(dcr_unmap_mmio); |
228 | ||
229 | #endif /* defined(CONFIG_PPC_DCR_MMIO) */ | |
230 | ||
231 | #ifdef CONFIG_PPC_DCR_NATIVE | |
853265e5 | 232 | DEFINE_SPINLOCK(dcr_ind_lock); |
22e55fcf | 233 | EXPORT_SYMBOL_GPL(dcr_ind_lock); |
b786af11 SN |
234 | #endif /* defined(CONFIG_PPC_DCR_NATIVE) */ |
235 |