1
2
3
4
5
6
7
8
9
10
11#include <linux/mod_devicetable.h>
12#include <linux/perf/riscv_pmu.h>
13#include <linux/platform_device.h>
14
15#define RISCV_PMU_LEGACY_CYCLE 0
16#define RISCV_PMU_LEGACY_INSTRET 1
17#define RISCV_PMU_LEGACY_NUM_CTR 2
18
19static bool pmu_init_done;
20
21static int pmu_legacy_ctr_get_idx(struct perf_event *event)
22{
23 struct perf_event_attr *attr = &event->attr;
24
25 if (event->attr.type != PERF_TYPE_HARDWARE)
26 return -EOPNOTSUPP;
27 if (attr->config == PERF_COUNT_HW_CPU_CYCLES)
28 return RISCV_PMU_LEGACY_CYCLE;
29 else if (attr->config == PERF_COUNT_HW_INSTRUCTIONS)
30 return RISCV_PMU_LEGACY_INSTRET;
31 else
32 return -EOPNOTSUPP;
33}
34
35
36static int pmu_legacy_event_map(struct perf_event *event, u64 *config)
37{
38 return pmu_legacy_ctr_get_idx(event);
39}
40
41static u64 pmu_legacy_read_ctr(struct perf_event *event)
42{
43 struct hw_perf_event *hwc = &event->hw;
44 int idx = hwc->idx;
45 u64 val;
46
47 if (idx == RISCV_PMU_LEGACY_CYCLE) {
48 val = riscv_pmu_ctr_read_csr(CSR_CYCLE);
49 if (IS_ENABLED(CONFIG_32BIT))
50 val = (u64)riscv_pmu_ctr_read_csr(CSR_CYCLEH) << 32 | val;
51 } else if (idx == RISCV_PMU_LEGACY_INSTRET) {
52 val = riscv_pmu_ctr_read_csr(CSR_INSTRET);
53 if (IS_ENABLED(CONFIG_32BIT))
54 val = ((u64)riscv_pmu_ctr_read_csr(CSR_INSTRETH)) << 32 | val;
55 } else
56 return 0;
57
58 return val;
59}
60
61static void pmu_legacy_ctr_start(struct perf_event *event, u64 ival)
62{
63 struct hw_perf_event *hwc = &event->hw;
64 u64 initial_val = pmu_legacy_read_ctr(event);
65
66
67
68
69
70
71
72 local64_set(&hwc->prev_count, initial_val);
73}
74
75
76
77
78
79
80
81
82static void pmu_legacy_init(struct riscv_pmu *pmu)
83{
84 pr_info("Legacy PMU implementation is available\n");
85
86 pmu->num_counters = RISCV_PMU_LEGACY_NUM_CTR;
87 pmu->ctr_start = pmu_legacy_ctr_start;
88 pmu->ctr_stop = NULL;
89 pmu->event_map = pmu_legacy_event_map;
90 pmu->ctr_get_idx = pmu_legacy_ctr_get_idx;
91 pmu->ctr_get_width = NULL;
92 pmu->ctr_clear_idx = NULL;
93 pmu->ctr_read = pmu_legacy_read_ctr;
94
95 perf_pmu_register(&pmu->pmu, "cpu", PERF_TYPE_RAW);
96}
97
98static int pmu_legacy_device_probe(struct platform_device *pdev)
99{
100 struct riscv_pmu *pmu = NULL;
101
102 pmu = riscv_pmu_alloc();
103 if (!pmu)
104 return -ENOMEM;
105 pmu_legacy_init(pmu);
106
107 return 0;
108}
109
110static struct platform_driver pmu_legacy_driver = {
111 .probe = pmu_legacy_device_probe,
112 .driver = {
113 .name = RISCV_PMU_LEGACY_PDEV_NAME,
114 },
115};
116
117static int __init riscv_pmu_legacy_devinit(void)
118{
119 int ret;
120 struct platform_device *pdev;
121
122 if (likely(pmu_init_done))
123 return 0;
124
125 ret = platform_driver_register(&pmu_legacy_driver);
126 if (ret)
127 return ret;
128
129 pdev = platform_device_register_simple(RISCV_PMU_LEGACY_PDEV_NAME, -1, NULL, 0);
130 if (IS_ERR(pdev)) {
131 platform_driver_unregister(&pmu_legacy_driver);
132 return PTR_ERR(pdev);
133 }
134
135 return ret;
136}
137late_initcall(riscv_pmu_legacy_devinit);
138
139void riscv_pmu_legacy_skip_init(void)
140{
141 pmu_init_done = true;
142}
143