coresight_fdt.c

Version: - FREEBSD - FREEBSD-13-STABLE - FREEBSD-13-0 - FREEBSD-12-STABLE - FREEBSD-12-0 - FREEBSD-11-STABLE - FREEBSD-11-0 - FREEBSD-10-STABLE - FREEBSD-10-0 - FREEBSD-9-STABLE - FREEBSD-9-0 - FREEBSD-8-STABLE - FREEBSD-8-0 - FREEBSD-7-STABLE - FREEBSD-7-0 - FREEBSD-6-STABLE - FREEBSD-6-0 - FREEBSD-5-STABLE - FREEBSD-5-0 - FREEBSD-4-STABLE - FREEBSD-3-STABLE - FREEBSD22 - l41 - OPENBSD - linux-2.6 - MK84 - PLAN9 - xnu-8792
SearchContext: - none - 3 - 10

    1 /*-
    2  * Copyright (c) 2018-2020 Ruslan Bukin <br@bsdpad.com>
    3  * All rights reserved.
    4  *
    5  * This software was developed by SRI International and the University of
    6  * Cambridge Computer Laboratory under DARPA/AFRL contract FA8750-10-C-0237
    7  * ("CTSRD"), as part of the DARPA CRASH research programme.
    8  *
    9  * Redistribution and use in source and binary forms, with or without
   10  * modification, are permitted provided that the following conditions
   11  * are met:
   12  * 1. Redistributions of source code must retain the above copyright
   13  *    notice, this list of conditions and the following disclaimer.
   14  * 2. Redistributions in binary form must reproduce the above copyright
   15  *    notice, this list of conditions and the following disclaimer in the
   16  *    documentation and/or other materials provided with the distribution.
   17  *
   18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   28  * SUCH DAMAGE.
   29  */
   30 
   31 #include <sys/cdefs.h>
   32 __FBSDID("$FreeBSD$");
   33 
   34 #include <sys/param.h>
   35 #include <sys/systm.h>
   36 #include <sys/bus.h>
   37 #include <sys/rman.h>
   38 #include <sys/kernel.h>
   39 #include <sys/lock.h>
   40 #include <sys/module.h>
   41 #include <sys/mutex.h>
   42 #include <machine/bus.h>
   43 
   44 #include <dev/ofw/ofw_bus.h>
   45 #include <dev/ofw/ofw_bus_subr.h>
   46 
   47 #include <arm64/coresight/coresight.h>
   48 
   49 static int
   50 coresight_fdt_get_ports(phandle_t dev_node,
   51     struct coresight_platform_data *pdata)
   52 {
   53         phandle_t node, child;
   54         pcell_t port_reg;
   55         phandle_t xref;
   56         char *name;
   57         int ret;
   58         phandle_t endpoint_child;
   59         struct endpoint *endp;
   60 
   61         child = ofw_bus_find_child(dev_node, "ports");
   62         if (child)
   63                 node = child;
   64         else
   65                 node = dev_node;
   66 
   67         for (child = OF_child(node); child != 0; child = OF_peer(child)) {
   68                 ret = OF_getprop_alloc(child, "name", (void **)&name);
   69                 if (ret == -1)
   70                         continue;
   71 
   72                 if (strcasecmp(name, "port") ||
   73                     strncasecmp(name, "port@", 6)) {
   74                         port_reg = -1;
   75                         OF_getencprop(child, "reg", (void *)&port_reg,
   76                             sizeof(port_reg));
   77 
   78                         endpoint_child = ofw_bus_find_child(child, "endpoint");
   79                         if (endpoint_child) {
   80                                 if (OF_getencprop(endpoint_child,
   81                                     "remote-endpoint", &xref,
   82                                     sizeof(xref)) == -1) {
   83                                         printf("failed\n");
   84                                         continue;
   85                                 }
   86                                 endp = malloc(sizeof(struct endpoint),
   87                                     M_CORESIGHT, M_WAITOK | M_ZERO);
   88                                 endp->my_node = endpoint_child;
   89                                 endp->their_node = OF_node_from_xref(xref);
   90                                 endp->dev_node = dev_node;
   91                                 endp->reg = port_reg;
   92                                 if (OF_getproplen(endpoint_child,
   93                                     "slave-mode") >= 0) {
   94                                         pdata->in_ports++;
   95                                         endp->input = 1;
   96                                 } else
   97                                         pdata->out_ports++;
   98 
   99                                 mtx_lock(&pdata->mtx_lock);
  100                                 TAILQ_INSERT_TAIL(&pdata->endpoints,
  101                                     endp, link);
  102                                 mtx_unlock(&pdata->mtx_lock);
  103                         }
  104                 }
  105         }
  106 
  107         return (0);
  108 }
  109 
  110 static int
  111 coresight_fdt_get_cpu(phandle_t node,
  112     struct coresight_platform_data *pdata)
  113 {
  114         phandle_t cpu_node;
  115         pcell_t xref;
  116         pcell_t cpu_reg;
  117 
  118         if (OF_getencprop(node, "cpu", &xref, sizeof(xref)) != -1) {
  119                 cpu_node = OF_node_from_xref(xref);
  120                 if (OF_getencprop(cpu_node, "reg", (void *)&cpu_reg,
  121                         sizeof(cpu_reg)) > 0) {
  122                         pdata->cpu = cpu_reg;
  123                         return (0);
  124                 }
  125         }
  126 
  127         return (-1);
  128 }
  129 
  130 struct coresight_platform_data *
  131 coresight_fdt_get_platform_data(device_t dev)
  132 {
  133         struct coresight_platform_data *pdata;
  134         phandle_t node;
  135 
  136         node = ofw_bus_get_node(dev);
  137 
  138         pdata = malloc(sizeof(struct coresight_platform_data),
  139             M_CORESIGHT, M_WAITOK | M_ZERO);
  140         pdata->bus_type = CORESIGHT_BUS_FDT;
  141 
  142         mtx_init(&pdata->mtx_lock, "Coresight Platform Data", NULL, MTX_DEF);
  143         TAILQ_INIT(&pdata->endpoints);
  144 
  145         coresight_fdt_get_cpu(node, pdata);
  146         coresight_fdt_get_ports(node, pdata);
  147 
  148         if (bootverbose)
  149                 printf("Total ports: in %d out %d\n",
  150                     pdata->in_ports, pdata->out_ports);
  151 
  152         return (pdata);
  153 }

Cache object: 692874449a28487950412b32d78c136b

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.

FreeBSD/Linux Kernel Cross Reference sys/arm64/coresight/coresight_fdt.c

FreeBSD/Linux Kernel Cross Reference
sys/arm64/coresight/coresight_fdt.c