706 строки
21 KiB
C
706 строки
21 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Performance event support for s390x - CPU-measurement Counter Sets
|
|
*
|
|
* Copyright IBM Corp. 2019
|
|
* Author(s): Hendrik Brueckner <brueckner@linux.ibm.com>
|
|
* Thomas Richer <tmricht@linux.ibm.com>
|
|
*/
|
|
#define KMSG_COMPONENT "cpum_cf_diag"
|
|
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel_stat.h>
|
|
#include <linux/percpu.h>
|
|
#include <linux/notifier.h>
|
|
#include <linux/init.h>
|
|
#include <linux/export.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/processor.h>
|
|
|
|
#include <asm/ctl_reg.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/cpu_mcf.h>
|
|
#include <asm/timex.h>
|
|
#include <asm/debug.h>
|
|
|
|
#define CF_DIAG_CTRSET_DEF 0xfeef /* Counter set header mark */
|
|
|
|
static unsigned int cf_diag_cpu_speed;
|
|
static debug_info_t *cf_diag_dbg;
|
|
|
|
struct cf_diag_csd { /* Counter set data per CPU */
|
|
size_t used; /* Bytes used in data/start */
|
|
unsigned char start[PAGE_SIZE]; /* Counter set at event start */
|
|
unsigned char data[PAGE_SIZE]; /* Counter set at event delete */
|
|
};
|
|
static DEFINE_PER_CPU(struct cf_diag_csd, cf_diag_csd);
|
|
|
|
/* Counter sets are stored as data stream in a page sized memory buffer and
|
|
* exported to user space via raw data attached to the event sample data.
|
|
* Each counter set starts with an eight byte header consisting of:
|
|
* - a two byte eye catcher (0xfeef)
|
|
* - a one byte counter set number
|
|
* - a two byte counter set size (indicates the number of counters in this set)
|
|
* - a three byte reserved value (must be zero) to make the header the same
|
|
* size as a counter value.
|
|
* All counter values are eight byte in size.
|
|
*
|
|
* All counter sets are followed by a 64 byte trailer.
|
|
* The trailer consists of a:
|
|
* - flag field indicating valid fields when corresponding bit set
|
|
* - the counter facility first and second version number
|
|
* - the CPU speed if nonzero
|
|
* - the time stamp the counter sets have been collected
|
|
* - the time of day (TOD) base value
|
|
* - the machine type.
|
|
*
|
|
* The counter sets are saved when the process is prepared to be executed on a
|
|
* CPU and saved again when the process is going to be removed from a CPU.
|
|
* The difference of both counter sets are calculated and stored in the event
|
|
* sample data area.
|
|
*/
|
|
|
|
struct cf_ctrset_entry { /* CPU-M CF counter set entry (8 byte) */
|
|
unsigned int def:16; /* 0-15 Data Entry Format */
|
|
unsigned int set:16; /* 16-31 Counter set identifier */
|
|
unsigned int ctr:16; /* 32-47 Number of stored counters */
|
|
unsigned int res1:16; /* 48-63 Reserved */
|
|
};
|
|
|
|
struct cf_trailer_entry { /* CPU-M CF_DIAG trailer (64 byte) */
|
|
/* 0 - 7 */
|
|
union {
|
|
struct {
|
|
unsigned int clock_base:1; /* TOD clock base set */
|
|
unsigned int speed:1; /* CPU speed set */
|
|
/* Measurement alerts */
|
|
unsigned int mtda:1; /* Loss of MT ctr. data alert */
|
|
unsigned int caca:1; /* Counter auth. change alert */
|
|
unsigned int lcda:1; /* Loss of counter data alert */
|
|
};
|
|
unsigned long flags; /* 0-63 All indicators */
|
|
};
|
|
/* 8 - 15 */
|
|
unsigned int cfvn:16; /* 64-79 Ctr First Version */
|
|
unsigned int csvn:16; /* 80-95 Ctr Second Version */
|
|
unsigned int cpu_speed:32; /* 96-127 CPU speed */
|
|
/* 16 - 23 */
|
|
unsigned long timestamp; /* 128-191 Timestamp (TOD) */
|
|
/* 24 - 55 */
|
|
union {
|
|
struct {
|
|
unsigned long progusage1;
|
|
unsigned long progusage2;
|
|
unsigned long progusage3;
|
|
unsigned long tod_base;
|
|
};
|
|
unsigned long progusage[4];
|
|
};
|
|
/* 56 - 63 */
|
|
unsigned int mach_type:16; /* Machine type */
|
|
unsigned int res1:16; /* Reserved */
|
|
unsigned int res2:32; /* Reserved */
|
|
};
|
|
|
|
/* Create the trailer data at the end of a page. */
|
|
static void cf_diag_trailer(struct cf_trailer_entry *te)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
struct cpuid cpuid;
|
|
|
|
te->cfvn = cpuhw->info.cfvn; /* Counter version numbers */
|
|
te->csvn = cpuhw->info.csvn;
|
|
|
|
get_cpu_id(&cpuid); /* Machine type */
|
|
te->mach_type = cpuid.machine;
|
|
te->cpu_speed = cf_diag_cpu_speed;
|
|
if (te->cpu_speed)
|
|
te->speed = 1;
|
|
te->clock_base = 1; /* Save clock base */
|
|
memcpy(&te->tod_base, &tod_clock_base[1], 8);
|
|
store_tod_clock((__u64 *)&te->timestamp);
|
|
}
|
|
|
|
/*
|
|
* Change the CPUMF state to active.
|
|
* Enable and activate the CPU-counter sets according
|
|
* to the per-cpu control state.
|
|
*/
|
|
static void cf_diag_enable(struct pmu *pmu)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
int err;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s pmu %p cpu %d flags %#x state %#llx\n",
|
|
__func__, pmu, smp_processor_id(), cpuhw->flags,
|
|
cpuhw->state);
|
|
if (cpuhw->flags & PMU_F_ENABLED)
|
|
return;
|
|
|
|
err = lcctl(cpuhw->state);
|
|
if (err) {
|
|
pr_err("Enabling the performance measuring unit "
|
|
"failed with rc=%x\n", err);
|
|
return;
|
|
}
|
|
cpuhw->flags |= PMU_F_ENABLED;
|
|
}
|
|
|
|
/*
|
|
* Change the CPUMF state to inactive.
|
|
* Disable and enable (inactive) the CPU-counter sets according
|
|
* to the per-cpu control state.
|
|
*/
|
|
static void cf_diag_disable(struct pmu *pmu)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
u64 inactive;
|
|
int err;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s pmu %p cpu %d flags %#x state %#llx\n",
|
|
__func__, pmu, smp_processor_id(), cpuhw->flags,
|
|
cpuhw->state);
|
|
if (!(cpuhw->flags & PMU_F_ENABLED))
|
|
return;
|
|
|
|
inactive = cpuhw->state & ~((1 << CPUMF_LCCTL_ENABLE_SHIFT) - 1);
|
|
err = lcctl(inactive);
|
|
if (err) {
|
|
pr_err("Disabling the performance measuring unit "
|
|
"failed with rc=%x\n", err);
|
|
return;
|
|
}
|
|
cpuhw->flags &= ~PMU_F_ENABLED;
|
|
}
|
|
|
|
/* Number of perf events counting hardware events */
|
|
static atomic_t cf_diag_events = ATOMIC_INIT(0);
|
|
|
|
/* Release the PMU if event is the last perf event */
|
|
static void cf_diag_perf_event_destroy(struct perf_event *event)
|
|
{
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d cf_diag_events %d\n",
|
|
__func__, event, event->cpu,
|
|
atomic_read(&cf_diag_events));
|
|
if (atomic_dec_return(&cf_diag_events) == 0)
|
|
__kernel_cpumcf_end();
|
|
}
|
|
|
|
/* Setup the event. Test for authorized counter sets and only include counter
|
|
* sets which are authorized at the time of the setup. Including unauthorized
|
|
* counter sets result in specification exception (and panic).
|
|
*/
|
|
static int __hw_perf_event_init(struct perf_event *event)
|
|
{
|
|
struct perf_event_attr *attr = &event->attr;
|
|
struct cpu_cf_events *cpuhw;
|
|
enum cpumf_ctr_set i;
|
|
int err = 0;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s event %p cpu %d\n", __func__,
|
|
event, event->cpu);
|
|
|
|
event->hw.config = attr->config;
|
|
event->hw.config_base = 0;
|
|
|
|
/* Add all authorized counter sets to config_base. The
|
|
* the hardware init function is either called per-cpu or just once
|
|
* for all CPUS (event->cpu == -1). This depends on the whether
|
|
* counting is started for all CPUs or on a per workload base where
|
|
* the perf event moves from one CPU to another CPU.
|
|
* Checking the authorization on any CPU is fine as the hardware
|
|
* applies the same authorization settings to all CPUs.
|
|
*/
|
|
cpuhw = &get_cpu_var(cpu_cf_events);
|
|
for (i = CPUMF_CTR_SET_BASIC; i < CPUMF_CTR_SET_MAX; ++i)
|
|
if (cpuhw->info.auth_ctl & cpumf_ctr_ctl[i])
|
|
event->hw.config_base |= cpumf_ctr_ctl[i];
|
|
put_cpu_var(cpu_cf_events);
|
|
|
|
/* No authorized counter sets, nothing to count/sample */
|
|
if (!event->hw.config_base) {
|
|
err = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
/* Set sample_period to indicate sampling */
|
|
event->hw.sample_period = attr->sample_period;
|
|
local64_set(&event->hw.period_left, event->hw.sample_period);
|
|
event->hw.last_period = event->hw.sample_period;
|
|
out:
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s err %d config_base %#lx\n",
|
|
__func__, err, event->hw.config_base);
|
|
return err;
|
|
}
|
|
|
|
static int cf_diag_event_init(struct perf_event *event)
|
|
{
|
|
struct perf_event_attr *attr = &event->attr;
|
|
int err = -ENOENT;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d config %#llx "
|
|
"sample_type %#llx cf_diag_events %d\n", __func__,
|
|
event, event->cpu, attr->config, attr->sample_type,
|
|
atomic_read(&cf_diag_events));
|
|
|
|
if (event->attr.config != PERF_EVENT_CPUM_CF_DIAG ||
|
|
event->attr.type != PERF_TYPE_RAW)
|
|
goto out;
|
|
|
|
/* Raw events are used to access counters directly,
|
|
* hence do not permit excludes.
|
|
* This event is usesless without PERF_SAMPLE_RAW to return counter set
|
|
* values as raw data.
|
|
*/
|
|
if (attr->exclude_kernel || attr->exclude_user || attr->exclude_hv ||
|
|
!(attr->sample_type & (PERF_SAMPLE_CPU | PERF_SAMPLE_RAW))) {
|
|
err = -EOPNOTSUPP;
|
|
goto out;
|
|
}
|
|
|
|
/* Initialize for using the CPU-measurement counter facility */
|
|
if (atomic_inc_return(&cf_diag_events) == 1) {
|
|
if (__kernel_cpumcf_begin()) {
|
|
atomic_dec(&cf_diag_events);
|
|
err = -EBUSY;
|
|
goto out;
|
|
}
|
|
}
|
|
event->destroy = cf_diag_perf_event_destroy;
|
|
|
|
err = __hw_perf_event_init(event);
|
|
if (unlikely(err))
|
|
event->destroy(event);
|
|
out:
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s err %d\n", __func__, err);
|
|
return err;
|
|
}
|
|
|
|
static void cf_diag_read(struct perf_event *event)
|
|
{
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s event %p\n", __func__, event);
|
|
}
|
|
|
|
/* Return the maximum possible counter set size (in number of 8 byte counters)
|
|
* depending on type and model number.
|
|
*/
|
|
static size_t cf_diag_ctrset_size(enum cpumf_ctr_set ctrset,
|
|
struct cpumf_ctr_info *info)
|
|
{
|
|
size_t ctrset_size = 0;
|
|
|
|
switch (ctrset) {
|
|
case CPUMF_CTR_SET_BASIC:
|
|
if (info->cfvn >= 1)
|
|
ctrset_size = 6;
|
|
break;
|
|
case CPUMF_CTR_SET_USER:
|
|
if (info->cfvn == 1)
|
|
ctrset_size = 6;
|
|
else if (info->cfvn >= 3)
|
|
ctrset_size = 2;
|
|
break;
|
|
case CPUMF_CTR_SET_CRYPTO:
|
|
if (info->csvn >= 1 && info->csvn <= 5)
|
|
ctrset_size = 16;
|
|
else if (info->csvn == 6)
|
|
ctrset_size = 20;
|
|
break;
|
|
case CPUMF_CTR_SET_EXT:
|
|
if (info->csvn == 1)
|
|
ctrset_size = 32;
|
|
else if (info->csvn == 2)
|
|
ctrset_size = 48;
|
|
else if (info->csvn >= 3 && info->csvn <= 5)
|
|
ctrset_size = 128;
|
|
else if (info->csvn == 6)
|
|
ctrset_size = 160;
|
|
break;
|
|
case CPUMF_CTR_SET_MT_DIAG:
|
|
if (info->csvn > 3)
|
|
ctrset_size = 48;
|
|
break;
|
|
case CPUMF_CTR_SET_MAX:
|
|
break;
|
|
}
|
|
|
|
return ctrset_size;
|
|
}
|
|
|
|
/* Calculate memory needed to store all counter sets together with header and
|
|
* trailer data. This is independend of the counter set authorization which
|
|
* can vary depending on the configuration.
|
|
*/
|
|
static size_t cf_diag_ctrset_maxsize(struct cpumf_ctr_info *info)
|
|
{
|
|
size_t max_size = sizeof(struct cf_trailer_entry);
|
|
enum cpumf_ctr_set i;
|
|
|
|
for (i = CPUMF_CTR_SET_BASIC; i < CPUMF_CTR_SET_MAX; ++i) {
|
|
size_t size = cf_diag_ctrset_size(i, info);
|
|
|
|
if (size)
|
|
max_size += size * sizeof(u64) +
|
|
sizeof(struct cf_ctrset_entry);
|
|
}
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s max_size %zu\n", __func__,
|
|
max_size);
|
|
|
|
return max_size;
|
|
}
|
|
|
|
/* Read a counter set. The counter set number determines which counter set and
|
|
* the CPUM-CF first and second version number determine the number of
|
|
* available counters in this counter set.
|
|
* Each counter set starts with header containing the counter set number and
|
|
* the number of 8 byte counters.
|
|
*
|
|
* The functions returns the number of bytes occupied by this counter set
|
|
* including the header.
|
|
* If there is no counter in the counter set, this counter set is useless and
|
|
* zero is returned on this case.
|
|
*/
|
|
static size_t cf_diag_getctrset(struct cf_ctrset_entry *ctrdata, int ctrset,
|
|
size_t room)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
size_t ctrset_size, need = 0;
|
|
int rc = 3; /* Assume write failure */
|
|
|
|
ctrdata->def = CF_DIAG_CTRSET_DEF;
|
|
ctrdata->set = ctrset;
|
|
ctrdata->res1 = 0;
|
|
ctrset_size = cf_diag_ctrset_size(ctrset, &cpuhw->info);
|
|
|
|
if (ctrset_size) { /* Save data */
|
|
need = ctrset_size * sizeof(u64) + sizeof(*ctrdata);
|
|
if (need <= room)
|
|
rc = ctr_stcctm(ctrset, ctrset_size,
|
|
(u64 *)(ctrdata + 1));
|
|
if (rc != 3)
|
|
ctrdata->ctr = ctrset_size;
|
|
else
|
|
need = 0;
|
|
}
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 6,
|
|
"%s ctrset %d ctrset_size %zu cfvn %d csvn %d"
|
|
" need %zd rc:%d\n",
|
|
__func__, ctrset, ctrset_size, cpuhw->info.cfvn,
|
|
cpuhw->info.csvn, need, rc);
|
|
return need;
|
|
}
|
|
|
|
/* Read out all counter sets and save them in the provided data buffer.
|
|
* The last 64 byte host an artificial trailer entry.
|
|
*/
|
|
static size_t cf_diag_getctr(void *data, size_t sz, unsigned long auth)
|
|
{
|
|
struct cf_trailer_entry *trailer;
|
|
size_t offset = 0, done;
|
|
int i;
|
|
|
|
memset(data, 0, sz);
|
|
sz -= sizeof(*trailer); /* Always room for trailer */
|
|
for (i = CPUMF_CTR_SET_BASIC; i < CPUMF_CTR_SET_MAX; ++i) {
|
|
struct cf_ctrset_entry *ctrdata = data + offset;
|
|
|
|
if (!(auth & cpumf_ctr_ctl[i]))
|
|
continue; /* Counter set not authorized */
|
|
|
|
done = cf_diag_getctrset(ctrdata, i, sz - offset);
|
|
offset += done;
|
|
debug_sprintf_event(cf_diag_dbg, 6,
|
|
"%s ctrset %d offset %zu done %zu\n",
|
|
__func__, i, offset, done);
|
|
}
|
|
trailer = data + offset;
|
|
cf_diag_trailer(trailer);
|
|
return offset + sizeof(*trailer);
|
|
}
|
|
|
|
/* Calculate the difference for each counter in a counter set. */
|
|
static void cf_diag_diffctrset(u64 *pstart, u64 *pstop, int counters)
|
|
{
|
|
for (; --counters >= 0; ++pstart, ++pstop)
|
|
if (*pstop >= *pstart)
|
|
*pstop -= *pstart;
|
|
else
|
|
*pstop = *pstart - *pstop;
|
|
}
|
|
|
|
/* Scan the counter sets and calculate the difference of each counter
|
|
* in each set. The result is the increment of each counter during the
|
|
* period the counter set has been activated.
|
|
*
|
|
* Return true on success.
|
|
*/
|
|
static int cf_diag_diffctr(struct cf_diag_csd *csd, unsigned long auth)
|
|
{
|
|
struct cf_trailer_entry *trailer_start, *trailer_stop;
|
|
struct cf_ctrset_entry *ctrstart, *ctrstop;
|
|
size_t offset = 0;
|
|
|
|
auth &= (1 << CPUMF_LCCTL_ENABLE_SHIFT) - 1;
|
|
do {
|
|
ctrstart = (struct cf_ctrset_entry *)(csd->start + offset);
|
|
ctrstop = (struct cf_ctrset_entry *)(csd->data + offset);
|
|
|
|
if (memcmp(ctrstop, ctrstart, sizeof(*ctrstop))) {
|
|
pr_err("cpum_cf_diag counter set compare error "
|
|
"in set %i\n", ctrstart->set);
|
|
return 0;
|
|
}
|
|
auth &= ~cpumf_ctr_ctl[ctrstart->set];
|
|
if (ctrstart->def == CF_DIAG_CTRSET_DEF) {
|
|
cf_diag_diffctrset((u64 *)(ctrstart + 1),
|
|
(u64 *)(ctrstop + 1), ctrstart->ctr);
|
|
offset += ctrstart->ctr * sizeof(u64) +
|
|
sizeof(*ctrstart);
|
|
}
|
|
debug_sprintf_event(cf_diag_dbg, 6,
|
|
"%s set %d ctr %d offset %zu auth %lx\n",
|
|
__func__, ctrstart->set, ctrstart->ctr,
|
|
offset, auth);
|
|
} while (ctrstart->def && auth);
|
|
|
|
/* Save time_stamp from start of event in stop's trailer */
|
|
trailer_start = (struct cf_trailer_entry *)(csd->start + offset);
|
|
trailer_stop = (struct cf_trailer_entry *)(csd->data + offset);
|
|
trailer_stop->progusage[0] = trailer_start->timestamp;
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Create perf event sample with the counter sets as raw data. The sample
|
|
* is then pushed to the event subsystem and the function checks for
|
|
* possible event overflows. If an event overflow occurs, the PMU is
|
|
* stopped.
|
|
*
|
|
* Return non-zero if an event overflow occurred.
|
|
*/
|
|
static int cf_diag_push_sample(struct perf_event *event,
|
|
struct cf_diag_csd *csd)
|
|
{
|
|
struct perf_sample_data data;
|
|
struct perf_raw_record raw;
|
|
struct pt_regs regs;
|
|
int overflow;
|
|
|
|
/* Setup perf sample */
|
|
perf_sample_data_init(&data, 0, event->hw.last_period);
|
|
memset(®s, 0, sizeof(regs));
|
|
memset(&raw, 0, sizeof(raw));
|
|
|
|
if (event->attr.sample_type & PERF_SAMPLE_CPU)
|
|
data.cpu_entry.cpu = event->cpu;
|
|
if (event->attr.sample_type & PERF_SAMPLE_RAW) {
|
|
raw.frag.size = csd->used;
|
|
raw.frag.data = csd->data;
|
|
raw.size = csd->used;
|
|
data.raw = &raw;
|
|
}
|
|
|
|
overflow = perf_event_overflow(event, &data, ®s);
|
|
debug_sprintf_event(cf_diag_dbg, 6,
|
|
"%s event %p cpu %d sample_type %#llx raw %d "
|
|
"ov %d\n", __func__, event, event->cpu,
|
|
event->attr.sample_type, raw.size, overflow);
|
|
if (overflow)
|
|
event->pmu->stop(event, 0);
|
|
|
|
perf_event_update_userpage(event);
|
|
return overflow;
|
|
}
|
|
|
|
static void cf_diag_start(struct perf_event *event, int flags)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
struct cf_diag_csd *csd = this_cpu_ptr(&cf_diag_csd);
|
|
struct hw_perf_event *hwc = &event->hw;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d flags %#x hwc-state %#x\n",
|
|
__func__, event, event->cpu, flags, hwc->state);
|
|
if (WARN_ON_ONCE(!(hwc->state & PERF_HES_STOPPED)))
|
|
return;
|
|
|
|
/* (Re-)enable and activate all counter sets */
|
|
lcctl(0); /* Reset counter sets */
|
|
hwc->state = 0;
|
|
ctr_set_multiple_enable(&cpuhw->state, hwc->config_base);
|
|
lcctl(cpuhw->state); /* Enable counter sets */
|
|
csd->used = cf_diag_getctr(csd->start, sizeof(csd->start),
|
|
event->hw.config_base);
|
|
ctr_set_multiple_start(&cpuhw->state, hwc->config_base);
|
|
/* Function cf_diag_enable() starts the counter sets. */
|
|
}
|
|
|
|
static void cf_diag_stop(struct perf_event *event, int flags)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
struct cf_diag_csd *csd = this_cpu_ptr(&cf_diag_csd);
|
|
struct hw_perf_event *hwc = &event->hw;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d flags %#x hwc-state %#x\n",
|
|
__func__, event, event->cpu, flags, hwc->state);
|
|
|
|
/* Deactivate all counter sets */
|
|
ctr_set_multiple_stop(&cpuhw->state, hwc->config_base);
|
|
local64_inc(&event->count);
|
|
csd->used = cf_diag_getctr(csd->data, sizeof(csd->data),
|
|
event->hw.config_base);
|
|
if (cf_diag_diffctr(csd, event->hw.config_base))
|
|
cf_diag_push_sample(event, csd);
|
|
hwc->state |= PERF_HES_STOPPED;
|
|
}
|
|
|
|
static int cf_diag_add(struct perf_event *event, int flags)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
int err = 0;
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d flags %#x cpuhw:%p\n",
|
|
__func__, event, event->cpu, flags, cpuhw);
|
|
|
|
if (cpuhw->flags & PMU_F_IN_USE) {
|
|
err = -EAGAIN;
|
|
goto out;
|
|
}
|
|
|
|
event->hw.state = PERF_HES_UPTODATE | PERF_HES_STOPPED;
|
|
|
|
cpuhw->flags |= PMU_F_IN_USE;
|
|
if (flags & PERF_EF_START)
|
|
cf_diag_start(event, PERF_EF_RELOAD);
|
|
out:
|
|
debug_sprintf_event(cf_diag_dbg, 5, "%s err %d\n", __func__, err);
|
|
return err;
|
|
}
|
|
|
|
static void cf_diag_del(struct perf_event *event, int flags)
|
|
{
|
|
struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
|
|
|
|
debug_sprintf_event(cf_diag_dbg, 5,
|
|
"%s event %p cpu %d flags %#x\n",
|
|
__func__, event, event->cpu, flags);
|
|
|
|
cf_diag_stop(event, PERF_EF_UPDATE);
|
|
ctr_set_multiple_stop(&cpuhw->state, event->hw.config_base);
|
|
ctr_set_multiple_disable(&cpuhw->state, event->hw.config_base);
|
|
cpuhw->flags &= ~PMU_F_IN_USE;
|
|
}
|
|
|
|
CPUMF_EVENT_ATTR(CF_DIAG, CF_DIAG, PERF_EVENT_CPUM_CF_DIAG);
|
|
|
|
static struct attribute *cf_diag_events_attr[] = {
|
|
CPUMF_EVENT_PTR(CF_DIAG, CF_DIAG),
|
|
NULL,
|
|
};
|
|
|
|
PMU_FORMAT_ATTR(event, "config:0-63");
|
|
|
|
static struct attribute *cf_diag_format_attr[] = {
|
|
&format_attr_event.attr,
|
|
NULL,
|
|
};
|
|
|
|
static struct attribute_group cf_diag_events_group = {
|
|
.name = "events",
|
|
.attrs = cf_diag_events_attr,
|
|
};
|
|
static struct attribute_group cf_diag_format_group = {
|
|
.name = "format",
|
|
.attrs = cf_diag_format_attr,
|
|
};
|
|
static const struct attribute_group *cf_diag_attr_groups[] = {
|
|
&cf_diag_events_group,
|
|
&cf_diag_format_group,
|
|
NULL,
|
|
};
|
|
|
|
/* Performance monitoring unit for s390x */
|
|
static struct pmu cf_diag = {
|
|
.task_ctx_nr = perf_sw_context,
|
|
.pmu_enable = cf_diag_enable,
|
|
.pmu_disable = cf_diag_disable,
|
|
.event_init = cf_diag_event_init,
|
|
.add = cf_diag_add,
|
|
.del = cf_diag_del,
|
|
.start = cf_diag_start,
|
|
.stop = cf_diag_stop,
|
|
.read = cf_diag_read,
|
|
|
|
.attr_groups = cf_diag_attr_groups
|
|
};
|
|
|
|
/* Get the CPU speed, try sampling facility first and CPU attributes second. */
|
|
static void cf_diag_get_cpu_speed(void)
|
|
{
|
|
if (cpum_sf_avail()) { /* Sampling facility first */
|
|
struct hws_qsi_info_block si;
|
|
|
|
memset(&si, 0, sizeof(si));
|
|
if (!qsi(&si)) {
|
|
cf_diag_cpu_speed = si.cpu_speed;
|
|
return;
|
|
}
|
|
}
|
|
|
|
if (test_facility(34)) { /* CPU speed extract static part */
|
|
unsigned long mhz = __ecag(ECAG_CPU_ATTRIBUTE, 0);
|
|
|
|
if (mhz != -1UL)
|
|
cf_diag_cpu_speed = mhz & 0xffffffff;
|
|
}
|
|
}
|
|
|
|
/* Initialize the counter set PMU to generate complete counter set data as
|
|
* event raw data. This relies on the CPU Measurement Counter Facility device
|
|
* already being loaded and initialized.
|
|
*/
|
|
static int __init cf_diag_init(void)
|
|
{
|
|
struct cpumf_ctr_info info;
|
|
size_t need;
|
|
int rc;
|
|
|
|
if (!kernel_cpumcf_avail() || !stccm_avail() || qctri(&info))
|
|
return -ENODEV;
|
|
cf_diag_get_cpu_speed();
|
|
|
|
/* Make sure the counter set data fits into predefined buffer. */
|
|
need = cf_diag_ctrset_maxsize(&info);
|
|
if (need > sizeof(((struct cf_diag_csd *)0)->start)) {
|
|
pr_err("Insufficient memory for PMU(cpum_cf_diag) need=%zu\n",
|
|
need);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Setup s390dbf facility */
|
|
cf_diag_dbg = debug_register(KMSG_COMPONENT, 2, 1, 128);
|
|
if (!cf_diag_dbg) {
|
|
pr_err("Registration of s390dbf(cpum_cf_diag) failed\n");
|
|
return -ENOMEM;
|
|
}
|
|
debug_register_view(cf_diag_dbg, &debug_sprintf_view);
|
|
|
|
rc = perf_pmu_register(&cf_diag, "cpum_cf_diag", PERF_TYPE_RAW);
|
|
if (rc) {
|
|
debug_unregister_view(cf_diag_dbg, &debug_sprintf_view);
|
|
debug_unregister(cf_diag_dbg);
|
|
pr_err("Registration of PMU(cpum_cf_diag) failed with rc=%i\n",
|
|
rc);
|
|
}
|
|
return rc;
|
|
}
|
|
arch_initcall(cf_diag_init);
|