sys/arm/arm/pmu.c

   1 /*-
   2  * Copyright (c) 2015 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 /*
  32  * Performance Monitoring Unit
  33  */
  34
  35 #include <sys/cdefs.h>
  36 __FBSDID("$FreeBSD$");
  37
  38 #include "opt_hwpmc_hooks.h"
  39
  40 #include <sys/param.h>
  41 #include <sys/systm.h>
  42 #include <sys/bus.h>
  43 #include <sys/kernel.h>
  44 #include <sys/module.h>
  45 #include <sys/malloc.h>
  46 #include <sys/rman.h>
  47 #include <sys/timeet.h>
  48 #include <sys/timetc.h>
  49 #include <sys/pmc.h>
  50 #include <sys/pmckern.h>
  51
  52 #include <dev/fdt/fdt_common.h>
  53 #include <dev/ofw/openfirm.h>
  54 #include <dev/ofw/ofw_bus.h>
  55 #include <dev/ofw/ofw_bus_subr.h>
  56
  57 #include <machine/bus.h>
  58 #include <machine/cpu.h>
  59 #include <machine/intr.h>
  60
  61 #define MAX_RLEN        8
  62
  63 struct pmu_softc {
  64         struct resource         *res[MAX_RLEN];
  65         device_t                dev;
  66         void                    *ih[MAX_RLEN];
  67 };
  68
  69 static struct ofw_compat_data compat_data[] = {
  70         {"arm,armv8-pmuv3",     1},
  71         {"arm,cortex-a17-pmu",  1},
  72         {"arm,cortex-a15-pmu",  1},
  73         {"arm,cortex-a12-pmu",  1},
  74         {"arm,cortex-a9-pmu",   1},
  75         {"arm,cortex-a8-pmu",   1},
  76         {"arm,cortex-a7-pmu",   1},
  77         {"arm,cortex-a5-pmu",   1},
  78         {"arm,arm11mpcore-pmu", 1},
  79         {"arm,arm1176-pmu",     1},
  80         {"arm,arm1136-pmu",     1},
  81         {"qcom,krait-pmu",      1},
  82         {NULL,                  0}
  83 };
  84
  85 static struct resource_spec pmu_spec[] = {
  86         { SYS_RES_IRQ,          0,      RF_ACTIVE },
  87         { SYS_RES_IRQ,          1,      RF_ACTIVE | RF_OPTIONAL },
  88         { SYS_RES_IRQ,          2,      RF_ACTIVE | RF_OPTIONAL },
  89         { SYS_RES_IRQ,          3,      RF_ACTIVE | RF_OPTIONAL },
  90         { SYS_RES_IRQ,          4,      RF_ACTIVE | RF_OPTIONAL },
  91         { SYS_RES_IRQ,          5,      RF_ACTIVE | RF_OPTIONAL },
  92         { SYS_RES_IRQ,          6,      RF_ACTIVE | RF_OPTIONAL },
  93         { SYS_RES_IRQ,          7,      RF_ACTIVE | RF_OPTIONAL },
  94         { -1, 0 }
  95 };
  96
  97 static int
  98 pmu_intr(void *arg)
  99 {
 100         struct trapframe *tf;
 101
 102         tf = arg;
 103
 104 #ifdef HWPMC_HOOKS
 105         if (pmc_intr)
 106                 (*pmc_intr)(PCPU_GET(cpuid), tf);
 107 #endif
 108
 109         return (FILTER_HANDLED);
 110 }
 111
 112 static int
 113 pmu_probe(device_t dev)
 114 {
 115
 116         if (!ofw_bus_status_okay(dev))
 117                 return (ENXIO);
 118
 119         if (ofw_bus_search_compatible(dev, compat_data)->ocd_data != 0) {
 120                 device_set_desc(dev, "Performance Monitoring Unit");
 121                 return (BUS_PROBE_DEFAULT);
 122         }
 123
 124         return (ENXIO);
 125 }
 126
 127 static int
 128 pmu_attach(device_t dev)
 129 {
 130         struct pmu_softc *sc;
 131         int err;
 132         int i;
 133
 134         sc = device_get_softc(dev);
 135         sc->dev = dev;
 136
 137         if (bus_alloc_resources(dev, pmu_spec, sc->res)) {
 138                 device_printf(dev, "could not allocate resources\n");
 139                 return (ENXIO);
 140         }
 141
 142         /* Setup interrupt handler */
 143         for (i = 0; i < MAX_RLEN; i++) {
 144                 if (sc->res[i] == NULL)
 145                         break;
 146
 147                 err = bus_setup_intr(dev, sc->res[i], INTR_MPSAFE | INTR_TYPE_MISC,
 148                     pmu_intr, NULL, NULL, &sc->ih[i]);
 149                 if (err) {
 150                         device_printf(dev, "Unable to setup interrupt handler.\n");
 151                         return (ENXIO);
 152                 }
 153         }
 154
 155         return (0);
 156 }
 157
 158 static device_method_t pmu_methods[] = {
 159         DEVMETHOD(device_probe,         pmu_probe),
 160         DEVMETHOD(device_attach,        pmu_attach),
 161         { 0, 0 }
 162 };
 163
 164 static driver_t pmu_driver = {
 165         "pmu",
 166         pmu_methods,
 167         sizeof(struct pmu_softc),
 168 };
 169
 170 static devclass_t pmu_devclass;
 171
 172 DRIVER_MODULE(pmu, simplebus, pmu_driver, pmu_devclass, 0, 0);