Home | History | Annotate | Line # | Download | only in fdt
fdt_subr.c revision 1.5.4.1
      1  1.5.4.1  pgoyette /* $NetBSD: fdt_subr.c,v 1.5.4.1 2017/04/26 02:53:11 pgoyette Exp $ */
      2      1.1  jmcneill 
      3      1.1  jmcneill /*-
      4      1.1  jmcneill  * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca>
      5      1.1  jmcneill  * All rights reserved.
      6      1.1  jmcneill  *
      7      1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8      1.1  jmcneill  * modification, are permitted provided that the following conditions
      9      1.1  jmcneill  * are met:
     10      1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11      1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12      1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13      1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14      1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15      1.1  jmcneill  *
     16      1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17      1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18      1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19      1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20      1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21      1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22      1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23      1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24      1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25      1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26      1.1  jmcneill  * SUCH DAMAGE.
     27      1.1  jmcneill  */
     28      1.1  jmcneill 
     29      1.1  jmcneill #include <sys/cdefs.h>
     30  1.5.4.1  pgoyette __KERNEL_RCSID(0, "$NetBSD: fdt_subr.c,v 1.5.4.1 2017/04/26 02:53:11 pgoyette Exp $");
     31      1.1  jmcneill 
     32      1.1  jmcneill #include <sys/param.h>
     33      1.1  jmcneill #include <sys/bus.h>
     34      1.1  jmcneill #include <sys/kmem.h>
     35      1.1  jmcneill 
     36      1.1  jmcneill #include <libfdt.h>
     37      1.1  jmcneill #include <dev/fdt/fdtvar.h>
     38      1.1  jmcneill 
     39      1.3  jmcneill static const void *fdt_data;
     40      1.3  jmcneill 
     41      1.3  jmcneill bool
     42      1.3  jmcneill fdtbus_set_data(const void *data)
     43      1.3  jmcneill {
     44      1.3  jmcneill 	KASSERT(fdt_data == NULL);
     45      1.3  jmcneill 	if (fdt_check_header(data) != 0) {
     46      1.3  jmcneill 		return false;
     47      1.3  jmcneill 	}
     48      1.3  jmcneill 	fdt_data = data;
     49      1.3  jmcneill 	return true;
     50      1.3  jmcneill }
     51      1.3  jmcneill 
     52      1.3  jmcneill const void *
     53      1.3  jmcneill fdtbus_get_data(void)
     54      1.3  jmcneill {
     55      1.3  jmcneill 	return fdt_data;
     56      1.3  jmcneill }
     57      1.3  jmcneill 
     58      1.3  jmcneill int
     59      1.3  jmcneill fdtbus_offset2phandle(int offset)
     60      1.3  jmcneill {
     61      1.3  jmcneill 	if (offset < 0)
     62      1.3  jmcneill 		return 0;
     63      1.3  jmcneill 
     64      1.3  jmcneill 	return offset + fdt_off_dt_struct(fdt_data);
     65      1.3  jmcneill }
     66      1.3  jmcneill 
     67      1.3  jmcneill int
     68      1.3  jmcneill fdtbus_phandle2offset(int phandle)
     69      1.3  jmcneill {
     70      1.3  jmcneill 	const int dtoff = fdt_off_dt_struct(fdt_data);
     71      1.3  jmcneill 
     72      1.3  jmcneill 	if (phandle == -1)
     73      1.3  jmcneill 		phandle = dtoff;
     74      1.3  jmcneill 
     75      1.3  jmcneill 	if (phandle < dtoff)
     76      1.3  jmcneill 		return -1;
     77      1.3  jmcneill 
     78      1.3  jmcneill 	return phandle - dtoff;
     79      1.3  jmcneill }
     80      1.3  jmcneill 
     81      1.3  jmcneill 
     82      1.1  jmcneill static int
     83      1.1  jmcneill fdtbus_get_addr_cells(int phandle)
     84      1.1  jmcneill {
     85      1.4  jmcneill 	uint32_t addr_cells;
     86      1.1  jmcneill 
     87      1.1  jmcneill 	const int parent = OF_parent(phandle);
     88      1.1  jmcneill 	if (parent == -1)
     89      1.1  jmcneill 		return -1;
     90      1.1  jmcneill 
     91      1.4  jmcneill 	if (of_getprop_uint32(parent, "#address-cells", &addr_cells))
     92      1.1  jmcneill 		addr_cells = 2;
     93      1.1  jmcneill 
     94      1.1  jmcneill 	return addr_cells;
     95      1.1  jmcneill }
     96      1.1  jmcneill 
     97      1.1  jmcneill static int
     98      1.1  jmcneill fdtbus_get_size_cells(int phandle)
     99      1.1  jmcneill {
    100      1.4  jmcneill 	uint32_t size_cells;
    101      1.1  jmcneill 
    102      1.1  jmcneill 	const int parent = OF_parent(phandle);
    103      1.1  jmcneill 	if (parent == -1)
    104      1.1  jmcneill 		return -1;
    105      1.1  jmcneill 
    106      1.4  jmcneill 	if (of_getprop_uint32(parent, "#size-cells", &size_cells))
    107      1.1  jmcneill 		size_cells = 0;
    108      1.1  jmcneill 
    109      1.1  jmcneill 	return size_cells;
    110      1.1  jmcneill }
    111      1.1  jmcneill 
    112      1.1  jmcneill int
    113      1.1  jmcneill fdtbus_get_phandle(int phandle, const char *prop)
    114      1.1  jmcneill {
    115      1.1  jmcneill 	u_int phandle_ref;
    116      1.1  jmcneill 	u_int *buf;
    117      1.1  jmcneill 	int len;
    118      1.1  jmcneill 
    119      1.1  jmcneill 	len = OF_getproplen(phandle, prop);
    120      1.1  jmcneill 	if (len < sizeof(phandle_ref))
    121      1.1  jmcneill 		return -1;
    122      1.1  jmcneill 
    123      1.1  jmcneill 	buf = kmem_alloc(len, KM_SLEEP);
    124      1.1  jmcneill 
    125      1.1  jmcneill 	if (OF_getprop(phandle, prop, buf, len) != len) {
    126      1.1  jmcneill 		kmem_free(buf, len);
    127      1.1  jmcneill 		return -1;
    128      1.1  jmcneill 	}
    129      1.1  jmcneill 
    130      1.1  jmcneill 	phandle_ref = fdt32_to_cpu(buf[0]);
    131      1.1  jmcneill 	kmem_free(buf, len);
    132      1.1  jmcneill 
    133      1.5  jmcneill 	return fdtbus_get_phandle_from_native(phandle_ref);
    134      1.5  jmcneill }
    135      1.5  jmcneill 
    136      1.5  jmcneill int
    137      1.5  jmcneill fdtbus_get_phandle_from_native(int phandle)
    138      1.5  jmcneill {
    139      1.5  jmcneill 	const int off = fdt_node_offset_by_phandle(fdt_data, phandle);
    140      1.1  jmcneill 	if (off < 0) {
    141      1.1  jmcneill 		return -1;
    142      1.1  jmcneill 	}
    143      1.3  jmcneill 	return fdtbus_offset2phandle(off);
    144      1.1  jmcneill }
    145      1.1  jmcneill 
    146  1.5.4.1  pgoyette bool
    147  1.5.4.1  pgoyette fdtbus_get_path(int phandle, char *buf, size_t buflen)
    148  1.5.4.1  pgoyette {
    149  1.5.4.1  pgoyette 	const int off = fdtbus_phandle2offset(phandle);
    150  1.5.4.1  pgoyette 	if (off < 0) {
    151  1.5.4.1  pgoyette 		return false;
    152  1.5.4.1  pgoyette 	}
    153  1.5.4.1  pgoyette 	if (fdt_get_path(fdt_data, off, buf, (int)buflen) != 0) {
    154  1.5.4.1  pgoyette 		return false;
    155  1.5.4.1  pgoyette 	}
    156  1.5.4.1  pgoyette 	return true;
    157  1.5.4.1  pgoyette }
    158  1.5.4.1  pgoyette 
    159      1.1  jmcneill int
    160      1.1  jmcneill fdtbus_get_reg(int phandle, u_int index, bus_addr_t *paddr, bus_size_t *psize)
    161      1.1  jmcneill {
    162      1.1  jmcneill 	bus_addr_t addr;
    163      1.1  jmcneill 	bus_size_t size;
    164  1.5.4.1  pgoyette 	const uint8_t *buf;
    165      1.1  jmcneill 	int len;
    166      1.1  jmcneill 
    167      1.1  jmcneill 	const int addr_cells = fdtbus_get_addr_cells(phandle);
    168      1.1  jmcneill 	const int size_cells = fdtbus_get_size_cells(phandle);
    169      1.1  jmcneill 	if (addr_cells == -1 || size_cells == -1)
    170      1.1  jmcneill 		return -1;
    171      1.1  jmcneill 
    172  1.5.4.1  pgoyette 	buf = fdt_getprop(fdtbus_get_data(),
    173  1.5.4.1  pgoyette 	    fdtbus_phandle2offset(phandle), "reg", &len);
    174  1.5.4.1  pgoyette 	if (buf == NULL || len <= 0)
    175      1.1  jmcneill 		return -1;
    176      1.1  jmcneill 
    177  1.5.4.1  pgoyette 	const u_int reglen = size_cells * 4 + addr_cells * 4;
    178  1.5.4.1  pgoyette 	if (reglen == 0)
    179      1.1  jmcneill 		return -1;
    180      1.1  jmcneill 
    181  1.5.4.1  pgoyette 	if (index >= len / reglen)
    182      1.1  jmcneill 		return -1;
    183      1.1  jmcneill 
    184      1.1  jmcneill 	switch (addr_cells) {
    185      1.1  jmcneill 	case 0:
    186      1.1  jmcneill 		addr = 0;
    187      1.1  jmcneill 		break;
    188      1.1  jmcneill 	case 1:
    189      1.1  jmcneill 		addr = be32dec(&buf[index * reglen + 0]);
    190      1.1  jmcneill 		break;
    191      1.1  jmcneill 	case 2:
    192      1.1  jmcneill 		addr = be64dec(&buf[index * reglen + 0]);
    193      1.1  jmcneill 		break;
    194      1.1  jmcneill 	default:
    195      1.1  jmcneill 		panic("fdtbus_get_reg: unsupported addr_cells %d", addr_cells);
    196      1.1  jmcneill 	}
    197      1.1  jmcneill 
    198      1.1  jmcneill 	switch (size_cells) {
    199      1.1  jmcneill 	case 0:
    200      1.1  jmcneill 		size = 0;
    201      1.1  jmcneill 		break;
    202      1.1  jmcneill 	case 1:
    203      1.1  jmcneill 		size = be32dec(&buf[index * reglen + addr_cells * 4]);
    204      1.1  jmcneill 		break;
    205      1.1  jmcneill 	case 2:
    206      1.1  jmcneill 		size = be64dec(&buf[index * reglen + addr_cells * 4]);
    207      1.1  jmcneill 		break;
    208      1.1  jmcneill 	default:
    209      1.1  jmcneill 		panic("fdtbus_get_reg: unsupported size_cells %d", size_cells);
    210      1.1  jmcneill 	}
    211      1.1  jmcneill 
    212      1.1  jmcneill 	if (paddr)
    213      1.1  jmcneill 		*paddr = addr;
    214      1.1  jmcneill 	if (psize)
    215      1.1  jmcneill 		*psize = size;
    216      1.1  jmcneill 
    217      1.1  jmcneill 	return 0;
    218      1.1  jmcneill }
    219  1.5.4.1  pgoyette 
    220  1.5.4.1  pgoyette const char *
    221  1.5.4.1  pgoyette fdtbus_get_stdout_path(void)
    222  1.5.4.1  pgoyette {
    223  1.5.4.1  pgoyette 	const char *prop;
    224  1.5.4.1  pgoyette 
    225  1.5.4.1  pgoyette 	const int off = fdt_path_offset(fdtbus_get_data(), "/chosen");
    226  1.5.4.1  pgoyette 	if (off < 0)
    227  1.5.4.1  pgoyette 		return NULL;
    228  1.5.4.1  pgoyette 
    229  1.5.4.1  pgoyette 	prop = fdt_getprop(fdtbus_get_data(), off, "stdout-path", NULL);
    230  1.5.4.1  pgoyette 	if (prop != NULL)
    231  1.5.4.1  pgoyette 		return prop;
    232  1.5.4.1  pgoyette 
    233  1.5.4.1  pgoyette 	/* If the stdout-path property is not found, assume serial0 */
    234  1.5.4.1  pgoyette 	return "serial0:115200n8";
    235  1.5.4.1  pgoyette }
    236  1.5.4.1  pgoyette 
    237  1.5.4.1  pgoyette int
    238  1.5.4.1  pgoyette fdtbus_get_stdout_phandle(void)
    239  1.5.4.1  pgoyette {
    240  1.5.4.1  pgoyette 	const char *prop, *p;
    241  1.5.4.1  pgoyette 	int off, len;
    242  1.5.4.1  pgoyette 
    243  1.5.4.1  pgoyette 	prop = fdtbus_get_stdout_path();
    244  1.5.4.1  pgoyette 	if (prop == NULL)
    245  1.5.4.1  pgoyette 		return -1;
    246  1.5.4.1  pgoyette 
    247  1.5.4.1  pgoyette 	p = strchr(prop, ':');
    248  1.5.4.1  pgoyette 	len = p == NULL ? strlen(prop) : (p - prop);
    249  1.5.4.1  pgoyette 	if (*prop != '/') {
    250  1.5.4.1  pgoyette 		/* Alias */
    251  1.5.4.1  pgoyette 		prop = fdt_get_alias_namelen(fdtbus_get_data(), prop, len);
    252  1.5.4.1  pgoyette 		if (prop == NULL)
    253  1.5.4.1  pgoyette 			return -1;
    254  1.5.4.1  pgoyette 		len = strlen(prop);
    255  1.5.4.1  pgoyette 	}
    256  1.5.4.1  pgoyette 	off = fdt_path_offset_namelen(fdtbus_get_data(), prop, len);
    257  1.5.4.1  pgoyette 	if (off < 0)
    258  1.5.4.1  pgoyette 		return -1;
    259  1.5.4.1  pgoyette 
    260  1.5.4.1  pgoyette 	return fdtbus_offset2phandle(off);
    261  1.5.4.1  pgoyette }
    262  1.5.4.1  pgoyette 
    263  1.5.4.1  pgoyette int
    264  1.5.4.1  pgoyette fdtbus_get_stdout_speed(void)
    265  1.5.4.1  pgoyette {
    266  1.5.4.1  pgoyette 	const char *prop, *p;
    267  1.5.4.1  pgoyette 
    268  1.5.4.1  pgoyette 	prop = fdtbus_get_stdout_path();
    269  1.5.4.1  pgoyette 	if (prop == NULL)
    270  1.5.4.1  pgoyette 		return -1;
    271  1.5.4.1  pgoyette 
    272  1.5.4.1  pgoyette 	p = strchr(prop, ':');
    273  1.5.4.1  pgoyette 	if (p == NULL)
    274  1.5.4.1  pgoyette 		return -1;
    275  1.5.4.1  pgoyette 
    276  1.5.4.1  pgoyette 	return (int)strtoul(p + 1, NULL, 10);
    277  1.5.4.1  pgoyette }
    278