1 /*- 2 * Copyright (c) 2012 Semihalf. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <sys/param.h> 31 #include <sys/systm.h> 32 #include <sys/kernel.h> 33 #include <sys/module.h> 34 #include <sys/slicer.h> 35 36 #include <dev/fdt/fdt_common.h> 37 38 #define DEBUG 39 #undef DEBUG 40 41 #ifdef DEBUG 42 #define debugf(fmt, args...) do { printf("%s(): ", __func__); \ 43 printf(fmt,##args); } while (0) 44 #else 45 #define debugf(fmt, args...) 46 #endif 47 48 int 49 flash_fill_slices(device_t dev, struct flash_slice *slices, int *slices_num) 50 { 51 char *slice_name; 52 phandle_t dt_node, dt_child; 53 u_long base, size; 54 int i; 55 ssize_t name_len; 56 57 /* 58 * We assume the caller provides buffer for FLASH_SLICES_MAX_NUM 59 * flash_slice structures. 60 */ 61 if (slices == NULL) { 62 *slices_num = 0; 63 return (ENOMEM); 64 } 65 66 dt_node = ofw_bus_get_node(dev); 67 for (dt_child = OF_child(dt_node), i = 0; dt_child != 0; 68 dt_child = OF_peer(dt_child)) { 69 70 if (i == FLASH_SLICES_MAX_NUM) { 71 debugf("not enough buffer for slice i=%d\n", i); 72 break; 73 } 74 75 /* 76 * Retrieve start and size of the slice. 77 */ 78 if (fdt_regsize(dt_child, &base, &size) != 0) { 79 debugf("error during processing reg property, i=%d\n", 80 i); 81 continue; 82 } 83 84 if (size == 0) { 85 debugf("slice i=%d with no size\n", i); 86 continue; 87 } 88 89 /* 90 * Retrieve label. 91 */ 92 name_len = OF_getprop_alloc(dt_child, "label", sizeof(char), 93 (void **)&slice_name); 94 if (name_len <= 0) { 95 /* Use node name if no label defined */ 96 name_len = OF_getprop_alloc(dt_child, "name", sizeof(char), 97 (void **)&slice_name); 98 if (name_len <= 0) { 99 debugf("slice i=%d with no name\n", i); 100 slice_name = NULL; 101 } 102 } 103 104 /* 105 * Fill slice entry data. 106 */ 107 slices[i].base = base; 108 slices[i].size = size; 109 slices[i].label = slice_name; 110 i++; 111 } 112 113 *slices_num = i; 114 return (0); 115 } 116