freebsd-dev/sys/arm64/coresight/coresight-dynamic-replicator.c
Ruslan Bukin b09de0b34a Add support for the Coresight technology from ARM Ltd.
ARM Coresight is a solution for debug and trace of complex SoC designs.

This includes a collection of drivers for ARM Coresight interconnect
devices within a small Coresight framework.

Supported devices are:
o Embedded Trace Macrocell v4 (ETMv4)
o Funnel
o Dynamic Replicator
o Trace Memory Controller (TMC)
o CPU debug module

Devices are connected to each other internally in SoC and the
configuration of each device endpoints is described in FDT.

Typical trace flow (as found on Qualcomm Snapdragon 410e):
CPU0 -> ETM0 -> funnel1 -> funnel0 -> ETF -> replicator -> ETR -> DRAM
CPU1 -> ETM1 -^
CPU2 -> ETM2 -^
CPU3 -> ETM3 -^

Note that both Embedded Trace FIFO (ETF) and Embedded Trace Router (ETR)
are hardware configurations of TMC.

This is required for upcoming HWPMC tracing support.

This is tested on single-core system only.

Reviewed by:	andrew (partially)
Sponsored by:	DARPA, AFRL
Differential Revision:	https://reviews.freebsd.org/D14618
2018-04-05 15:45:54 +00:00

173 lines
4.5 KiB
C

/*-
* Copyright (c) 2018 Ruslan Bukin <br@bsdpad.com>
* All rights reserved.
*
* This software was developed by BAE Systems, the University of Cambridge
* Computer Laboratory, and Memorial University under DARPA/AFRL contract
* FA8650-15-C-7558 ("CADETS"), as part of the DARPA Transparent Computing
* (TC) research program.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <machine/bus.h>
#include <arm64/coresight/coresight.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include "coresight_if.h"
#define REPLICATOR_IDFILTER0 0x00
#define REPLICATOR_IDFILTER1 0x04
static struct ofw_compat_data compat_data[] = {
{ "arm,coresight-dynamic-replicator", 1 },
{ NULL, 0 }
};
struct replicator_softc {
struct resource *res;
struct coresight_platform_data *pdata;
};
static struct resource_spec replicator_spec[] = {
{ SYS_RES_MEMORY, 0, RF_ACTIVE },
{ -1, 0 }
};
static int
replicator_init(device_t dev)
{
struct replicator_softc *sc;
sc = device_get_softc(dev);
/* Unlock Coresight */
bus_write_4(sc->res, CORESIGHT_LAR, CORESIGHT_UNLOCK);
return (0);
}
static int
replicator_enable(device_t dev, struct endpoint *endp,
struct coresight_event *event)
{
struct replicator_softc *sc;
sc = device_get_softc(dev);
/* Enable the port. Keep the other port disabled */
if (endp->reg == 0) {
bus_write_4(sc->res, REPLICATOR_IDFILTER0, 0x00);
bus_write_4(sc->res, REPLICATOR_IDFILTER1, 0xff);
} else {
bus_write_4(sc->res, REPLICATOR_IDFILTER0, 0xff);
bus_write_4(sc->res, REPLICATOR_IDFILTER1, 0x00);
}
return (0);
}
static void
replicator_disable(device_t dev, struct endpoint *endp,
struct coresight_event *event)
{
struct replicator_softc *sc;
sc = device_get_softc(dev);
bus_write_4(sc->res, REPLICATOR_IDFILTER0, 0xff);
bus_write_4(sc->res, REPLICATOR_IDFILTER1, 0xff);
}
static int
replicator_probe(device_t dev)
{
if (!ofw_bus_status_okay(dev))
return (ENXIO);
if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0)
return (ENXIO);
device_set_desc(dev, "Coresight Dynamic Replicator");
return (BUS_PROBE_DEFAULT);
}
static int
replicator_attach(device_t dev)
{
struct replicator_softc *sc;
struct coresight_desc desc;
sc = device_get_softc(dev);
if (bus_alloc_resources(dev, replicator_spec, &sc->res) != 0) {
device_printf(dev, "cannot allocate resources for device\n");
return (ENXIO);
}
sc->pdata = coresight_get_platform_data(dev);
desc.pdata = sc->pdata;
desc.dev = dev;
desc.dev_type = CORESIGHT_DYNAMIC_REPLICATOR;
coresight_register(&desc);
return (0);
}
static device_method_t replicator_methods[] = {
/* Device interface */
DEVMETHOD(device_probe, replicator_probe),
DEVMETHOD(device_attach, replicator_attach),
/* Coresight interface */
DEVMETHOD(coresight_init, replicator_init),
DEVMETHOD(coresight_enable, replicator_enable),
DEVMETHOD(coresight_disable, replicator_disable),
DEVMETHOD_END
};
static driver_t replicator_driver = {
"replicator",
replicator_methods,
sizeof(struct replicator_softc),
};
static devclass_t replicator_devclass;
DRIVER_MODULE(replicator, simplebus, replicator_driver, replicator_devclass,
0, 0);
MODULE_VERSION(replicator, 1);