Home | History | Annotate | Line # | Download | only in cardbus 
      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
     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
     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
    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
    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
    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
    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
    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
    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