sys/arm64/coresight/coresight_funnel_fdt.c

   1 /*-
   2  * Copyright (c) 2018-2020 Ruslan Bukin <br@bsdpad.com>
   3  * All rights reserved.
   4  *
   5  * This software was developed by BAE Systems, the University of Cambridge
   6  * Computer Laboratory, and Memorial University under DARPA/AFRL contract
   7  * FA8650-15-C-7558 ("CADETS"), as part of the DARPA Transparent Computing
   8  * (TC) research program.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  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.
  18  *
  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
  29  * SUCH DAMAGE.
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __FBSDID("$FreeBSD$");
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/bus.h>
  38 #include <sys/rman.h>
  39 #include <sys/kernel.h>
  40 #include <sys/module.h>
  41 #include <machine/bus.h>
  42
  43 #include <dev/ofw/ofw_bus.h>
  44 #include <dev/ofw/ofw_bus_subr.h>
  45
  46 #include <arm64/coresight/coresight.h>
  47 #include <arm64/coresight/coresight_funnel.h>
  48
  49 #include "coresight_if.h"
  50
  51 static struct ofw_compat_data compat_data[] = {
  52         { "arm,coresight-funnel",               HWTYPE_FUNNEL },
  53         { "arm,coresight-static-funnel",        HWTYPE_STATIC_FUNNEL },
  54         { NULL,                                 HWTYPE_NONE }
  55 };
  56
  57 static int
  58 funnel_fdt_probe(device_t dev)
  59 {
  60         struct funnel_softc *sc;
  61
  62         if (!ofw_bus_status_okay(dev))
  63                 return (ENXIO);
  64
  65         sc = device_get_softc(dev);
  66
  67         sc->hwtype = ofw_bus_search_compatible(dev, compat_data)->ocd_data;
  68         switch (sc->hwtype) {
  69         case HWTYPE_FUNNEL:
  70                 device_set_desc(dev, "Coresight Funnel");
  71                 break;
  72         case HWTYPE_STATIC_FUNNEL:
  73                 device_set_desc(dev, "Coresight Static Funnel");
  74                 break;
  75         default:
  76                 return (ENXIO);
  77         };
  78
  79         return (BUS_PROBE_DEFAULT);
  80 }
  81
  82 static int
  83 funnel_fdt_attach(device_t dev)
  84 {
  85         struct funnel_softc *sc;
  86
  87         sc = device_get_softc(dev);
  88         sc->pdata = coresight_fdt_get_platform_data(dev);
  89
  90         return (funnel_attach(dev));
  91 }
  92
  93 static device_method_t funnel_fdt_methods[] = {
  94         /* Device interface */
  95         DEVMETHOD(device_probe,         funnel_fdt_probe),
  96         DEVMETHOD(device_attach,        funnel_fdt_attach),
  97         DEVMETHOD_END
  98 };
  99
 100 DEFINE_CLASS_1(funnel, funnel_fdt_driver, funnel_fdt_methods,
 101     sizeof(struct funnel_softc), funnel_driver);
 102
 103 EARLY_DRIVER_MODULE(funnel, simplebus, funnel_fdt_driver, 0, 0,
 104     BUS_PASS_INTERRUPT + BUS_PASS_ORDER_MIDDLE);