1 /* $NetBSD: rbus.c,v 1.29 2012/01/27 18:53:07 para Exp $ */
2
3 /*
4 * Copyright (c) 1999 and 2000
5 * HAYAKAWA Koichi. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 */
27
28 #include <sys/cdefs.h>
29 __KERNEL_RCSID(0, "$NetBSD: rbus.c,v 1.29 2012/01/27 18:53:07 para Exp $");
30
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/device.h>
34 #include <sys/malloc.h>
35 #include <sys/extent.h>
36
37 #include <sys/bus.h>
38
39 #include <dev/cardbus/rbus.h>
40
41 /* #define RBUS_DEBUG */
42
43 #if defined RBUS_DEBUG
44 #define STATIC
45 #define DPRINTF(a) printf a
46 #else
47 #define STATIC static
48 #define DPRINTF(a)
49 #endif
50
51
52
53 static rbus_tag_t rbus_new_body(bus_space_tag_t bt, rbus_tag_t parent,
54 struct extent *ex, bus_addr_t start,
55 bus_addr_t end, bus_addr_t offset,
56 int flags);
57
58
59 int
rbus_space_alloc(rbus_tag_t rbt,bus_addr_t addr,bus_size_t size,bus_addr_t mask,bus_addr_t align,int flags,bus_addr_t * addrp,bus_space_handle_t * bshp)60 rbus_space_alloc(rbus_tag_t rbt, bus_addr_t addr, bus_size_t size, bus_addr_t mask, bus_addr_t align, int flags, bus_addr_t *addrp, bus_space_handle_t *bshp)
61 {
62 return rbus_space_alloc_subregion(rbt, rbt->rb_start, rbt->rb_end,
63 addr, size, mask, align, flags, addrp, bshp);
64 }
65
66
67
68
69 int
rbus_space_alloc_subregion(rbus_tag_t rbt,bus_addr_t substart,bus_addr_t subend,bus_addr_t addr,bus_size_t size,bus_addr_t mask,bus_addr_t align,int flags,bus_addr_t * addrp,bus_space_handle_t * bshp)70 rbus_space_alloc_subregion(rbus_tag_t rbt, bus_addr_t substart, bus_addr_t subend, bus_addr_t addr, bus_size_t size, bus_addr_t mask, bus_addr_t align, int flags, bus_addr_t *addrp, bus_space_handle_t *bshp)
71 {
72 bus_addr_t decodesize = mask + 1;
73 bus_addr_t boundary, search_addr;
74 int val;
75 u_long result;
76 int exflags = EX_FAST | EX_NOWAIT | EX_MALLOCOK;
77
78 DPRINTF(("rbus_space_alloc: addr %lx, size %lx, mask %lx, align %lx\n",
79 (u_long)addr, (u_long)size, (u_long)mask, (u_long)align));
80
81 addr += rbt->rb_offset;
82
83 if (mask == 0) {
84 /* FULL Decode */
85 decodesize = 0;
86 }
87
88 if (rbt->rb_flags == RBUS_SPACE_ASK_PARENT) {
89 return rbus_space_alloc(rbt->rb_parent, addr, size, mask,
90 align, flags, addrp, bshp);
91 } else if (rbt->rb_flags == RBUS_SPACE_SHARE ||
92 rbt->rb_flags == RBUS_SPACE_DEDICATE) {
93 /* rbt has its own sh_extent */
94
95 /*
96 * sanity check: the subregion [substart, subend] should be
97 * smaller than the region included in sh_extent.
98 */
99 if (substart < rbt->rb_ext->ex_start
100 || subend > rbt->rb_ext->ex_end) {
101 DPRINTF(("rbus: out of range\n"));
102 return 1;
103 }
104
105 if (decodesize == align) {
106 if(extent_alloc_subregion(rbt->rb_ext, substart,
107 subend, size, align, 0, exflags, &result)) {
108 return 1;
109 }
110 } else if (decodesize == 0) {
111 /* maybe, the register is overflowed. */
112
113 if (extent_alloc_subregion(rbt->rb_ext, addr,
114 addr + size, size, 1, 0, exflags, &result)) {
115 return 1;
116 }
117 } else {
118
119 boundary = decodesize > align ? decodesize : align;
120
121 search_addr = (substart & ~(boundary - 1)) + addr;
122
123 if (search_addr < substart) {
124 search_addr += boundary;
125 }
126
127 val = 1;
128 for (; search_addr + size <= subend;
129 search_addr += boundary) {
130 val = extent_alloc_subregion(rbt->rb_ext,
131 search_addr, search_addr + size, size,
132 align, 0, exflags, &result);
133 DPRINTF(("rbus: trying [%lx:%lx] %lx\n",
134 (u_long)search_addr,
135 (u_long)search_addr + size, (u_long)align));
136 if (val == 0) {
137 break;
138 }
139 }
140 if (val != 0) {
141 /* no space found */
142 DPRINTF(("rbus: no space found\n"));
143 return 1;
144 }
145 }
146
147 if(md_space_map(rbt->rb_bt, result, size, flags, bshp)) {
148 /* map failed */
149 extent_free(rbt->rb_ext, result, size, exflags);
150 return 1;
151 }
152
153 if (addrp != NULL) {
154 *addrp = result + rbt->rb_offset;
155 }
156 return 0;
157 } else {
158 /* error!! */
159 DPRINTF(("rbus: no rbus type\n"));
160 return 1;
161 }
162 }
163
164
165
166
167
168 int
rbus_space_free(rbus_tag_t rbt,bus_space_handle_t bsh,bus_size_t size,bus_addr_t * addrp)169 rbus_space_free(rbus_tag_t rbt, bus_space_handle_t bsh, bus_size_t size, bus_addr_t *addrp)
170 {
171 int exflags = EX_FAST | EX_NOWAIT;
172 bus_addr_t addr;
173 int status = 1;
174
175 if (rbt->rb_flags == RBUS_SPACE_ASK_PARENT) {
176 status = rbus_space_free(rbt->rb_parent, bsh, size, &addr);
177 } else if (rbt->rb_flags == RBUS_SPACE_SHARE ||
178 rbt->rb_flags == RBUS_SPACE_DEDICATE) {
179 md_space_unmap(rbt->rb_bt, bsh, size, &addr);
180
181 extent_free(rbt->rb_ext, addr, size, exflags);
182
183 status = 0;
184 } else {
185 /* error. INVALID rbustag */
186 status = 1;
187 }
188 if (status == 0 && addrp != NULL) {
189 *addrp = addr;
190 }
191 return status;
192 }
193
194
195
196 /*
197 * static rbus_tag_t
198 * rbus_new_body(bus_space_tag_t bt, rbus_tag_t parent,
199 * struct extent *ex, bus_addr_t start, bus_size_t end,
200 * bus_addr_t offset, int flags)
201 *
202 */
203 static rbus_tag_t
rbus_new_body(bus_space_tag_t bt,rbus_tag_t parent,struct extent * ex,bus_addr_t start,bus_addr_t end,bus_addr_t offset,int flags)204 rbus_new_body(bus_space_tag_t bt, rbus_tag_t parent, struct extent *ex, bus_addr_t start, bus_addr_t end, bus_addr_t offset, int flags)
205 {
206 rbus_tag_t rb;
207
208 /* sanity check */
209 if (parent != NULL) {
210 if (start < parent->rb_start || end > parent->rb_end) {
211 /*
212 * out of range: [start, size] should be
213 * contained in parent space
214 */
215 return 0;
216 /* Should I invoke panic? */
217 }
218 }
219
220 if (NULL == (rb = (rbus_tag_t)malloc(sizeof(struct rbustag), M_DEVBUF,
221 M_NOWAIT))) {
222 panic("no memory for rbus instance");
223 }
224
225 rb->rb_bt = bt;
226 rb->rb_parent = parent;
227 rb->rb_start = start;
228 rb->rb_end = end;
229 rb->rb_offset = offset;
230 rb->rb_flags = flags;
231 rb->rb_ext = ex;
232
233 DPRINTF(("rbus_new_body: [%lx, %lx] type %s name [%s]\n",
234 (u_long)start, (u_long)end,
235 flags == RBUS_SPACE_SHARE ? "share" :
236 flags == RBUS_SPACE_DEDICATE ? "dedicated" :
237 flags == RBUS_SPACE_ASK_PARENT ? "parent" : "invalid",
238 ex != NULL ? ex->ex_name : "noname"));
239
240 return rb;
241 }
242
243
244
245 /*
246 * rbus_tag_t rbus_new(rbus_tag_t parent, bus_addr_t start, bus_size_t
247 * size, bus_addr_t offset, int flags)
248 *
249 * This function makes a new child rbus instance.
250 */
251 rbus_tag_t
rbus_new(rbus_tag_t parent,bus_addr_t start,bus_size_t size,bus_addr_t offset,int flags)252 rbus_new(rbus_tag_t parent, bus_addr_t start, bus_size_t size, bus_addr_t offset, int flags)
253 {
254 rbus_tag_t rb;
255 struct extent *ex = NULL;
256 bus_addr_t end = start + size;
257
258 if (flags == RBUS_SPACE_SHARE) {
259 ex = parent->rb_ext;
260 } else if (flags == RBUS_SPACE_DEDICATE) {
261 if (NULL == (ex = extent_create("rbus", start, end,
262 NULL, 0, EX_NOCOALESCE|EX_NOWAIT))) {
263 return NULL;
264 }
265 } else if (flags == RBUS_SPACE_ASK_PARENT) {
266 ex = NULL;
267 } else {
268 /* Invalid flag */
269 return 0;
270 }
271
272 rb = rbus_new_body(parent->rb_bt, parent, ex, start, start + size,
273 offset, flags);
274
275 if ((rb == NULL) && (flags == RBUS_SPACE_DEDICATE)) {
276 extent_destroy(ex);
277 }
278
279 return rb;
280 }
281
282
283
284
285 /*
286 * rbus_tag_t rbus_new_root_delegate(bus_space_tag, bus_addr_t,
287 * bus_size_t, bus_addr_t offset)
288 *
289 * This function makes a root rbus instance.
290 */
291 rbus_tag_t
rbus_new_root_delegate(bus_space_tag_t bt,bus_addr_t start,bus_size_t size,bus_addr_t offset)292 rbus_new_root_delegate(bus_space_tag_t bt, bus_addr_t start, bus_size_t size, bus_addr_t offset)
293 {
294 rbus_tag_t rb;
295 struct extent *ex;
296
297 if (NULL == (ex = extent_create("rbus root", start, start + size,
298 NULL, 0, EX_NOCOALESCE|EX_NOWAIT))) {
299 return NULL;
300 }
301
302 rb = rbus_new_body(bt, NULL, ex, start, start + size, offset,
303 RBUS_SPACE_DEDICATE);
304
305 if (rb == NULL) {
306 extent_destroy(ex);
307 }
308
309 return rb;
310 }
311
312
313
314 /*
315 * rbus_tag_t rbus_new_root_share(bus_space_tag, struct extent *,
316 * bus_addr_t, bus_size_t, bus_addr_t offset)
317 *
318 * This function makes a root rbus instance.
319 */
320 rbus_tag_t
rbus_new_root_share(bus_space_tag_t bt,struct extent * ex,bus_addr_t start,bus_size_t size,bus_addr_t offset)321 rbus_new_root_share(bus_space_tag_t bt, struct extent *ex, bus_addr_t start, bus_size_t size, bus_addr_t offset)
322 {
323 /* sanity check */
324 if (start < ex->ex_start || start + size > ex->ex_end) {
325 /*
326 * out of range: [start, size] should be contained in
327 * parent space
328 */
329 return 0;
330 /* Should I invoke panic? */
331 }
332
333 return rbus_new_body(bt, NULL, ex, start, start + size, offset,
334 RBUS_SPACE_SHARE);
335 }
336
337
338
339
340
341 /*
342 * int rbus_delete (rbus_tag_t rb)
343 *
344 * This function deletes the rbus structure pointed in the argument.
345 */
346 int
rbus_delete(rbus_tag_t rb)347 rbus_delete(rbus_tag_t rb)
348 {
349 DPRINTF(("rbus_delete called [%s]\n",
350 rb->rb_ext != NULL ? rb->rb_ext->ex_name : "noname"));
351 if (rb->rb_flags == RBUS_SPACE_DEDICATE) {
352 extent_destroy(rb->rb_ext);
353 }
354
355 free(rb, M_DEVBUF);
356
357 return 0;
358 }
359