1bba6f0a9SMarius Strobl /*- 2718cf2ccSPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3718cf2ccSPedro F. Giffuni * 494b4a038SNathan Whitehorn * Copyright (c) 2001 - 2003 by Thomas Moestl <tmm@FreeBSD.org>. 5bba6f0a9SMarius Strobl * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org> 6bba6f0a9SMarius Strobl * All rights reserved. 7bba6f0a9SMarius Strobl * 8bba6f0a9SMarius Strobl * Redistribution and use in source and binary forms, with or without 9bba6f0a9SMarius Strobl * modification, are permitted provided that the following conditions 10bba6f0a9SMarius Strobl * are met: 11bba6f0a9SMarius Strobl * 1. Redistributions of source code must retain the above copyright 12bba6f0a9SMarius Strobl * notice, this list of conditions, and the following disclaimer, 13bba6f0a9SMarius Strobl * without modification, immediately at the beginning of the file. 14bba6f0a9SMarius Strobl * 2. Redistributions in binary form must reproduce the above copyright 15bba6f0a9SMarius Strobl * notice, this list of conditions and the following disclaimer in 16bba6f0a9SMarius Strobl * the documentation and/or other materials provided with the 17bba6f0a9SMarius Strobl * distribution. 18bba6f0a9SMarius Strobl * 19bba6f0a9SMarius Strobl * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 20bba6f0a9SMarius Strobl * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21bba6f0a9SMarius Strobl * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22bba6f0a9SMarius Strobl * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 23bba6f0a9SMarius Strobl * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24bba6f0a9SMarius Strobl * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25bba6f0a9SMarius Strobl * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26bba6f0a9SMarius Strobl * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27bba6f0a9SMarius Strobl * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28bba6f0a9SMarius Strobl * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29bba6f0a9SMarius Strobl * SUCH DAMAGE. 30bba6f0a9SMarius Strobl */ 31bba6f0a9SMarius Strobl 32bba6f0a9SMarius Strobl #include <sys/cdefs.h> 33bba6f0a9SMarius Strobl __FBSDID("$FreeBSD$"); 34bba6f0a9SMarius Strobl 358297758aSRafal Jaworowski #include "opt_platform.h" 36bba6f0a9SMarius Strobl #include <sys/param.h> 37bba6f0a9SMarius Strobl #include <sys/systm.h> 38bba6f0a9SMarius Strobl #include <sys/bus.h> 39bba6f0a9SMarius Strobl #include <sys/errno.h> 4094b4a038SNathan Whitehorn #include <sys/libkern.h> 41c90902d3SWarner Losh #include <sys/sbuf.h> 42bba6f0a9SMarius Strobl 43c47d4cdeSIan Lepore #include <machine/resource.h> 44c47d4cdeSIan Lepore 4594b4a038SNathan Whitehorn #include <dev/ofw/ofw_bus.h> 46bba6f0a9SMarius Strobl #include <dev/ofw/ofw_bus_subr.h> 47bba6f0a9SMarius Strobl #include <dev/ofw/openfirm.h> 48bba6f0a9SMarius Strobl 49bba6f0a9SMarius Strobl #include "ofw_bus_if.h" 50bba6f0a9SMarius Strobl 5124f4202dSJustin Hibbits #define OFW_COMPAT_LEN 255 52e5e94d2dSWojciech Macek #define OFW_STATUS_LEN 16 5324f4202dSJustin Hibbits 54bba6f0a9SMarius Strobl int 55bba6f0a9SMarius Strobl ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo *obd, phandle_t node) 56bba6f0a9SMarius Strobl { 57bba6f0a9SMarius Strobl 58bba6f0a9SMarius Strobl if (obd == NULL) 59bba6f0a9SMarius Strobl return (ENOMEM); 60bba6f0a9SMarius Strobl /* The 'name' property is considered mandatory. */ 61217d17bcSOleksandr Tymoshenko if ((OF_getprop_alloc(node, "name", (void **)&obd->obd_name)) == -1) 62bba6f0a9SMarius Strobl return (EINVAL); 63217d17bcSOleksandr Tymoshenko OF_getprop_alloc(node, "compatible", (void **)&obd->obd_compat); 64217d17bcSOleksandr Tymoshenko OF_getprop_alloc(node, "device_type", (void **)&obd->obd_type); 65217d17bcSOleksandr Tymoshenko OF_getprop_alloc(node, "model", (void **)&obd->obd_model); 66217d17bcSOleksandr Tymoshenko OF_getprop_alloc(node, "status", (void **)&obd->obd_status); 67bba6f0a9SMarius Strobl obd->obd_node = node; 68bba6f0a9SMarius Strobl return (0); 69bba6f0a9SMarius Strobl } 70bba6f0a9SMarius Strobl 71bba6f0a9SMarius Strobl void 72bba6f0a9SMarius Strobl ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo *obd) 73bba6f0a9SMarius Strobl { 74bba6f0a9SMarius Strobl 75bba6f0a9SMarius Strobl if (obd == NULL) 76bba6f0a9SMarius Strobl return; 77bba6f0a9SMarius Strobl if (obd->obd_compat != NULL) 78bba6f0a9SMarius Strobl free(obd->obd_compat, M_OFWPROP); 79bba6f0a9SMarius Strobl if (obd->obd_model != NULL) 80bba6f0a9SMarius Strobl free(obd->obd_model, M_OFWPROP); 81bba6f0a9SMarius Strobl if (obd->obd_name != NULL) 82bba6f0a9SMarius Strobl free(obd->obd_name, M_OFWPROP); 83bba6f0a9SMarius Strobl if (obd->obd_type != NULL) 84bba6f0a9SMarius Strobl free(obd->obd_type, M_OFWPROP); 85e4be5a16SNathan Whitehorn if (obd->obd_status != NULL) 86e4be5a16SNathan Whitehorn free(obd->obd_status, M_OFWPROP); 87bba6f0a9SMarius Strobl } 88bba6f0a9SMarius Strobl 8994b4a038SNathan Whitehorn int 90c90902d3SWarner Losh ofw_bus_gen_child_pnpinfo(device_t cbdev, device_t child, struct sbuf *sb) 9194b4a038SNathan Whitehorn { 92481d6b54SMarius Strobl 9325f0326aSEmmanuel Vadot if (!ofw_bus_status_okay(child)) 9425f0326aSEmmanuel Vadot return (0); 9525f0326aSEmmanuel Vadot 9694b4a038SNathan Whitehorn if (ofw_bus_get_name(child) != NULL) { 97c90902d3SWarner Losh sbuf_printf(sb, "name=%s ", ofw_bus_get_name(child)); 9894b4a038SNathan Whitehorn } 9994b4a038SNathan Whitehorn 10094b4a038SNathan Whitehorn if (ofw_bus_get_compat(child) != NULL) { 101c90902d3SWarner Losh sbuf_printf(sb, "compat=%s ", ofw_bus_get_compat(child)); 10294b4a038SNathan Whitehorn } 10325f0326aSEmmanuel Vadot 10494b4a038SNathan Whitehorn return (0); 10594b4a038SNathan Whitehorn }; 106bba6f0a9SMarius Strobl 107bba6f0a9SMarius Strobl const char * 108bba6f0a9SMarius Strobl ofw_bus_gen_get_compat(device_t bus, device_t dev) 109bba6f0a9SMarius Strobl { 110bba6f0a9SMarius Strobl const struct ofw_bus_devinfo *obd; 111bba6f0a9SMarius Strobl 112bba6f0a9SMarius Strobl obd = OFW_BUS_GET_DEVINFO(bus, dev); 113bba6f0a9SMarius Strobl if (obd == NULL) 114bba6f0a9SMarius Strobl return (NULL); 115bba6f0a9SMarius Strobl return (obd->obd_compat); 116bba6f0a9SMarius Strobl } 117bba6f0a9SMarius Strobl 118bba6f0a9SMarius Strobl const char * 119bba6f0a9SMarius Strobl ofw_bus_gen_get_model(device_t bus, device_t dev) 120bba6f0a9SMarius Strobl { 121bba6f0a9SMarius Strobl const struct ofw_bus_devinfo *obd; 122bba6f0a9SMarius Strobl 123bba6f0a9SMarius Strobl obd = OFW_BUS_GET_DEVINFO(bus, dev); 124bba6f0a9SMarius Strobl if (obd == NULL) 125bba6f0a9SMarius Strobl return (NULL); 126bba6f0a9SMarius Strobl return (obd->obd_model); 127bba6f0a9SMarius Strobl } 128bba6f0a9SMarius Strobl 129bba6f0a9SMarius Strobl const char * 130bba6f0a9SMarius Strobl ofw_bus_gen_get_name(device_t bus, device_t dev) 131bba6f0a9SMarius Strobl { 132bba6f0a9SMarius Strobl const struct ofw_bus_devinfo *obd; 133bba6f0a9SMarius Strobl 134bba6f0a9SMarius Strobl obd = OFW_BUS_GET_DEVINFO(bus, dev); 135bba6f0a9SMarius Strobl if (obd == NULL) 136bba6f0a9SMarius Strobl return (NULL); 137bba6f0a9SMarius Strobl return (obd->obd_name); 138bba6f0a9SMarius Strobl } 139bba6f0a9SMarius Strobl 140bba6f0a9SMarius Strobl phandle_t 141bba6f0a9SMarius Strobl ofw_bus_gen_get_node(device_t bus, device_t dev) 142bba6f0a9SMarius Strobl { 143bba6f0a9SMarius Strobl const struct ofw_bus_devinfo *obd; 144bba6f0a9SMarius Strobl 145bba6f0a9SMarius Strobl obd = OFW_BUS_GET_DEVINFO(bus, dev); 146bba6f0a9SMarius Strobl if (obd == NULL) 147*3eae4e10SMichal Meloun return ((phandle_t)-1); 148bba6f0a9SMarius Strobl return (obd->obd_node); 149bba6f0a9SMarius Strobl } 150bba6f0a9SMarius Strobl 151bba6f0a9SMarius Strobl const char * 152bba6f0a9SMarius Strobl ofw_bus_gen_get_type(device_t bus, device_t dev) 153bba6f0a9SMarius Strobl { 154bba6f0a9SMarius Strobl const struct ofw_bus_devinfo *obd; 155bba6f0a9SMarius Strobl 156bba6f0a9SMarius Strobl obd = OFW_BUS_GET_DEVINFO(bus, dev); 157bba6f0a9SMarius Strobl if (obd == NULL) 158bba6f0a9SMarius Strobl return (NULL); 159bba6f0a9SMarius Strobl return (obd->obd_type); 160bba6f0a9SMarius Strobl } 16194b4a038SNathan Whitehorn 162e4be5a16SNathan Whitehorn const char * 163e4be5a16SNathan Whitehorn ofw_bus_get_status(device_t dev) 164e4be5a16SNathan Whitehorn { 165e4be5a16SNathan Whitehorn const struct ofw_bus_devinfo *obd; 166e4be5a16SNathan Whitehorn 167e4be5a16SNathan Whitehorn obd = OFW_BUS_GET_DEVINFO(device_get_parent(dev), dev); 168e4be5a16SNathan Whitehorn if (obd == NULL) 169e4be5a16SNathan Whitehorn return (NULL); 170e4be5a16SNathan Whitehorn 171e4be5a16SNathan Whitehorn return (obd->obd_status); 172e4be5a16SNathan Whitehorn } 173e4be5a16SNathan Whitehorn 174e4be5a16SNathan Whitehorn int 175e4be5a16SNathan Whitehorn ofw_bus_status_okay(device_t dev) 176e4be5a16SNathan Whitehorn { 177e4be5a16SNathan Whitehorn const char *status; 178e4be5a16SNathan Whitehorn 179e4be5a16SNathan Whitehorn status = ofw_bus_get_status(dev); 180f3856d8fSAndrew Turner if (status == NULL || strcmp(status, "okay") == 0 || 181f3856d8fSAndrew Turner strcmp(status, "ok") == 0) 182e4be5a16SNathan Whitehorn return (1); 183e4be5a16SNathan Whitehorn 184e4be5a16SNathan Whitehorn return (0); 185e4be5a16SNathan Whitehorn } 186e4be5a16SNathan Whitehorn 187e5e94d2dSWojciech Macek int 188e5e94d2dSWojciech Macek ofw_bus_node_status_okay(phandle_t node) 189e5e94d2dSWojciech Macek { 190e5e94d2dSWojciech Macek char status[OFW_STATUS_LEN]; 191e5e94d2dSWojciech Macek int len; 192e5e94d2dSWojciech Macek 193e5e94d2dSWojciech Macek len = OF_getproplen(node, "status"); 194e5e94d2dSWojciech Macek if (len <= 0) 195e5e94d2dSWojciech Macek return (1); 196e5e94d2dSWojciech Macek 197e5e94d2dSWojciech Macek OF_getprop(node, "status", status, OFW_STATUS_LEN); 198e5e94d2dSWojciech Macek if ((len == 5 && (bcmp(status, "okay", len) == 0)) || 199e5e94d2dSWojciech Macek (len == 3 && (bcmp(status, "ok", len)))) 200e5e94d2dSWojciech Macek return (1); 201e5e94d2dSWojciech Macek 202e5e94d2dSWojciech Macek return (0); 203e5e94d2dSWojciech Macek } 204e5e94d2dSWojciech Macek 20572a638c7SAndrew Turner static int 20624f4202dSJustin Hibbits ofw_bus_node_is_compatible_int(const char *compat, int len, 20724f4202dSJustin Hibbits const char *onecompat) 20872a638c7SAndrew Turner { 20972a638c7SAndrew Turner int onelen, l, ret; 21072a638c7SAndrew Turner 21172a638c7SAndrew Turner onelen = strlen(onecompat); 21272a638c7SAndrew Turner 21372a638c7SAndrew Turner ret = 0; 21472a638c7SAndrew Turner while (len > 0) { 21572a638c7SAndrew Turner if (strlen(compat) == onelen && 21672a638c7SAndrew Turner strncasecmp(compat, onecompat, onelen) == 0) { 21772a638c7SAndrew Turner /* Found it. */ 21872a638c7SAndrew Turner ret = 1; 21972a638c7SAndrew Turner break; 22072a638c7SAndrew Turner } 22172a638c7SAndrew Turner 22272a638c7SAndrew Turner /* Slide to the next sub-string. */ 22372a638c7SAndrew Turner l = strlen(compat) + 1; 22472a638c7SAndrew Turner compat += l; 22572a638c7SAndrew Turner len -= l; 22672a638c7SAndrew Turner } 22772a638c7SAndrew Turner 22872a638c7SAndrew Turner return (ret); 22972a638c7SAndrew Turner } 23072a638c7SAndrew Turner 2318297758aSRafal Jaworowski int 23224f4202dSJustin Hibbits ofw_bus_node_is_compatible(phandle_t node, const char *compatstr) 23324f4202dSJustin Hibbits { 23424f4202dSJustin Hibbits char compat[OFW_COMPAT_LEN]; 23524f4202dSJustin Hibbits int len, rv; 23624f4202dSJustin Hibbits 23724f4202dSJustin Hibbits if ((len = OF_getproplen(node, "compatible")) <= 0) 23824f4202dSJustin Hibbits return (0); 23924f4202dSJustin Hibbits 24024f4202dSJustin Hibbits bzero(compat, OFW_COMPAT_LEN); 24124f4202dSJustin Hibbits 24224f4202dSJustin Hibbits if (OF_getprop(node, "compatible", compat, OFW_COMPAT_LEN) < 0) 24324f4202dSJustin Hibbits return (0); 24424f4202dSJustin Hibbits 24524f4202dSJustin Hibbits rv = ofw_bus_node_is_compatible_int(compat, len, compatstr); 24624f4202dSJustin Hibbits 24724f4202dSJustin Hibbits return (rv); 24824f4202dSJustin Hibbits } 24924f4202dSJustin Hibbits 25024f4202dSJustin Hibbits int 2518297758aSRafal Jaworowski ofw_bus_is_compatible(device_t dev, const char *onecompat) 2528297758aSRafal Jaworowski { 2538297758aSRafal Jaworowski phandle_t node; 2548297758aSRafal Jaworowski const char *compat; 25572a638c7SAndrew Turner int len; 2568297758aSRafal Jaworowski 2578297758aSRafal Jaworowski if ((compat = ofw_bus_get_compat(dev)) == NULL) 2588297758aSRafal Jaworowski return (0); 2598297758aSRafal Jaworowski 2600d8d9edaSNathan Whitehorn if ((node = ofw_bus_get_node(dev)) == -1) 2618297758aSRafal Jaworowski return (0); 2628297758aSRafal Jaworowski 2638297758aSRafal Jaworowski /* Get total 'compatible' prop len */ 2648297758aSRafal Jaworowski if ((len = OF_getproplen(node, "compatible")) <= 0) 2658297758aSRafal Jaworowski return (0); 2668297758aSRafal Jaworowski 26724f4202dSJustin Hibbits return (ofw_bus_node_is_compatible_int(compat, len, onecompat)); 2688297758aSRafal Jaworowski } 2698297758aSRafal Jaworowski 2708297758aSRafal Jaworowski int 2718297758aSRafal Jaworowski ofw_bus_is_compatible_strict(device_t dev, const char *compatible) 2728297758aSRafal Jaworowski { 2738297758aSRafal Jaworowski const char *compat; 27426ca4965SHiroki Sato size_t len; 2758297758aSRafal Jaworowski 2768297758aSRafal Jaworowski if ((compat = ofw_bus_get_compat(dev)) == NULL) 2778297758aSRafal Jaworowski return (0); 2788297758aSRafal Jaworowski 27926ca4965SHiroki Sato len = strlen(compatible); 28026ca4965SHiroki Sato if (strlen(compat) == len && 28126ca4965SHiroki Sato strncasecmp(compat, compatible, len) == 0) 2828297758aSRafal Jaworowski return (1); 2838297758aSRafal Jaworowski 2848297758aSRafal Jaworowski return (0); 2858297758aSRafal Jaworowski } 2868297758aSRafal Jaworowski 287498fa7c1SIan Lepore const struct ofw_compat_data * 288498fa7c1SIan Lepore ofw_bus_search_compatible(device_t dev, const struct ofw_compat_data *compat) 289498fa7c1SIan Lepore { 290498fa7c1SIan Lepore 291498fa7c1SIan Lepore if (compat == NULL) 292498fa7c1SIan Lepore return NULL; 293498fa7c1SIan Lepore 294498fa7c1SIan Lepore for (; compat->ocd_str != NULL; ++compat) { 295498fa7c1SIan Lepore if (ofw_bus_is_compatible(dev, compat->ocd_str)) 296498fa7c1SIan Lepore break; 297498fa7c1SIan Lepore } 298498fa7c1SIan Lepore 299498fa7c1SIan Lepore return (compat); 300498fa7c1SIan Lepore } 301498fa7c1SIan Lepore 30226ca4965SHiroki Sato int 30326ca4965SHiroki Sato ofw_bus_has_prop(device_t dev, const char *propname) 30426ca4965SHiroki Sato { 30526ca4965SHiroki Sato phandle_t node; 30626ca4965SHiroki Sato 30726ca4965SHiroki Sato if ((node = ofw_bus_get_node(dev)) == -1) 30826ca4965SHiroki Sato return (0); 30926ca4965SHiroki Sato 31026ca4965SHiroki Sato return (OF_hasprop(node, propname)); 31126ca4965SHiroki Sato } 31226ca4965SHiroki Sato 31394b4a038SNathan Whitehorn void 31494b4a038SNathan Whitehorn ofw_bus_setup_iinfo(phandle_t node, struct ofw_bus_iinfo *ii, int intrsz) 31594b4a038SNathan Whitehorn { 31694b4a038SNathan Whitehorn pcell_t addrc; 31794b4a038SNathan Whitehorn int msksz; 31894b4a038SNathan Whitehorn 319d3a0a0f3SNathan Whitehorn if (OF_getencprop(node, "#address-cells", &addrc, sizeof(addrc)) == -1) 32094b4a038SNathan Whitehorn addrc = 2; 32194b4a038SNathan Whitehorn ii->opi_addrc = addrc * sizeof(pcell_t); 32294b4a038SNathan Whitehorn 323f7604b1bSOleksandr Tymoshenko ii->opi_imapsz = OF_getencprop_alloc(node, "interrupt-map", 32494b4a038SNathan Whitehorn (void **)&ii->opi_imap); 32594b4a038SNathan Whitehorn if (ii->opi_imapsz > 0) { 326f7604b1bSOleksandr Tymoshenko msksz = OF_getencprop_alloc(node, "interrupt-map-mask", 32794b4a038SNathan Whitehorn (void **)&ii->opi_imapmsk); 32894b4a038SNathan Whitehorn /* 329481d6b54SMarius Strobl * Failure to get the mask is ignored; a full mask is used 330481d6b54SMarius Strobl * then. We barf on bad mask sizes, however. 33194b4a038SNathan Whitehorn */ 332481d6b54SMarius Strobl if (msksz != -1 && msksz != ii->opi_addrc + intrsz) 33394b4a038SNathan Whitehorn panic("ofw_bus_setup_iinfo: bad interrupt-map-mask " 33494b4a038SNathan Whitehorn "property!"); 33594b4a038SNathan Whitehorn } 33694b4a038SNathan Whitehorn } 33794b4a038SNathan Whitehorn 33894b4a038SNathan Whitehorn int 33994b4a038SNathan Whitehorn ofw_bus_lookup_imap(phandle_t node, struct ofw_bus_iinfo *ii, void *reg, 34094b4a038SNathan Whitehorn int regsz, void *pintr, int pintrsz, void *mintr, int mintrsz, 34195e3bfe8SNathan Whitehorn phandle_t *iparent) 34294b4a038SNathan Whitehorn { 34395e3bfe8SNathan Whitehorn uint8_t maskbuf[regsz + pintrsz]; 34494b4a038SNathan Whitehorn int rv; 34594b4a038SNathan Whitehorn 34694b4a038SNathan Whitehorn if (ii->opi_imapsz <= 0) 34794b4a038SNathan Whitehorn return (0); 34894b4a038SNathan Whitehorn KASSERT(regsz >= ii->opi_addrc, 34994b4a038SNathan Whitehorn ("ofw_bus_lookup_imap: register size too small: %d < %d", 35094b4a038SNathan Whitehorn regsz, ii->opi_addrc)); 3516064b6acSNathan Whitehorn if (node != -1) { 352d3a0a0f3SNathan Whitehorn rv = OF_getencprop(node, "reg", reg, regsz); 35394b4a038SNathan Whitehorn if (rv < regsz) 3546064b6acSNathan Whitehorn panic("ofw_bus_lookup_imap: cannot get reg property"); 3556064b6acSNathan Whitehorn } 35694b4a038SNathan Whitehorn return (ofw_bus_search_intrmap(pintr, pintrsz, reg, ii->opi_addrc, 35794b4a038SNathan Whitehorn ii->opi_imap, ii->opi_imapsz, ii->opi_imapmsk, maskbuf, mintr, 358eaef5f0aSNathan Whitehorn mintrsz, iparent)); 35994b4a038SNathan Whitehorn } 36094b4a038SNathan Whitehorn 36194b4a038SNathan Whitehorn /* 36294b4a038SNathan Whitehorn * Map an interrupt using the firmware reg, interrupt-map and 36394b4a038SNathan Whitehorn * interrupt-map-mask properties. 36494b4a038SNathan Whitehorn * The interrupt property to be mapped must be of size intrsz, and pointed to 36594b4a038SNathan Whitehorn * by intr. The regs property of the node for which the mapping is done must 36694b4a038SNathan Whitehorn * be passed as regs. This property is an array of register specifications; 36794b4a038SNathan Whitehorn * the size of the address part of such a specification must be passed as 36894b4a038SNathan Whitehorn * physsz. Only the first element of the property is used. 36994b4a038SNathan Whitehorn * imap and imapsz hold the interrupt mask and it's size. 37094b4a038SNathan Whitehorn * imapmsk is a pointer to the interrupt-map-mask property, which must have 37194b4a038SNathan Whitehorn * a size of physsz + intrsz; it may be NULL, in which case a full mask is 37294b4a038SNathan Whitehorn * assumed. 37394b4a038SNathan Whitehorn * maskbuf must point to a buffer of length physsz + intrsz. 37494b4a038SNathan Whitehorn * The interrupt is returned in result, which must point to a buffer of length 37594b4a038SNathan Whitehorn * rintrsz (which gives the expected size of the mapped interrupt). 376cb6d9d6cSNathan Whitehorn * Returns number of cells in the interrupt if a mapping was found, 0 otherwise. 37794b4a038SNathan Whitehorn */ 37894b4a038SNathan Whitehorn int 37994b4a038SNathan Whitehorn ofw_bus_search_intrmap(void *intr, int intrsz, void *regs, int physsz, 38094b4a038SNathan Whitehorn void *imap, int imapsz, void *imapmsk, void *maskbuf, void *result, 381eaef5f0aSNathan Whitehorn int rintrsz, phandle_t *iparent) 38294b4a038SNathan Whitehorn { 38394b4a038SNathan Whitehorn phandle_t parent; 384481d6b54SMarius Strobl uint8_t *ref = maskbuf; 385481d6b54SMarius Strobl uint8_t *uiintr = intr; 386481d6b54SMarius Strobl uint8_t *uiregs = regs; 387481d6b54SMarius Strobl uint8_t *uiimapmsk = imapmsk; 388481d6b54SMarius Strobl uint8_t *mptr; 389122493cfSAndrew Turner pcell_t paddrsz; 39094b4a038SNathan Whitehorn pcell_t pintrsz; 391151ba793SAlexander Kabaev int i, tsz; 39294b4a038SNathan Whitehorn 39394b4a038SNathan Whitehorn if (imapmsk != NULL) { 39494b4a038SNathan Whitehorn for (i = 0; i < physsz; i++) 39594b4a038SNathan Whitehorn ref[i] = uiregs[i] & uiimapmsk[i]; 39694b4a038SNathan Whitehorn for (i = 0; i < intrsz; i++) 39794b4a038SNathan Whitehorn ref[physsz + i] = uiintr[i] & uiimapmsk[physsz + i]; 39894b4a038SNathan Whitehorn } else { 39994b4a038SNathan Whitehorn bcopy(regs, ref, physsz); 40094b4a038SNathan Whitehorn bcopy(intr, ref + physsz, intrsz); 40194b4a038SNathan Whitehorn } 40294b4a038SNathan Whitehorn 40394b4a038SNathan Whitehorn mptr = imap; 40494b4a038SNathan Whitehorn i = imapsz; 405122493cfSAndrew Turner paddrsz = 0; 40694b4a038SNathan Whitehorn while (i > 0) { 40794b4a038SNathan Whitehorn bcopy(mptr + physsz + intrsz, &parent, sizeof(parent)); 4089f4a7eaeSNathan Whitehorn #ifndef OFW_IMAP_NO_IPARENT_ADDR_CELLS 409122493cfSAndrew Turner /* 4109f4a7eaeSNathan Whitehorn * Find if we need to read the parent address data. 4119f4a7eaeSNathan Whitehorn * CHRP-derived OF bindings, including ePAPR-compliant FDTs, 4129f4a7eaeSNathan Whitehorn * use this as an optional part of the specifier. 413122493cfSAndrew Turner */ 414122493cfSAndrew Turner if (OF_getencprop(OF_node_from_xref(parent), 415122493cfSAndrew Turner "#address-cells", &paddrsz, sizeof(paddrsz)) == -1) 416122493cfSAndrew Turner paddrsz = 0; /* default */ 417122493cfSAndrew Turner paddrsz *= sizeof(pcell_t); 418122493cfSAndrew Turner #endif 419122493cfSAndrew Turner 420752ba930SIan Lepore if (OF_searchencprop(OF_node_from_xref(parent), 421d3a0a0f3SNathan Whitehorn "#interrupt-cells", &pintrsz, sizeof(pintrsz)) == -1) 42294b4a038SNathan Whitehorn pintrsz = 1; /* default */ 42394b4a038SNathan Whitehorn pintrsz *= sizeof(pcell_t); 424acb97117SNathan Whitehorn 425481d6b54SMarius Strobl /* Compute the map stride size. */ 426122493cfSAndrew Turner tsz = physsz + intrsz + sizeof(phandle_t) + paddrsz + pintrsz; 427acb97117SNathan Whitehorn KASSERT(i >= tsz, ("ofw_bus_search_intrmap: truncated map")); 42894b4a038SNathan Whitehorn 42994b4a038SNathan Whitehorn if (bcmp(ref, mptr, physsz + intrsz) == 0) { 430122493cfSAndrew Turner bcopy(mptr + physsz + intrsz + sizeof(parent) + paddrsz, 431cb6d9d6cSNathan Whitehorn result, MIN(rintrsz, pintrsz)); 432eaef5f0aSNathan Whitehorn 433eaef5f0aSNathan Whitehorn if (iparent != NULL) 434eaef5f0aSNathan Whitehorn *iparent = parent; 435cb6d9d6cSNathan Whitehorn return (pintrsz/sizeof(pcell_t)); 43694b4a038SNathan Whitehorn } 43794b4a038SNathan Whitehorn mptr += tsz; 43894b4a038SNathan Whitehorn i -= tsz; 43994b4a038SNathan Whitehorn } 44094b4a038SNathan Whitehorn return (0); 44194b4a038SNathan Whitehorn } 4426064b6acSNathan Whitehorn 443c47d4cdeSIan Lepore int 4441e43b18cSAndrew Turner ofw_bus_msimap(phandle_t node, uint16_t pci_rid, phandle_t *msi_parent, 4451e43b18cSAndrew Turner uint32_t *msi_rid) 4461e43b18cSAndrew Turner { 4471e43b18cSAndrew Turner pcell_t *map, mask, msi_base, rid_base, rid_length; 4481e43b18cSAndrew Turner ssize_t len; 449151ba793SAlexander Kabaev uint32_t masked_rid; 4501e43b18cSAndrew Turner int err, i; 4511e43b18cSAndrew Turner 4521e43b18cSAndrew Turner /* TODO: This should be OF_searchprop_alloc if we had it */ 453f7604b1bSOleksandr Tymoshenko len = OF_getencprop_alloc_multi(node, "msi-map", sizeof(*map), 454f7604b1bSOleksandr Tymoshenko (void **)&map); 4551e43b18cSAndrew Turner if (len < 0) { 4561e43b18cSAndrew Turner if (msi_parent != NULL) { 4571e43b18cSAndrew Turner *msi_parent = 0; 4581e43b18cSAndrew Turner OF_getencprop(node, "msi-parent", msi_parent, 4591e43b18cSAndrew Turner sizeof(*msi_parent)); 4601e43b18cSAndrew Turner } 4611e43b18cSAndrew Turner if (msi_rid != NULL) 4621e43b18cSAndrew Turner *msi_rid = pci_rid; 4631e43b18cSAndrew Turner return (0); 4641e43b18cSAndrew Turner } 4651e43b18cSAndrew Turner 4661e43b18cSAndrew Turner err = ENOENT; 4671e43b18cSAndrew Turner mask = 0xffffffff; 4681e43b18cSAndrew Turner OF_getencprop(node, "msi-map-mask", &mask, sizeof(mask)); 4691e43b18cSAndrew Turner 4701e43b18cSAndrew Turner masked_rid = pci_rid & mask; 4711e43b18cSAndrew Turner for (i = 0; i < len; i += 4) { 4721e43b18cSAndrew Turner rid_base = map[i + 0]; 4731e43b18cSAndrew Turner rid_length = map[i + 3]; 4741e43b18cSAndrew Turner 4751e43b18cSAndrew Turner if (masked_rid < rid_base || 4761e43b18cSAndrew Turner masked_rid >= (rid_base + rid_length)) 4771e43b18cSAndrew Turner continue; 4781e43b18cSAndrew Turner 4791e43b18cSAndrew Turner msi_base = map[i + 2]; 4801e43b18cSAndrew Turner 4811e43b18cSAndrew Turner if (msi_parent != NULL) 4821e43b18cSAndrew Turner *msi_parent = map[i + 1]; 4831e43b18cSAndrew Turner if (msi_rid != NULL) 4841e43b18cSAndrew Turner *msi_rid = masked_rid - rid_base + msi_base; 4851e43b18cSAndrew Turner err = 0; 4861e43b18cSAndrew Turner break; 4871e43b18cSAndrew Turner } 4881e43b18cSAndrew Turner 4891e43b18cSAndrew Turner free(map, M_OFWPROP); 4901e43b18cSAndrew Turner 4911e43b18cSAndrew Turner return (err); 4921e43b18cSAndrew Turner } 4931e43b18cSAndrew Turner 494d310c9e0SMarcin Wojtas static int 495d310c9e0SMarcin Wojtas ofw_bus_reg_to_rl_helper(device_t dev, phandle_t node, pcell_t acells, pcell_t scells, 496d310c9e0SMarcin Wojtas struct resource_list *rl, const char *reg_source) 4974b3d9160SZbigniew Bodek { 4984b3d9160SZbigniew Bodek uint64_t phys, size; 4994b3d9160SZbigniew Bodek ssize_t i, j, rid, nreg, ret; 5004b3d9160SZbigniew Bodek uint32_t *reg; 5014b3d9160SZbigniew Bodek char *name; 5024b3d9160SZbigniew Bodek 5034b3d9160SZbigniew Bodek /* 5044b3d9160SZbigniew Bodek * This may be just redundant when having ofw_bus_devinfo 5054b3d9160SZbigniew Bodek * but makes this routine independent of it. 5064b3d9160SZbigniew Bodek */ 507217d17bcSOleksandr Tymoshenko ret = OF_getprop_alloc(node, "name", (void **)&name); 5084b3d9160SZbigniew Bodek if (ret == -1) 5094b3d9160SZbigniew Bodek name = NULL; 5104b3d9160SZbigniew Bodek 511f7604b1bSOleksandr Tymoshenko ret = OF_getencprop_alloc_multi(node, reg_source, sizeof(*reg), 512f7604b1bSOleksandr Tymoshenko (void **)®); 5134b3d9160SZbigniew Bodek nreg = (ret == -1) ? 0 : ret; 5144b3d9160SZbigniew Bodek 5154b3d9160SZbigniew Bodek if (nreg % (acells + scells) != 0) { 5164b3d9160SZbigniew Bodek if (bootverbose) 5174b3d9160SZbigniew Bodek device_printf(dev, "Malformed reg property on <%s>\n", 5184b3d9160SZbigniew Bodek (name == NULL) ? "unknown" : name); 5194b3d9160SZbigniew Bodek nreg = 0; 5204b3d9160SZbigniew Bodek } 5214b3d9160SZbigniew Bodek 5224b3d9160SZbigniew Bodek for (i = 0, rid = 0; i < nreg; i += acells + scells, rid++) { 5234b3d9160SZbigniew Bodek phys = size = 0; 5244b3d9160SZbigniew Bodek for (j = 0; j < acells; j++) { 5254b3d9160SZbigniew Bodek phys <<= 32; 5264b3d9160SZbigniew Bodek phys |= reg[i + j]; 5274b3d9160SZbigniew Bodek } 5284b3d9160SZbigniew Bodek for (j = 0; j < scells; j++) { 5294b3d9160SZbigniew Bodek size <<= 32; 5304b3d9160SZbigniew Bodek size |= reg[i + acells + j]; 5314b3d9160SZbigniew Bodek } 5324b3d9160SZbigniew Bodek /* Skip the dummy reg property of glue devices like ssm(4). */ 5334b3d9160SZbigniew Bodek if (size != 0) 5344b3d9160SZbigniew Bodek resource_list_add(rl, SYS_RES_MEMORY, rid, 5354b3d9160SZbigniew Bodek phys, phys + size - 1, size); 5364b3d9160SZbigniew Bodek } 5374b3d9160SZbigniew Bodek free(name, M_OFWPROP); 5384b3d9160SZbigniew Bodek free(reg, M_OFWPROP); 5394b3d9160SZbigniew Bodek 5404b3d9160SZbigniew Bodek return (0); 5414b3d9160SZbigniew Bodek } 5424b3d9160SZbigniew Bodek 543d310c9e0SMarcin Wojtas int 544d310c9e0SMarcin Wojtas ofw_bus_reg_to_rl(device_t dev, phandle_t node, pcell_t acells, pcell_t scells, 545d310c9e0SMarcin Wojtas struct resource_list *rl) 546d310c9e0SMarcin Wojtas { 547d310c9e0SMarcin Wojtas 548d310c9e0SMarcin Wojtas return (ofw_bus_reg_to_rl_helper(dev, node, acells, scells, rl, "reg")); 549d310c9e0SMarcin Wojtas } 550d310c9e0SMarcin Wojtas 551d310c9e0SMarcin Wojtas int 552d310c9e0SMarcin Wojtas ofw_bus_assigned_addresses_to_rl(device_t dev, phandle_t node, pcell_t acells, 553d310c9e0SMarcin Wojtas pcell_t scells, struct resource_list *rl) 554d310c9e0SMarcin Wojtas { 555d310c9e0SMarcin Wojtas 556d310c9e0SMarcin Wojtas return (ofw_bus_reg_to_rl_helper(dev, node, acells, scells, 557d310c9e0SMarcin Wojtas rl, "assigned-addresses")); 558d310c9e0SMarcin Wojtas } 559d310c9e0SMarcin Wojtas 560821a61efSMichal Meloun /* 561821a61efSMichal Meloun * Get interrupt parent for given node. 562821a61efSMichal Meloun * Returns 0 if interrupt parent doesn't exist. 563821a61efSMichal Meloun */ 564821a61efSMichal Meloun phandle_t 565821a61efSMichal Meloun ofw_bus_find_iparent(phandle_t node) 566821a61efSMichal Meloun { 567821a61efSMichal Meloun phandle_t iparent; 568821a61efSMichal Meloun 569821a61efSMichal Meloun if (OF_searchencprop(node, "interrupt-parent", &iparent, 570821a61efSMichal Meloun sizeof(iparent)) == -1) { 571821a61efSMichal Meloun for (iparent = node; iparent != 0; 572821a61efSMichal Meloun iparent = OF_parent(iparent)) { 573821a61efSMichal Meloun if (OF_hasprop(iparent, "interrupt-controller")) 574821a61efSMichal Meloun break; 575821a61efSMichal Meloun } 576821a61efSMichal Meloun iparent = OF_xref_from_node(iparent); 577821a61efSMichal Meloun } 578821a61efSMichal Meloun return (iparent); 579821a61efSMichal Meloun } 580821a61efSMichal Meloun 5814b3d9160SZbigniew Bodek int 582a8c5ea04SRuslan Bukin ofw_bus_intr_to_rl(device_t dev, phandle_t node, 583a8c5ea04SRuslan Bukin struct resource_list *rl, int *rlen) 584c47d4cdeSIan Lepore { 585c47d4cdeSIan Lepore phandle_t iparent; 586c47d4cdeSIan Lepore uint32_t icells, *intr; 587c47d4cdeSIan Lepore int err, i, irqnum, nintr, rid; 588c47d4cdeSIan Lepore boolean_t extended; 589c47d4cdeSIan Lepore 590f7604b1bSOleksandr Tymoshenko nintr = OF_getencprop_alloc_multi(node, "interrupts", sizeof(*intr), 591c47d4cdeSIan Lepore (void **)&intr); 592c47d4cdeSIan Lepore if (nintr > 0) { 593821a61efSMichal Meloun iparent = ofw_bus_find_iparent(node); 59408b96b9fSNathan Whitehorn if (iparent == 0) { 595c47d4cdeSIan Lepore device_printf(dev, "No interrupt-parent found, " 596c47d4cdeSIan Lepore "assuming direct parent\n"); 597c47d4cdeSIan Lepore iparent = OF_parent(node); 59808b96b9fSNathan Whitehorn iparent = OF_xref_from_node(iparent); 59908b96b9fSNathan Whitehorn } 600c47d4cdeSIan Lepore if (OF_searchencprop(OF_node_from_xref(iparent), 601c47d4cdeSIan Lepore "#interrupt-cells", &icells, sizeof(icells)) == -1) { 602c47d4cdeSIan Lepore device_printf(dev, "Missing #interrupt-cells " 603c47d4cdeSIan Lepore "property, assuming <1>\n"); 604c47d4cdeSIan Lepore icells = 1; 605c47d4cdeSIan Lepore } 606c47d4cdeSIan Lepore if (icells < 1 || icells > nintr) { 607c47d4cdeSIan Lepore device_printf(dev, "Invalid #interrupt-cells property " 608c47d4cdeSIan Lepore "value <%d>, assuming <1>\n", icells); 609c47d4cdeSIan Lepore icells = 1; 610c47d4cdeSIan Lepore } 611c47d4cdeSIan Lepore extended = false; 612c47d4cdeSIan Lepore } else { 613f7604b1bSOleksandr Tymoshenko nintr = OF_getencprop_alloc_multi(node, "interrupts-extended", 614c47d4cdeSIan Lepore sizeof(*intr), (void **)&intr); 615c47d4cdeSIan Lepore if (nintr <= 0) 616c47d4cdeSIan Lepore return (0); 617c47d4cdeSIan Lepore extended = true; 618c47d4cdeSIan Lepore } 619c47d4cdeSIan Lepore err = 0; 620c47d4cdeSIan Lepore rid = 0; 621c47d4cdeSIan Lepore for (i = 0; i < nintr; i += icells) { 622c47d4cdeSIan Lepore if (extended) { 623c47d4cdeSIan Lepore iparent = intr[i++]; 624c47d4cdeSIan Lepore if (OF_searchencprop(OF_node_from_xref(iparent), 625c47d4cdeSIan Lepore "#interrupt-cells", &icells, sizeof(icells)) == -1) { 626c47d4cdeSIan Lepore device_printf(dev, "Missing #interrupt-cells " 627c47d4cdeSIan Lepore "property\n"); 628c47d4cdeSIan Lepore err = ENOENT; 629c47d4cdeSIan Lepore break; 630c47d4cdeSIan Lepore } 631c47d4cdeSIan Lepore if (icells < 1 || (i + icells) > nintr) { 632c47d4cdeSIan Lepore device_printf(dev, "Invalid #interrupt-cells " 633c47d4cdeSIan Lepore "property value <%d>\n", icells); 634c47d4cdeSIan Lepore err = ERANGE; 635c47d4cdeSIan Lepore break; 636c47d4cdeSIan Lepore } 637c47d4cdeSIan Lepore } 638c47d4cdeSIan Lepore irqnum = ofw_bus_map_intr(dev, iparent, icells, &intr[i]); 639c47d4cdeSIan Lepore resource_list_add(rl, SYS_RES_IRQ, rid++, irqnum, irqnum, 1); 640c47d4cdeSIan Lepore } 641a8c5ea04SRuslan Bukin if (rlen != NULL) 642a8c5ea04SRuslan Bukin *rlen = rid; 643c47d4cdeSIan Lepore free(intr, M_OFWPROP); 644c47d4cdeSIan Lepore return (err); 645c47d4cdeSIan Lepore } 646ad5244ecSSvatopluk Kraus 647ad5244ecSSvatopluk Kraus int 648ad5244ecSSvatopluk Kraus ofw_bus_intr_by_rid(device_t dev, phandle_t node, int wanted_rid, 649ad5244ecSSvatopluk Kraus phandle_t *producer, int *ncells, pcell_t **cells) 650ad5244ecSSvatopluk Kraus { 651ad5244ecSSvatopluk Kraus phandle_t iparent; 652ad5244ecSSvatopluk Kraus uint32_t icells, *intr; 653ad5244ecSSvatopluk Kraus int err, i, nintr, rid; 654ad5244ecSSvatopluk Kraus boolean_t extended; 655ad5244ecSSvatopluk Kraus 656f7604b1bSOleksandr Tymoshenko nintr = OF_getencprop_alloc_multi(node, "interrupts", sizeof(*intr), 657ad5244ecSSvatopluk Kraus (void **)&intr); 658ad5244ecSSvatopluk Kraus if (nintr > 0) { 659ad5244ecSSvatopluk Kraus iparent = ofw_bus_find_iparent(node); 660ad5244ecSSvatopluk Kraus if (iparent == 0) { 661ad5244ecSSvatopluk Kraus device_printf(dev, "No interrupt-parent found, " 662ad5244ecSSvatopluk Kraus "assuming direct parent\n"); 663ad5244ecSSvatopluk Kraus iparent = OF_parent(node); 664ad5244ecSSvatopluk Kraus iparent = OF_xref_from_node(iparent); 665ad5244ecSSvatopluk Kraus } 666ad5244ecSSvatopluk Kraus if (OF_searchencprop(OF_node_from_xref(iparent), 667ad5244ecSSvatopluk Kraus "#interrupt-cells", &icells, sizeof(icells)) == -1) { 668ad5244ecSSvatopluk Kraus device_printf(dev, "Missing #interrupt-cells " 669ad5244ecSSvatopluk Kraus "property, assuming <1>\n"); 670ad5244ecSSvatopluk Kraus icells = 1; 671ad5244ecSSvatopluk Kraus } 672ad5244ecSSvatopluk Kraus if (icells < 1 || icells > nintr) { 673ad5244ecSSvatopluk Kraus device_printf(dev, "Invalid #interrupt-cells property " 674ad5244ecSSvatopluk Kraus "value <%d>, assuming <1>\n", icells); 675ad5244ecSSvatopluk Kraus icells = 1; 676ad5244ecSSvatopluk Kraus } 677ad5244ecSSvatopluk Kraus extended = false; 678ad5244ecSSvatopluk Kraus } else { 679f7604b1bSOleksandr Tymoshenko nintr = OF_getencprop_alloc_multi(node, "interrupts-extended", 680ad5244ecSSvatopluk Kraus sizeof(*intr), (void **)&intr); 681ad5244ecSSvatopluk Kraus if (nintr <= 0) 682ad5244ecSSvatopluk Kraus return (ESRCH); 683ad5244ecSSvatopluk Kraus extended = true; 684ad5244ecSSvatopluk Kraus } 685ad5244ecSSvatopluk Kraus err = ESRCH; 686ad5244ecSSvatopluk Kraus rid = 0; 687ad5244ecSSvatopluk Kraus for (i = 0; i < nintr; i += icells, rid++) { 688ad5244ecSSvatopluk Kraus if (extended) { 689ad5244ecSSvatopluk Kraus iparent = intr[i++]; 690ad5244ecSSvatopluk Kraus if (OF_searchencprop(OF_node_from_xref(iparent), 691ad5244ecSSvatopluk Kraus "#interrupt-cells", &icells, sizeof(icells)) == -1) { 692ad5244ecSSvatopluk Kraus device_printf(dev, "Missing #interrupt-cells " 693ad5244ecSSvatopluk Kraus "property\n"); 694ad5244ecSSvatopluk Kraus err = ENOENT; 695ad5244ecSSvatopluk Kraus break; 696ad5244ecSSvatopluk Kraus } 697ad5244ecSSvatopluk Kraus if (icells < 1 || (i + icells) > nintr) { 698ad5244ecSSvatopluk Kraus device_printf(dev, "Invalid #interrupt-cells " 699ad5244ecSSvatopluk Kraus "property value <%d>\n", icells); 700ad5244ecSSvatopluk Kraus err = ERANGE; 701ad5244ecSSvatopluk Kraus break; 702ad5244ecSSvatopluk Kraus } 703ad5244ecSSvatopluk Kraus } 704ad5244ecSSvatopluk Kraus if (rid == wanted_rid) { 705ad5244ecSSvatopluk Kraus *cells = malloc(icells * sizeof(**cells), M_OFWPROP, 706ad5244ecSSvatopluk Kraus M_WAITOK); 707ad5244ecSSvatopluk Kraus *producer = iparent; 708ad5244ecSSvatopluk Kraus *ncells= icells; 709ad5244ecSSvatopluk Kraus memcpy(*cells, intr + i, icells * sizeof(**cells)); 710ad5244ecSSvatopluk Kraus err = 0; 711ad5244ecSSvatopluk Kraus break; 712ad5244ecSSvatopluk Kraus } 713ad5244ecSSvatopluk Kraus } 714ad5244ecSSvatopluk Kraus free(intr, M_OFWPROP); 715ad5244ecSSvatopluk Kraus return (err); 716ad5244ecSSvatopluk Kraus } 71708b96b9fSNathan Whitehorn 71872a638c7SAndrew Turner phandle_t 71937c1967cSOleksandr Tymoshenko ofw_bus_find_child(phandle_t start, const char *child_name) 72037c1967cSOleksandr Tymoshenko { 72137c1967cSOleksandr Tymoshenko char *name; 72237c1967cSOleksandr Tymoshenko int ret; 72337c1967cSOleksandr Tymoshenko phandle_t child; 72437c1967cSOleksandr Tymoshenko 72537c1967cSOleksandr Tymoshenko for (child = OF_child(start); child != 0; child = OF_peer(child)) { 726217d17bcSOleksandr Tymoshenko ret = OF_getprop_alloc(child, "name", (void **)&name); 72737c1967cSOleksandr Tymoshenko if (ret == -1) 72837c1967cSOleksandr Tymoshenko continue; 72937c1967cSOleksandr Tymoshenko if (strcmp(name, child_name) == 0) { 73037c1967cSOleksandr Tymoshenko free(name, M_OFWPROP); 73137c1967cSOleksandr Tymoshenko return (child); 73237c1967cSOleksandr Tymoshenko } 73337c1967cSOleksandr Tymoshenko 73437c1967cSOleksandr Tymoshenko free(name, M_OFWPROP); 73537c1967cSOleksandr Tymoshenko } 73637c1967cSOleksandr Tymoshenko 73737c1967cSOleksandr Tymoshenko return (0); 73837c1967cSOleksandr Tymoshenko } 73937c1967cSOleksandr Tymoshenko 74037c1967cSOleksandr Tymoshenko phandle_t 74172a638c7SAndrew Turner ofw_bus_find_compatible(phandle_t node, const char *onecompat) 74272a638c7SAndrew Turner { 74372a638c7SAndrew Turner phandle_t child, ret; 74472a638c7SAndrew Turner 74572a638c7SAndrew Turner /* 74672a638c7SAndrew Turner * Traverse all children of 'start' node, and find first with 74772a638c7SAndrew Turner * matching 'compatible' property. 74872a638c7SAndrew Turner */ 74972a638c7SAndrew Turner for (child = OF_child(node); child != 0; child = OF_peer(child)) { 750edf3dd3bSMarcin Wojtas if (ofw_bus_node_is_compatible(child, onecompat) != 0) 75172a638c7SAndrew Turner return (child); 75272a638c7SAndrew Turner 75372a638c7SAndrew Turner ret = ofw_bus_find_compatible(child, onecompat); 75472a638c7SAndrew Turner if (ret != 0) 75572a638c7SAndrew Turner return (ret); 75672a638c7SAndrew Turner } 75772a638c7SAndrew Turner return (0); 75872a638c7SAndrew Turner } 759bb39ff4cSWarner Losh 760bb39ff4cSWarner Losh /** 761bb39ff4cSWarner Losh * @brief Return child of bus whose phandle is node 762bb39ff4cSWarner Losh * 763bb39ff4cSWarner Losh * A direct child of @p will be returned if it its phandle in the 764bb39ff4cSWarner Losh * OFW tree is @p node. Otherwise, NULL is returned. 765bb39ff4cSWarner Losh * 766bb39ff4cSWarner Losh * @param bus The bus to examine 767bb39ff4cSWarner Losh * @param node The phandle_t to look for. 768bb39ff4cSWarner Losh */ 769bb39ff4cSWarner Losh device_t 770bb39ff4cSWarner Losh ofw_bus_find_child_device_by_phandle(device_t bus, phandle_t node) 771bb39ff4cSWarner Losh { 772bb39ff4cSWarner Losh device_t *children, retval, child; 773bb39ff4cSWarner Losh int nkid, i; 774bb39ff4cSWarner Losh 775bb39ff4cSWarner Losh /* 776bb39ff4cSWarner Losh * Nothing can match the flag value for no node. 777bb39ff4cSWarner Losh */ 778bb39ff4cSWarner Losh if (node == -1) 779bb39ff4cSWarner Losh return (NULL); 780bb39ff4cSWarner Losh 781bb39ff4cSWarner Losh /* 782bb39ff4cSWarner Losh * Search the children for a match. We microoptimize 783bb39ff4cSWarner Losh * a bit by not using ofw_bus_get since we already know 784bb39ff4cSWarner Losh * the parent. We do not recurse. 785bb39ff4cSWarner Losh */ 786bb39ff4cSWarner Losh if (device_get_children(bus, &children, &nkid) != 0) 787bb39ff4cSWarner Losh return (NULL); 788bb39ff4cSWarner Losh retval = NULL; 789bb39ff4cSWarner Losh for (i = 0; i < nkid; i++) { 790bb39ff4cSWarner Losh child = children[i]; 791bb39ff4cSWarner Losh if (OFW_BUS_GET_NODE(bus, child) == node) { 792bb39ff4cSWarner Losh retval = child; 793bb39ff4cSWarner Losh break; 794bb39ff4cSWarner Losh } 795bb39ff4cSWarner Losh } 796bb39ff4cSWarner Losh free(children, M_TEMP); 797bb39ff4cSWarner Losh 798bb39ff4cSWarner Losh return (retval); 799bb39ff4cSWarner Losh } 8000b757c47SMichal Meloun 8010b757c47SMichal Meloun /* 8020b757c47SMichal Meloun * Parse property that contain list of xrefs and values 8030b757c47SMichal Meloun * (like standard "clocks" and "resets" properties) 8040b757c47SMichal Meloun * Input arguments: 8050b757c47SMichal Meloun * node - consumers device node 8060b757c47SMichal Meloun * list_name - name of parsed list - "clocks" 8070b757c47SMichal Meloun * cells_name - name of size property - "#clock-cells" 80891ef8da0SAdrian Chadd * idx - the index of the requested list entry, or, if -1, an indication 80991ef8da0SAdrian Chadd * to return the number of entries in the parsed list. 8100b757c47SMichal Meloun * Output arguments: 8110b757c47SMichal Meloun * producer - handle of producer 81291ef8da0SAdrian Chadd * ncells - number of cells in result or the number of items in the list when 81391ef8da0SAdrian Chadd * idx == -1. 8140b757c47SMichal Meloun * cells - array of decoded cells 8150b757c47SMichal Meloun */ 81691ef8da0SAdrian Chadd static int 81791ef8da0SAdrian Chadd ofw_bus_parse_xref_list_internal(phandle_t node, const char *list_name, 8180b757c47SMichal Meloun const char *cells_name, int idx, phandle_t *producer, int *ncells, 8190b757c47SMichal Meloun pcell_t **cells) 8200b757c47SMichal Meloun { 8210b757c47SMichal Meloun phandle_t pnode; 8220b757c47SMichal Meloun phandle_t *elems; 8230b757c47SMichal Meloun uint32_t pcells; 8240b757c47SMichal Meloun int rv, i, j, nelems, cnt; 8250b757c47SMichal Meloun 8260b757c47SMichal Meloun elems = NULL; 827f7604b1bSOleksandr Tymoshenko nelems = OF_getencprop_alloc_multi(node, list_name, sizeof(*elems), 8280b757c47SMichal Meloun (void **)&elems); 8290b757c47SMichal Meloun if (nelems <= 0) 8300b757c47SMichal Meloun return (ENOENT); 83191ef8da0SAdrian Chadd rv = (idx == -1) ? 0 : ENOENT; 8320b757c47SMichal Meloun for (i = 0, cnt = 0; i < nelems; i += pcells, cnt++) { 8330b757c47SMichal Meloun pnode = elems[i++]; 8340b757c47SMichal Meloun if (OF_getencprop(OF_node_from_xref(pnode), 8350b757c47SMichal Meloun cells_name, &pcells, sizeof(pcells)) == -1) { 8360b757c47SMichal Meloun printf("Missing %s property\n", cells_name); 8370b757c47SMichal Meloun rv = ENOENT; 8380b757c47SMichal Meloun break; 8390b757c47SMichal Meloun } 8400b757c47SMichal Meloun 8410b757c47SMichal Meloun if ((i + pcells) > nelems) { 8420b757c47SMichal Meloun printf("Invalid %s property value <%d>\n", cells_name, 8430b757c47SMichal Meloun pcells); 8440b757c47SMichal Meloun rv = ERANGE; 8450b757c47SMichal Meloun break; 8460b757c47SMichal Meloun } 8470b757c47SMichal Meloun if (cnt == idx) { 8480b757c47SMichal Meloun *cells= malloc(pcells * sizeof(**cells), M_OFWPROP, 8490b757c47SMichal Meloun M_WAITOK); 8500b757c47SMichal Meloun *producer = pnode; 8510b757c47SMichal Meloun *ncells = pcells; 8520b757c47SMichal Meloun for (j = 0; j < pcells; j++) 8530b757c47SMichal Meloun (*cells)[j] = elems[i + j]; 8540b757c47SMichal Meloun rv = 0; 8550b757c47SMichal Meloun break; 8560b757c47SMichal Meloun } 8570b757c47SMichal Meloun } 8580b757c47SMichal Meloun if (elems != NULL) 8590b757c47SMichal Meloun free(elems, M_OFWPROP); 86091ef8da0SAdrian Chadd if (idx == -1 && rv == 0) 86191ef8da0SAdrian Chadd *ncells = cnt; 8620b757c47SMichal Meloun return (rv); 8630b757c47SMichal Meloun } 8640b757c47SMichal Meloun 8650b757c47SMichal Meloun /* 86691ef8da0SAdrian Chadd * Parse property that contain list of xrefs and values 86791ef8da0SAdrian Chadd * (like standard "clocks" and "resets" properties) 86891ef8da0SAdrian Chadd * Input arguments: 86991ef8da0SAdrian Chadd * node - consumers device node 87091ef8da0SAdrian Chadd * list_name - name of parsed list - "clocks" 87191ef8da0SAdrian Chadd * cells_name - name of size property - "#clock-cells" 87291ef8da0SAdrian Chadd * idx - the index of the requested list entry (>= 0) 87391ef8da0SAdrian Chadd * Output arguments: 87491ef8da0SAdrian Chadd * producer - handle of producer 87591ef8da0SAdrian Chadd * ncells - number of cells in result 87691ef8da0SAdrian Chadd * cells - array of decoded cells 87791ef8da0SAdrian Chadd */ 87891ef8da0SAdrian Chadd int 87991ef8da0SAdrian Chadd ofw_bus_parse_xref_list_alloc(phandle_t node, const char *list_name, 88091ef8da0SAdrian Chadd const char *cells_name, int idx, phandle_t *producer, int *ncells, 88191ef8da0SAdrian Chadd pcell_t **cells) 88291ef8da0SAdrian Chadd { 88391ef8da0SAdrian Chadd 88491ef8da0SAdrian Chadd KASSERT(idx >= 0, 88591ef8da0SAdrian Chadd ("ofw_bus_parse_xref_list_alloc: negative index supplied")); 88691ef8da0SAdrian Chadd 88791ef8da0SAdrian Chadd return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name, 88891ef8da0SAdrian Chadd idx, producer, ncells, cells)); 88991ef8da0SAdrian Chadd } 89091ef8da0SAdrian Chadd 89191ef8da0SAdrian Chadd /* 89291ef8da0SAdrian Chadd * Parse property that contain list of xrefs and values 89391ef8da0SAdrian Chadd * (like standard "clocks" and "resets" properties) 89491ef8da0SAdrian Chadd * and determine the number of items in the list 89591ef8da0SAdrian Chadd * Input arguments: 89691ef8da0SAdrian Chadd * node - consumers device node 89791ef8da0SAdrian Chadd * list_name - name of parsed list - "clocks" 89891ef8da0SAdrian Chadd * cells_name - name of size property - "#clock-cells" 89991ef8da0SAdrian Chadd * Output arguments: 90091ef8da0SAdrian Chadd * count - number of items in list 90191ef8da0SAdrian Chadd */ 90291ef8da0SAdrian Chadd int 90391ef8da0SAdrian Chadd ofw_bus_parse_xref_list_get_length(phandle_t node, const char *list_name, 90491ef8da0SAdrian Chadd const char *cells_name, int *count) 90591ef8da0SAdrian Chadd { 90691ef8da0SAdrian Chadd 90791ef8da0SAdrian Chadd return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name, 90891ef8da0SAdrian Chadd -1, NULL, count, NULL)); 90991ef8da0SAdrian Chadd } 91091ef8da0SAdrian Chadd 91191ef8da0SAdrian Chadd /* 9120b757c47SMichal Meloun * Find index of string in string list property (case sensitive). 9130b757c47SMichal Meloun */ 9140b757c47SMichal Meloun int 9150b757c47SMichal Meloun ofw_bus_find_string_index(phandle_t node, const char *list_name, 9160b757c47SMichal Meloun const char *name, int *idx) 9170b757c47SMichal Meloun { 9180b757c47SMichal Meloun char *elems; 9190b757c47SMichal Meloun int rv, i, cnt, nelems; 9200b757c47SMichal Meloun 9210b757c47SMichal Meloun elems = NULL; 922217d17bcSOleksandr Tymoshenko nelems = OF_getprop_alloc(node, list_name, (void **)&elems); 9230b757c47SMichal Meloun if (nelems <= 0) 9240b757c47SMichal Meloun return (ENOENT); 9250b757c47SMichal Meloun 9260b757c47SMichal Meloun rv = ENOENT; 9270b757c47SMichal Meloun for (i = 0, cnt = 0; i < nelems; cnt++) { 9280b757c47SMichal Meloun if (strcmp(elems + i, name) == 0) { 9290b757c47SMichal Meloun *idx = cnt; 9300b757c47SMichal Meloun rv = 0; 9310b757c47SMichal Meloun break; 9320b757c47SMichal Meloun } 9330b757c47SMichal Meloun i += strlen(elems + i) + 1; 9340b757c47SMichal Meloun } 9350b757c47SMichal Meloun 9360b757c47SMichal Meloun if (elems != NULL) 9370b757c47SMichal Meloun free(elems, M_OFWPROP); 9380b757c47SMichal Meloun return (rv); 9390b757c47SMichal Meloun } 9400b757c47SMichal Meloun 9410b757c47SMichal Meloun /* 9420b757c47SMichal Meloun * Create zero terminated array of strings from string list property. 9430b757c47SMichal Meloun */ 9440b757c47SMichal Meloun int 9450b757c47SMichal Meloun ofw_bus_string_list_to_array(phandle_t node, const char *list_name, 946086a6314SMichal Meloun const char ***out_array) 9470b757c47SMichal Meloun { 9480b757c47SMichal Meloun char *elems, *tptr; 949086a6314SMichal Meloun const char **array; 9500b757c47SMichal Meloun int i, cnt, nelems, len; 9510b757c47SMichal Meloun 9520b757c47SMichal Meloun elems = NULL; 953217d17bcSOleksandr Tymoshenko nelems = OF_getprop_alloc(node, list_name, (void **)&elems); 9540b757c47SMichal Meloun if (nelems <= 0) 9550b757c47SMichal Meloun return (nelems); 9560b757c47SMichal Meloun 9570b757c47SMichal Meloun /* Count number of strings. */ 9580b757c47SMichal Meloun for (i = 0, cnt = 0; i < nelems; cnt++) 9590b757c47SMichal Meloun i += strlen(elems + i) + 1; 9600b757c47SMichal Meloun 9610b757c47SMichal Meloun /* Allocate space for arrays and all strings. */ 962086a6314SMichal Meloun array = malloc((cnt + 1) * sizeof(char *) + nelems, M_OFWPROP, 9630b757c47SMichal Meloun M_WAITOK); 9640b757c47SMichal Meloun 9650b757c47SMichal Meloun /* Get address of first string. */ 966086a6314SMichal Meloun tptr = (char *)(array + cnt + 1); 9670b757c47SMichal Meloun 9680b757c47SMichal Meloun /* Copy strings. */ 9690b757c47SMichal Meloun memcpy(tptr, elems, nelems); 9700b757c47SMichal Meloun free(elems, M_OFWPROP); 9710b757c47SMichal Meloun 9720b757c47SMichal Meloun /* Fill string pointers. */ 9730b757c47SMichal Meloun for (i = 0, cnt = 0; i < nelems; cnt++) { 974086a6314SMichal Meloun len = strlen(tptr) + 1; 975086a6314SMichal Meloun array[cnt] = tptr; 9760b757c47SMichal Meloun i += len; 9770b757c47SMichal Meloun tptr += len; 9780b757c47SMichal Meloun } 9794d24901aSPedro F. Giffuni array[cnt] = NULL; 980086a6314SMichal Meloun *out_array = array; 9810b757c47SMichal Meloun 9820b757c47SMichal Meloun return (cnt); 9830b757c47SMichal Meloun } 984