2 * Copyright (c) 2009-2014 The FreeBSD Foundation
5 * This software was developed by Andrew Turner under sponsorship from
6 * the FreeBSD Foundation.
7 * This software was developed by Semihalf under sponsorship from
8 * the FreeBSD Foundation.
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD$");
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/module.h>
40 #include <sys/limits.h>
42 #include <machine/resource.h>
44 #include <dev/fdt/fdt_common.h>
45 #include <dev/ofw/ofw_bus.h>
46 #include <dev/ofw/ofw_bus_subr.h>
47 #include <dev/ofw/openfirm.h>
49 #include "ofw_bus_if.h"
52 #define debugf(fmt, args...) do { printf("%s(): ", __func__); \
53 printf(fmt,##args); } while (0)
55 #define debugf(fmt, args...)
58 #define FDT_COMPAT_LEN 255
59 #define FDT_TYPE_LEN 64
60 #define FDT_NAME_LEN 32
62 #define FDT_REG_CELLS 4
64 vm_paddr_t fdt_immr_pa;
65 vm_offset_t fdt_immr_va;
66 vm_offset_t fdt_immr_size;
68 struct fdt_ic_list fdt_ic_list_head = SLIST_HEAD_INITIALIZER(fdt_ic_list_head);
71 fdt_get_range_by_busaddr(phandle_t node, u_long addr, u_long *base,
74 pcell_t ranges[32], *rangesptr;
75 pcell_t addr_cells, size_cells, par_addr_cells;
76 u_long bus_addr, par_bus_addr, pbase, psize;
77 int err, i, len, tuple_size, tuples;
85 if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
88 * Process 'ranges' property.
90 par_addr_cells = fdt_parent_addr_cells(node);
91 if (par_addr_cells > 2) {
95 len = OF_getproplen(node, "ranges");
98 if (len > sizeof(ranges))
101 return (fdt_get_range_by_busaddr(OF_parent(node), addr,
105 if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
108 tuple_size = addr_cells + par_addr_cells + size_cells;
109 tuples = len / (tuple_size * sizeof(cell_t));
111 if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
117 for (i = 0; i < tuples; i++) {
118 rangesptr = &ranges[i * tuple_size];
120 bus_addr = fdt_data_get((void *)rangesptr, addr_cells);
121 if (bus_addr != addr)
123 rangesptr += addr_cells;
125 par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
126 rangesptr += par_addr_cells;
128 err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
135 *base = par_bus_addr;
137 *size = fdt_data_get((void *)rangesptr, size_cells);
146 fdt_get_range(phandle_t node, int range_id, u_long *base, u_long *size)
148 pcell_t ranges[6], *rangesptr;
149 pcell_t addr_cells, size_cells, par_addr_cells;
150 u_long par_bus_addr, pbase, psize;
151 int err, len, tuple_size, tuples;
153 if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
156 * Process 'ranges' property.
158 par_addr_cells = fdt_parent_addr_cells(node);
159 if (par_addr_cells > 2)
162 len = OF_getproplen(node, "ranges");
163 if (len > sizeof(ranges))
171 if (!(range_id < len))
174 if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
177 tuple_size = sizeof(pcell_t) * (addr_cells + par_addr_cells +
179 tuples = len / tuple_size;
181 if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
186 rangesptr = &ranges[range_id];
188 *base = fdt_data_get((void *)rangesptr, addr_cells);
189 rangesptr += addr_cells;
191 par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
192 rangesptr += par_addr_cells;
194 err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
199 *base += par_bus_addr;
201 *size = fdt_data_get((void *)rangesptr, size_cells);
206 fdt_immr_addr(vm_offset_t immr_va)
213 * Try to access the SOC node directly i.e. through /aliases/.
215 if ((node = OF_finddevice("soc")) != 0)
216 if (fdt_is_compatible_strict(node, "simple-bus"))
219 * Find the node the long way.
221 if ((node = OF_finddevice("/")) == 0)
224 if ((node = fdt_find_compatible(node, "simple-bus", 1)) == 0)
228 if ((r = fdt_get_range(node, 0, &base, &size)) == 0) {
230 fdt_immr_va = immr_va;
231 fdt_immr_size = size;
238 * This routine is an early-usage version of the ofw_bus_is_compatible() when
239 * the ofw_bus I/F is not available (like early console routines and similar).
240 * Note the buffer has to be on the stack since malloc() is usually not
241 * available in such cases either.
244 fdt_is_compatible(phandle_t node, const char *compatstr)
246 char buf[FDT_COMPAT_LEN];
248 int len, onelen, l, rv;
250 if ((len = OF_getproplen(node, "compatible")) <= 0)
253 compat = (char *)&buf;
254 bzero(compat, FDT_COMPAT_LEN);
256 if (OF_getprop(node, "compatible", compat, FDT_COMPAT_LEN) < 0)
259 onelen = strlen(compatstr);
262 if (strncasecmp(compat, compatstr, onelen) == 0) {
267 /* Slide to the next sub-string. */
268 l = strlen(compat) + 1;
277 fdt_is_compatible_strict(phandle_t node, const char *compatible)
279 char compat[FDT_COMPAT_LEN];
281 if (OF_getproplen(node, "compatible") <= 0)
284 if (OF_getprop(node, "compatible", compat, FDT_COMPAT_LEN) < 0)
287 if (strncasecmp(compat, compatible, FDT_COMPAT_LEN) == 0)
295 fdt_find_compatible(phandle_t start, const char *compat, int strict)
300 * Traverse all children of 'start' node, and find first with
301 * matching 'compatible' property.
303 for (child = OF_child(start); child != 0; child = OF_peer(child))
304 if (fdt_is_compatible(child, compat)) {
306 if (!fdt_is_compatible_strict(child, compat))
314 fdt_find_child(phandle_t start, const char *child_name)
316 char name[FDT_NAME_LEN];
319 for (child = OF_child(start); child != 0; child = OF_peer(child)) {
320 if (OF_getprop(child, "name", name, sizeof(name)) <= 0)
322 if (strcmp(name, child_name) == 0)
330 fdt_depth_search_compatible(phandle_t start, const char *compat, int strict)
332 phandle_t child, node;
335 * Depth-search all descendants of 'start' node, and find first with
336 * matching 'compatible' property.
338 for (node = OF_child(start); node != 0; node = OF_peer(node)) {
339 if (fdt_is_compatible(node, compat) &&
340 (strict == 0 || fdt_is_compatible_strict(node, compat))) {
343 child = fdt_depth_search_compatible(node, compat, strict);
351 fdt_is_enabled(phandle_t node)
356 len = OF_getprop_alloc(node, "status", sizeof(char),
360 /* It is OK if no 'status' property. */
363 /* Anything other than 'okay' means disabled. */
365 if (strncmp((char *)stat, "okay", len) == 0)
368 free(stat, M_OFWPROP);
373 fdt_is_type(phandle_t node, const char *typestr)
375 char type[FDT_TYPE_LEN];
377 if (OF_getproplen(node, "device_type") <= 0)
380 if (OF_getprop(node, "device_type", type, FDT_TYPE_LEN) < 0)
383 if (strncasecmp(type, typestr, FDT_TYPE_LEN) == 0)
391 fdt_parent_addr_cells(phandle_t node)
395 /* Find out #address-cells of the superior bus. */
396 if (OF_searchprop(OF_parent(node), "#address-cells", &addr_cells,
397 sizeof(addr_cells)) <= 0)
400 return ((int)fdt32_to_cpu(addr_cells));
404 fdt_pm_is_enabled(phandle_t node)
410 #if defined(SOC_MV_KIRKWOOD) || defined(SOC_MV_DISCOVERY)
417 fdt_data_get(void *data, int cells)
421 return (fdt32_to_cpu(*((uint32_t *)data)));
423 return (fdt64_to_cpu(*((uint64_t *)data)));
427 fdt_addrsize_cells(phandle_t node, int *addr_cells, int *size_cells)
433 * Retrieve #{address,size}-cells.
435 cell_size = sizeof(cell);
436 if (OF_getprop(node, "#address-cells", &cell, cell_size) < cell_size)
438 *addr_cells = fdt32_to_cpu((int)cell);
440 if (OF_getprop(node, "#size-cells", &cell, cell_size) < cell_size)
442 *size_cells = fdt32_to_cpu((int)cell);
444 if (*addr_cells > 3 || *size_cells > 2)
450 fdt_data_to_res(pcell_t *data, int addr_cells, int size_cells, u_long *start,
454 /* Address portion. */
458 *start = fdt_data_get((void *)data, addr_cells);
465 *count = fdt_data_get((void *)data, size_cells);
470 fdt_regsize(phandle_t node, u_long *base, u_long *size)
473 int addr_cells, len, size_cells;
475 if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells))
478 if ((sizeof(pcell_t) * (addr_cells + size_cells)) > sizeof(reg))
481 len = OF_getprop(node, "reg", ®, sizeof(reg));
485 *base = fdt_data_get(®[0], addr_cells);
486 *size = fdt_data_get(®[addr_cells], size_cells);
491 fdt_reg_to_rl(phandle_t node, struct resource_list *rl)
493 u_long end, count, start;
494 pcell_t *reg, *regptr;
495 pcell_t addr_cells, size_cells;
496 int tuple_size, tuples;
498 long busaddr, bussize;
500 if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells) != 0)
502 if (fdt_get_range(OF_parent(node), 0, &busaddr, &bussize)) {
507 tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
508 tuples = OF_getprop_alloc(node, "reg", tuple_size, (void **)®);
509 debugf("addr_cells = %d, size_cells = %d\n", addr_cells, size_cells);
510 debugf("tuples = %d, tuple size = %d\n", tuples, tuple_size);
512 /* No 'reg' property in this node. */
516 for (i = 0; i < tuples; i++) {
518 rv = fdt_data_to_res(reg, addr_cells, size_cells, &start,
521 resource_list_free(rl);
524 reg += addr_cells + size_cells;
526 /* Calculate address range relative to base. */
528 end = start + count - 1;
530 debugf("reg addr start = %lx, end = %lx, count = %lx\n", start,
533 resource_list_add(rl, SYS_RES_MEMORY, i, start, end,
539 free(regptr, M_OFWPROP);
544 fdt_get_phyaddr(phandle_t node, device_t dev, int *phy_addr, void **phy_sc)
547 pcell_t phy_handle, phy_reg;
549 device_t parent, child;
551 if (OF_getencprop(node, "phy-handle", (void *)&phy_handle,
552 sizeof(phy_handle)) <= 0)
555 phy_node = OF_node_from_xref(phy_handle);
557 if (OF_getprop(phy_node, "reg", (void *)&phy_reg,
558 sizeof(phy_reg)) <= 0)
561 *phy_addr = fdt32_to_cpu(phy_reg);
564 * Search for softc used to communicate with phy.
568 * Step 1: Search for ancestor of the phy-node with a "phy-handle"
571 phy_node = OF_parent(phy_node);
572 while (phy_node != 0) {
573 if (OF_getprop(phy_node, "phy-handle", (void *)&phy_handle,
574 sizeof(phy_handle)) > 0)
576 phy_node = OF_parent(phy_node);
582 * Step 2: For each device with the same parent and name as ours
583 * compare its node with the one found in step 1, ancestor of phy
584 * node (stored in phy_node).
586 parent = device_get_parent(dev);
588 child = device_find_child(parent, device_get_name(dev), i);
589 while (child != NULL) {
590 if (ofw_bus_get_node(child) == phy_node)
593 child = device_find_child(parent, device_get_name(dev), i);
599 * Use softc of the device found.
601 *phy_sc = (void *)device_get_softc(child);
607 fdt_get_reserved_regions(struct mem_region *mr, int *mrcnt)
609 pcell_t reserve[FDT_REG_CELLS * FDT_MEM_REGIONS];
611 phandle_t memory, root;
612 uint32_t memory_size;
613 int addr_cells, size_cells;
614 int i, max_size, res_len, rv, tuple_size, tuples;
616 max_size = sizeof(reserve);
617 root = OF_finddevice("/");
618 memory = OF_finddevice("/memory");
624 if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
628 if (addr_cells > 2) {
633 tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
635 res_len = OF_getproplen(root, "memreserve");
636 if (res_len <= 0 || res_len > sizeof(reserve)) {
641 if (OF_getprop(root, "memreserve", reserve, res_len) <= 0) {
647 tuples = res_len / tuple_size;
648 reservep = (pcell_t *)&reserve;
649 for (i = 0; i < tuples; i++) {
651 rv = fdt_data_to_res(reservep, addr_cells, size_cells,
652 (u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
657 reservep += addr_cells + size_cells;
667 fdt_get_mem_regions(struct mem_region *mr, int *mrcnt, uint32_t *memsize)
669 pcell_t reg[FDT_REG_CELLS * FDT_MEM_REGIONS];
672 uint32_t memory_size;
673 int addr_cells, size_cells;
674 int i, max_size, reg_len, rv, tuple_size, tuples;
676 max_size = sizeof(reg);
677 memory = OF_finddevice("/memory");
683 if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
687 if (addr_cells > 2) {
692 tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
693 reg_len = OF_getproplen(memory, "reg");
694 if (reg_len <= 0 || reg_len > sizeof(reg)) {
699 if (OF_getprop(memory, "reg", reg, reg_len) <= 0) {
705 tuples = reg_len / tuple_size;
706 regp = (pcell_t *)®
707 for (i = 0; i < tuples; i++) {
709 rv = fdt_data_to_res(regp, addr_cells, size_cells,
710 (u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
715 regp += addr_cells + size_cells;
716 memory_size += mr[i].mr_size;
719 if (memory_size == 0) {
725 *memsize = memory_size;
732 fdt_get_unit(device_t dev)
736 name = ofw_bus_get_name(dev);
737 name = strchr(name, '@') + 1;
739 return (strtol(name,NULL,0));