forked from Mirrors/opensbi
a2c172f526
This reduces .bss size by 8 KiB, and should reduce overall memory usage since most platforms will have significantly fewer than 512 entries in this table. At the same time, it removes the fixed table size limit. Since the table is only used within fdt_pmu.c, instead of updating the extern declaration, make the table local to this file. Signed-off-by: Samuel Holland <samuel.holland@sifive.com> Reviewed-by: Anup Patel <anup@brainfault.org>
130 lines
3.3 KiB
C
130 lines
3.3 KiB
C
// SPDX-License-Identifier: BSD-2-Clause
|
|
/*
|
|
* fdt_pmu.c - Flat Device Tree PMU helper routines
|
|
*
|
|
* Copyright (c) 2021 Western Digital Corporation or its affiliates.
|
|
*
|
|
* Authors:
|
|
* Atish Patra <atish.patra@wdc.com>
|
|
*/
|
|
|
|
#include <libfdt.h>
|
|
#include <sbi/sbi_hart.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_heap.h>
|
|
#include <sbi/sbi_pmu.h>
|
|
#include <sbi/sbi_scratch.h>
|
|
#include <sbi_utils/fdt/fdt_helper.h>
|
|
#include <sbi_utils/fdt/fdt_pmu.h>
|
|
|
|
static struct fdt_pmu_hw_event_select_map *fdt_pmu_evt_select;
|
|
static uint32_t hw_event_count;
|
|
|
|
uint64_t fdt_pmu_get_select_value(uint32_t event_idx)
|
|
{
|
|
int i;
|
|
struct fdt_pmu_hw_event_select_map *event;
|
|
|
|
for (i = 0; i < hw_event_count; i++) {
|
|
event = &fdt_pmu_evt_select[i];
|
|
if (event->eidx == event_idx)
|
|
return event->select;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int fdt_pmu_fixup(void *fdt)
|
|
{
|
|
int pmu_offset;
|
|
struct sbi_scratch *scratch = sbi_scratch_thishart_ptr();
|
|
|
|
if (!fdt)
|
|
return SBI_EINVAL;
|
|
|
|
pmu_offset = fdt_node_offset_by_compatible(fdt, -1, "riscv,pmu");
|
|
if (pmu_offset < 0)
|
|
return SBI_EFAIL;
|
|
|
|
fdt_delprop(fdt, pmu_offset, "riscv,event-to-mhpmcounters");
|
|
fdt_delprop(fdt, pmu_offset, "riscv,event-to-mhpmevent");
|
|
fdt_delprop(fdt, pmu_offset, "riscv,raw-event-to-mhpmcounters");
|
|
if (!sbi_hart_has_extension(scratch, SBI_HART_EXT_SSCOFPMF))
|
|
fdt_delprop(fdt, pmu_offset, "interrupts-extended");
|
|
|
|
return 0;
|
|
}
|
|
|
|
int fdt_pmu_setup(const void *fdt)
|
|
{
|
|
int i, pmu_offset, len, result;
|
|
const u32 *event_val;
|
|
const u32 *event_ctr_map;
|
|
struct fdt_pmu_hw_event_select_map *event;
|
|
uint64_t raw_selector, select_mask;
|
|
u32 event_idx_start, event_idx_end, ctr_map;
|
|
|
|
if (!fdt)
|
|
return SBI_EINVAL;
|
|
|
|
pmu_offset = fdt_node_offset_by_compatible(fdt, -1, "riscv,pmu");
|
|
if (pmu_offset < 0)
|
|
return SBI_ENOENT;
|
|
|
|
event_ctr_map = fdt_getprop(fdt, pmu_offset,
|
|
"riscv,event-to-mhpmcounters", &len);
|
|
if (event_ctr_map) {
|
|
len = len / (sizeof(u32) * 3);
|
|
for (i = 0; i < len; i++) {
|
|
event_idx_start = fdt32_to_cpu(event_ctr_map[3 * i]);
|
|
event_idx_end = fdt32_to_cpu(event_ctr_map[3 * i + 1]);
|
|
ctr_map = fdt32_to_cpu(event_ctr_map[3 * i + 2]);
|
|
result = sbi_pmu_add_hw_event_counter_map(
|
|
event_idx_start, event_idx_end, ctr_map);
|
|
if (result)
|
|
return result;
|
|
}
|
|
}
|
|
|
|
event_val = fdt_getprop(fdt, pmu_offset,
|
|
"riscv,event-to-mhpmevent", &len);
|
|
if (event_val) {
|
|
len = len / (sizeof(u32) * 3);
|
|
|
|
hw_event_count = len;
|
|
fdt_pmu_evt_select = sbi_calloc(hw_event_count,
|
|
sizeof(*fdt_pmu_evt_select));
|
|
if (!fdt_pmu_evt_select)
|
|
return SBI_ENOMEM;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
event = &fdt_pmu_evt_select[i];
|
|
event->eidx = fdt32_to_cpu(event_val[3 * i]);
|
|
event->select = fdt32_to_cpu(event_val[3 * i + 1]);
|
|
event->select = (event->select << 32) |
|
|
fdt32_to_cpu(event_val[3 * i + 2]);
|
|
}
|
|
}
|
|
|
|
event_val = fdt_getprop(fdt, pmu_offset,
|
|
"riscv,raw-event-to-mhpmcounters", &len);
|
|
if (event_val) {
|
|
len = len / (sizeof(u32) * 5);
|
|
for (i = 0; i < len; i++) {
|
|
raw_selector = fdt32_to_cpu(event_val[5 * i]);
|
|
raw_selector = (raw_selector << 32) |
|
|
fdt32_to_cpu(event_val[5 * i + 1]);
|
|
select_mask = fdt32_to_cpu(event_val[5 * i + 2]);
|
|
select_mask = (select_mask << 32) |
|
|
fdt32_to_cpu(event_val[5 * i + 3]);
|
|
ctr_map = fdt32_to_cpu(event_val[5 * i + 4]);
|
|
result = sbi_pmu_add_raw_event_counter_map(
|
|
raw_selector, select_mask, ctr_map);
|
|
if (result)
|
|
return result;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|