octeon_pmc.c revision 233336
1/*- 2 * Copyright (c) 2012 Oleksandr Tymoshenko <gonzo@freebsd.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD: head/sys/mips/cavium/octeon_pmc.c 233336 2012-03-23 00:11:54Z gonzo $ 27 */ 28 29#include <sys/cdefs.h> 30__FBSDID("$FreeBSD: head/sys/mips/cavium/octeon_pmc.c 233336 2012-03-23 00:11:54Z gonzo $"); 31 32#include <sys/param.h> 33#include <sys/systm.h> 34#include <sys/bus.h> 35#include <sys/interrupt.h> 36#include <sys/kernel.h> 37#include <sys/module.h> 38#include <sys/rman.h> 39#include <sys/malloc.h> 40#include <sys/smp.h> 41#include <sys/pmc.h> 42#include <sys/pmckern.h> 43 44#include <machine/bus.h> 45#include <machine/intr_machdep.h> 46 47#include <contrib/octeon-sdk/cvmx.h> 48#include <mips/cavium/octeon_irq.h> 49 50struct octeon_pmc_softc { 51 struct rman irq_rman; 52 struct resource *octeon_pmc_irq; 53}; 54 55static void octeon_pmc_identify(driver_t *, device_t); 56static int octeon_pmc_probe(device_t); 57static int octeon_pmc_attach(device_t); 58static int octeon_pmc_intr(void *); 59 60#define OCTEON_PMC_IRQ 4 61 62static void 63octeon_pmc_identify(driver_t *drv, device_t parent) 64{ 65 if (octeon_has_feature(OCTEON_FEATURE_USB)) 66 BUS_ADD_CHILD(parent, 0, "pmc", 0); 67} 68 69static int 70octeon_pmc_probe(device_t dev) 71{ 72 if (device_get_unit(dev) != 0) 73 return (ENXIO); 74 75 device_set_desc(dev, "Cavium Octeon Performance Counters"); 76 return (0); 77} 78 79static int 80octeon_pmc_attach(device_t dev) 81{ 82 struct octeon_pmc_softc *sc; 83 int error; 84 int rid; 85 uint64_t cvmctl; 86 87 sc = device_get_softc(dev); 88 89 rid = 0; 90 sc->octeon_pmc_irq = bus_alloc_resource(dev, 91 SYS_RES_IRQ, &rid, OCTEON_PMC_IRQ, 92 OCTEON_PMC_IRQ, 1, RF_ACTIVE); 93 94 if (sc->octeon_pmc_irq == NULL) { 95 device_printf(dev, "could not allocate irq%d\n", OCTEON_PMC_IRQ); 96 return (ENXIO); 97 } 98 99 error = bus_setup_intr(dev, sc->octeon_pmc_irq, 100 INTR_TYPE_MISC, octeon_pmc_intr, NULL, sc, NULL); 101 if (error != 0) { 102 device_printf(dev, "bus_setup_intr failed: %d\n", error); 103 return (error); 104 } 105 106 /* 107 * Move the Performance Counter interrupt to OCTEON_PMC_IRQ 108 */ 109 cvmctl = mips_rd_cvmctl(); 110 cvmctl &= ~(7 << 7); 111 cvmctl |= (OCTEON_PMC_IRQ + 2) << 7; 112 mips_wr_cvmctl(cvmctl); 113 114 return (0); 115} 116 117static int 118octeon_pmc_intr(void *arg) 119{ 120 struct trapframe *tf = PCPU_GET(curthread)->td_intr_frame; 121 122 if (pmc_intr) 123 (*pmc_intr)(PCPU_GET(cpuid), tf); 124 125 return (FILTER_HANDLED); 126} 127 128static device_method_t octeon_pmc_methods[] = { 129 DEVMETHOD(device_identify, octeon_pmc_identify), 130 DEVMETHOD(device_probe, octeon_pmc_probe), 131 DEVMETHOD(device_attach, octeon_pmc_attach), 132 { 0, 0 } 133}; 134 135static driver_t octeon_pmc_driver = { 136 "pmc", 137 octeon_pmc_methods, 138 sizeof(struct octeon_pmc_softc), 139}; 140static devclass_t octeon_pmc_devclass; 141DRIVER_MODULE(octeon_pmc, nexus, octeon_pmc_driver, octeon_pmc_devclass, 0, 0); 142