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 #ifdef DEBUG 39 #define debugf(fmt, args...) do { printf("%s(): ", __func__); \ 40 printf(fmt,##args); } while (0) 41 #else 42 #define debugf(fmt, args...) 43 #endif 44 45 int 46 fdt_flash_fill_slices(device_t dev, struct flash_slice *slices, int *slices_num) 47 { 48 char *slice_name; 49 phandle_t dt_node, dt_child; 50 u_long base, size; 51 int i; 52 ssize_t name_len; 53 54 /* 55 * We assume the caller provides buffer for FLASH_SLICES_MAX_NUM 56 * flash_slice structures. 57 */ 58 if (slices == NULL) { 59 *slices_num = 0; 60 return (ENOMEM); 61 } 62 63 dt_node = ofw_bus_get_node(dev); 64 for (dt_child = OF_child(dt_node), i = 0; dt_child != 0; 65 dt_child = OF_peer(dt_child)) { 66 67 if (i == FLASH_SLICES_MAX_NUM) { 68 debugf("not enough buffer for slice i=%d\n", i); 69 break; 70 } 71 72 /* 73 * Retrieve start and size of the slice. 74 */ 75 if (fdt_regsize(dt_child, &base, &size) != 0) { 76 debugf("error during processing reg property, i=%d\n", 77 i); 78 continue; 79 } 80 81 if (size == 0) { 82 debugf("slice i=%d with no size\n", i); 83 continue; 84 } 85 86 /* 87 * Retrieve label. 88 */ 89 name_len = OF_getprop_alloc(dt_child, "label", sizeof(char), 90 (void **)&slice_name); 91 if (name_len <= 0) { 92 /* Use node name if no label defined */ 93 name_len = OF_getprop_alloc(dt_child, "name", sizeof(char), 94 (void **)&slice_name); 95 if (name_len <= 0) { 96 debugf("slice i=%d with no name\n", i); 97 slice_name = NULL; 98 } 99 } 100 101 /* 102 * Fill slice entry data. 103 */ 104 slices[i].base = base; 105 slices[i].size = size; 106 slices[i].label = slice_name; 107 i++; 108 } 109 110 *slices_num = i; 111 return (0); 112 } 113