perf: hisi: Add support for HiSilicon SoC L3T PMU driver

ascend inclusion
category: feature
bugzilla: https://gitee.com/openeuler/kernel/issues/I4D4WR
CVE: NA

---------------------------

This patch adds support for L3T PMU driver in HiSilicon SoC chip, Each
L3T has own control, counter and interrupt registers and is an separate
PMU. For each L3T PMU, it has 8-programable counters and each counter
is free-running.
Signed-off-by: NFang Lijun <fanglijun3@huawei.com>
Reviewed-by: NHanjun Guo <guohanjun@huawei.com>
Signed-off-by: NYang Yingliang <yangyingliang@huawei.com>

drivers/perf/hisilicon/Makefile

-obj-$(CONFIG_HISI_PMU) += hisi_uncore_pmu.o hisi_uncore_l3c_pmu.o hisi_uncore_hha_pmu.o hisi_uncore_ddrc_pmu.o hisi_uncore_lpddrc_pmu.o
+obj-$(CONFIG_HISI_PMU) += hisi_uncore_pmu.o hisi_uncore_l3c_pmu.o hisi_uncore_hha_pmu.o hisi_uncore_ddrc_pmu.o hisi_uncore_lpddrc_pmu.o hisi_uncore_l3t_pmu.o

drivers/perf/hisilicon/hisi_uncore_l3t_pmu.c

+// SPDX-License-Identifier: GPL-2.0
+/*
+ * HiSilicon SoC L3T uncore Hardware event counters support
+ *
+ * Copyright (C) 2021 Hisilicon Limited
+ * Author: Fang Lijun <fanglijun3@huawei.com>
+ *         Anurup M <anurup.m@huawei.com>
+ *         Shaokun Zhang <zhangshaokun@hisilicon.com>
+ *
+ * This code is based on the uncore PMUs like arm-cci and arm-ccn.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+#include <linux/acpi.h>
+#include <linux/bug.h>
+#include <linux/cpuhotplug.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/list.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/smp.h>
+
+#include "hisi_uncore_pmu.h"
+
+/* L3T register definition */
+#define L3T_PERF_CTRL		0x0408
+#define L3T_INT_MASK		0x0800
+#define L3T_INT_STATUS		0x0808
+#define L3T_INT_CLEAR		0x080c
+#define L3T_EVENT_CTRL	        0x1c00
+#define L3T_EVENT_TYPE0		0x1d00
+/*
+ * Each counter is 48-bits and [48:63] are reserved
+ * which are Read-As-Zero and Writes-Ignored.
+ */
+#define L3T_CNTR0_LOWER		0x1e00
+
+/* L3T has 8-counters */
+#define L3T_NR_COUNTERS		0x8
+
+#define L3T_PERF_CTRL_EN	0x20000
+#define L3T_EVTYPE_NONE		0xff
+
+/*
+ * Select the counter register offset using the counter index
+ */
+static u32 hisi_l3t_pmu_get_counter_offset(u32 cntr_idx)
+{
+	return (L3T_CNTR0_LOWER + (cntr_idx * 8));
+}
+
+static u64 hisi_l3t_pmu_read_counter(struct hisi_pmu *l3t_pmu,
+				     struct hw_perf_event *hwc)
+{
+	u32 idx = hwc->idx;
+
+	if (!hisi_uncore_pmu_counter_valid(l3t_pmu, idx)) {
+		dev_err(l3t_pmu->dev, "Unsupported event index:%d!\n", idx);
+		return 0;
+	}
+
+	/* Read 64-bits and the upper 16 bits are RAZ */
+	return readq(l3t_pmu->base + hisi_l3t_pmu_get_counter_offset(idx));
+}
+
+static void hisi_l3t_pmu_write_counter(struct hisi_pmu *l3t_pmu,
+				       struct hw_perf_event *hwc, u64 val)
+{
+	u32 idx = hwc->idx;
+
+	if (!hisi_uncore_pmu_counter_valid(l3t_pmu, idx)) {
+		dev_err(l3t_pmu->dev, "Unsupported event index:%d!\n", idx);
+		return;
+	}
+
+	/* Write 64-bits and the upper 16 bits are WI */
+	writeq(val, l3t_pmu->base + hisi_l3t_pmu_get_counter_offset(idx));
+}
+
+static void hisi_l3t_pmu_write_evtype(struct hisi_pmu *l3t_pmu, int idx,
+				      u32 type)
+{
+	u32 reg, reg_idx, shift, val;
+
+	/*
+	 * Select the appropriate event select register(L3T_EVENT_TYPE0/1).
+	 * There are 2 event select registers for the 8 hardware counters.
+	 * Event code is 8-bits and for the former 4 hardware counters,
+	 * L3T_EVENT_TYPE0 is chosen. For the latter 4 hardware counters,
+	 * L3T_EVENT_TYPE1 is chosen.
+	 */
+	reg = L3T_EVENT_TYPE0 + (idx / 4) * 4;
+	reg_idx = idx % 4;
+	shift = 8 * reg_idx;
+
+	/* Write event code to L3T_EVENT_TYPEx Register */
+	val = readl(l3t_pmu->base + reg);
+	val &= ~(L3T_EVTYPE_NONE << shift);
+	val |= (type << shift);
+	writel(val, l3t_pmu->base + reg);
+}
+
+static void hisi_l3t_pmu_start_counters(struct hisi_pmu *l3t_pmu)
+{
+	u32 val;
+
+	/*
+	 * Set perf_enable bit in L3T_PERF_CTRL register to start counting
+	 * for all enabled counters.
+	 */
+	val = readl(l3t_pmu->base + L3T_PERF_CTRL);
+	val |= L3T_PERF_CTRL_EN;
+	writel(val, l3t_pmu->base + L3T_PERF_CTRL);
+}
+
+static void hisi_l3t_pmu_stop_counters(struct hisi_pmu *l3t_pmu)
+{
+	u32 val;
+
+	/*
+	 * Clear perf_enable bit in L3T_PERF_CTRL register to stop counting
+	 * for all enabled counters.
+	 */
+	val = readl(l3t_pmu->base + L3T_PERF_CTRL);
+	val &= ~(L3T_PERF_CTRL_EN);
+	writel(val, l3t_pmu->base + L3T_PERF_CTRL);
+}
+
+static void hisi_l3t_pmu_enable_counter(struct hisi_pmu *l3t_pmu,
+					struct hw_perf_event *hwc)
+{
+	u32 val;
+
+	/* Enable counter index in L3T_EVENT_CTRL register */
+	val = readl(l3t_pmu->base + L3T_EVENT_CTRL);
+	val |= (1 << hwc->idx);
+	writel(val, l3t_pmu->base + L3T_EVENT_CTRL);
+}
+
+static void hisi_l3t_pmu_disable_counter(struct hisi_pmu *l3t_pmu,
+					 struct hw_perf_event *hwc)
+{
+	u32 val;
+
+	/* Clear counter index in L3T_EVENT_CTRL register */
+	val = readl(l3t_pmu->base + L3T_EVENT_CTRL);
+	val &= ~(1 << hwc->idx);
+	writel(val, l3t_pmu->base + L3T_EVENT_CTRL);
+}
+
+static void hisi_l3t_pmu_enable_counter_int(struct hisi_pmu *l3t_pmu,
+					    struct hw_perf_event *hwc)
+{
+	u32 val;
+
+	val = readl(l3t_pmu->base + L3T_INT_MASK);
+	/* Write 0 to enable interrupt */
+	val &= ~(1 << hwc->idx);
+	writel(val, l3t_pmu->base + L3T_INT_MASK);
+}
+
+static void hisi_l3t_pmu_disable_counter_int(struct hisi_pmu *l3t_pmu,
+					     struct hw_perf_event *hwc)
+{
+	u32 val;
+
+	val = readl(l3t_pmu->base + L3T_INT_MASK);
+	/* Write 1 to mask interrupt */
+	val |= (1 << hwc->idx);
+	writel(val, l3t_pmu->base + L3T_INT_MASK);
+}
+
+static irqreturn_t hisi_l3t_pmu_isr(int irq, void *dev_id)
+{
+	struct hisi_pmu *l3t_pmu = dev_id;
+	struct perf_event *event;
+	unsigned long overflown;
+	int idx;
+
+	/* Read L3T_INT_STATUS register */
+	overflown = readl(l3t_pmu->base + L3T_INT_STATUS);
+	if (!overflown)
+		return IRQ_NONE;
+
+	/*
+	 * Find the counter index which overflowed if the bit was set
+	 * and handle it.
+	 */
+	for_each_set_bit(idx, &overflown, L3T_NR_COUNTERS) {
+		/* Write 1 to clear the IRQ status flag */
+		writel((1 << idx), l3t_pmu->base + L3T_INT_CLEAR);
+
+		/* Get the corresponding event struct */
+		event = l3t_pmu->pmu_events.hw_events[idx];
+		if (!event)
+			continue;
+
+		hisi_uncore_pmu_event_update(event);
+		hisi_uncore_pmu_set_event_period(event);
+	}
+
+	return IRQ_HANDLED;
+}
+
+static int hisi_l3t_pmu_init_irq(struct hisi_pmu *l3t_pmu,
+				 struct platform_device *pdev)
+{
+	int irq, ret;
+
+	/* Read and init IRQ */
+	irq = platform_get_irq(pdev, 0);
+	if (irq < 0) {
+		dev_err(&pdev->dev, "L3T PMU get irq fail; irq:%d\n", irq);
+		return irq;
+	}
+
+	ret = devm_request_irq(&pdev->dev, irq, hisi_l3t_pmu_isr,
+			       IRQF_NOBALANCING | IRQF_NO_THREAD | IRQF_SHARED,
+			       dev_name(&pdev->dev), l3t_pmu);
+	if (ret < 0) {
+		dev_err(&pdev->dev,
+			"Fail to request IRQ:%d ret:%d\n", irq, ret);
+		return ret;
+	}
+
+	l3t_pmu->irq = irq;
+
+	return 0;
+}
+
+static const struct of_device_id l3t_of_match[] = {
+	{ .compatible = "hisilicon,l3t-pmu", },
+	{},
+};
+MODULE_DEVICE_TABLE(of, l3t_of_match);
+
+static int hisi_l3t_pmu_init_data(struct platform_device *pdev,
+				  struct hisi_pmu *l3t_pmu)
+{
+	struct resource *res;
+
+	/*
+	 * Use the SCCL_ID and CCL_ID to identify the L3T PMU, while
+	 * SCCL_ID is in MPIDR[aff2] and CCL_ID is in MPIDR[aff1].
+	 */
+	if (device_property_read_u32(&pdev->dev, "hisilicon,scl-id",
+				     &l3t_pmu->sccl_id)) {
+		dev_err(&pdev->dev, "Can not read l3t sccl-id!\n");
+		return -EINVAL;
+	}
+
+	if (device_property_read_u32(&pdev->dev, "hisilicon,ccl-id",
+				     &l3t_pmu->ccl_id)) {
+		dev_err(&pdev->dev, "Can not read l3t ccl-id!\n");
+		return -EINVAL;
+	}
+
+	if (device_property_read_u32(&pdev->dev, "hisilicon,index-id",
+			     &l3t_pmu->index_id)) {
+		dev_err(&pdev->dev, "Can not read l3t index-id!\n");
+		return -EINVAL;
+	}
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	l3t_pmu->base = devm_ioremap_resource(&pdev->dev, res);
+	if (IS_ERR(l3t_pmu->base)) {
+		dev_err(&pdev->dev, "ioremap failed for l3t_pmu resource\n");
+		return PTR_ERR(l3t_pmu->base);
+	}
+
+	return 0;
+}
+
+static struct attribute *hisi_l3t_pmu_format_attr[] = {
+	HISI_PMU_FORMAT_ATTR(event, "config:0-7"),
+	NULL,
+};
+
+static const struct attribute_group hisi_l3t_pmu_format_group = {
+	.name = "format",
+	.attrs = hisi_l3t_pmu_format_attr,
+};
+
+static struct attribute *hisi_l3t_pmu_events_attr[] = {
+	HISI_PMU_EVENT_ATTR(rd_cpipe,		0x00),
+	HISI_PMU_EVENT_ATTR(wr_cpipe,		0x01),
+	HISI_PMU_EVENT_ATTR(rd_hit_cpipe,	0x02),
+	HISI_PMU_EVENT_ATTR(wr_hit_cpipe,	0x03),
+	HISI_PMU_EVENT_ATTR(victim_num,		0x04),
+	HISI_PMU_EVENT_ATTR(rd_spipe,		0x20),
+	HISI_PMU_EVENT_ATTR(wr_spipe,		0x21),
+	HISI_PMU_EVENT_ATTR(rd_hit_spipe,	0x22),
+	HISI_PMU_EVENT_ATTR(wr_hit_spipe,	0x23),
+	HISI_PMU_EVENT_ATTR(back_invalid,	0x29),
+	HISI_PMU_EVENT_ATTR(retry_cpu,		0x40),
+	HISI_PMU_EVENT_ATTR(retry_ring,		0x41),
+	HISI_PMU_EVENT_ATTR(prefetch_drop,	0x42),
+	NULL,
+};
+
+static const struct attribute_group hisi_l3t_pmu_events_group = {
+	.name = "events",
+	.attrs = hisi_l3t_pmu_events_attr,
+};
+
+static DEVICE_ATTR(cpumask, 0444, hisi_cpumask_sysfs_show, NULL);
+
+static struct attribute *hisi_l3t_pmu_cpumask_attrs[] = {
+	&dev_attr_cpumask.attr,
+	NULL,
+};
+
+static const struct attribute_group hisi_l3t_pmu_cpumask_attr_group = {
+	.attrs = hisi_l3t_pmu_cpumask_attrs,
+};
+
+static const struct attribute_group *hisi_l3t_pmu_attr_groups[] = {
+	&hisi_l3t_pmu_format_group,
+	&hisi_l3t_pmu_events_group,
+	&hisi_l3t_pmu_cpumask_attr_group,
+	NULL,
+};
+
+static const struct hisi_uncore_ops hisi_uncore_l3t_ops = {
+	.write_evtype		= hisi_l3t_pmu_write_evtype,
+	.get_event_idx		= hisi_uncore_pmu_get_event_idx,
+	.start_counters		= hisi_l3t_pmu_start_counters,
+	.stop_counters		= hisi_l3t_pmu_stop_counters,
+	.enable_counter		= hisi_l3t_pmu_enable_counter,
+	.disable_counter	= hisi_l3t_pmu_disable_counter,
+	.enable_counter_int	= hisi_l3t_pmu_enable_counter_int,
+	.disable_counter_int	= hisi_l3t_pmu_disable_counter_int,
+	.write_counter		= hisi_l3t_pmu_write_counter,
+	.read_counter		= hisi_l3t_pmu_read_counter,
+};
+
+static int hisi_l3t_pmu_dev_probe(struct platform_device *pdev,
+				  struct hisi_pmu *l3t_pmu)
+{
+	int ret;
+
+	ret = hisi_l3t_pmu_init_data(pdev, l3t_pmu);
+	if (ret)
+		return ret;
+
+	ret = hisi_l3t_pmu_init_irq(l3t_pmu, pdev);
+	if (ret)
+		return ret;
+
+	l3t_pmu->num_counters = L3T_NR_COUNTERS;
+	l3t_pmu->counter_bits = 48;
+	l3t_pmu->ops = &hisi_uncore_l3t_ops;
+	l3t_pmu->dev = &pdev->dev;
+	l3t_pmu->on_cpu = -1;
+	l3t_pmu->check_event = 0x59;
+
+	return 0;
+}
+
+static int hisi_l3t_pmu_probe(struct platform_device *pdev)
+{
+	struct hisi_pmu *l3t_pmu;
+	char *name;
+	int ret;
+
+	l3t_pmu = devm_kzalloc(&pdev->dev, sizeof(*l3t_pmu), GFP_KERNEL);
+	if (!l3t_pmu)
+		return -ENOMEM;
+
+	platform_set_drvdata(pdev, l3t_pmu);
+
+	ret = hisi_l3t_pmu_dev_probe(pdev, l3t_pmu);
+	if (ret)
+		return ret;
+
+	name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "hisi_sccl%u_l3t%u",
+			      l3t_pmu->sccl_id, l3t_pmu->index_id);
+	HISI_INIT_PMU(&l3t_pmu->pmu, name, hisi_l3t_pmu_attr_groups);
+
+	ret = perf_pmu_register(&l3t_pmu->pmu, name, -1);
+	if (ret) {
+		dev_err(l3t_pmu->dev, "L3T PMU register failed!\n");
+		return ret;
+	}
+
+	/* Pick one core to use for cpumask attributes */
+	cpumask_set_cpu(smp_processor_id(), &l3t_pmu->associated_cpus);
+
+	l3t_pmu->on_cpu = cpumask_first(&l3t_pmu->associated_cpus);
+	if (l3t_pmu->on_cpu >= nr_cpu_ids)
+		return -EINVAL;
+
+	return 0;
+}
+
+static int hisi_l3t_pmu_remove(struct platform_device *pdev)
+{
+	struct hisi_pmu *l3t_pmu = platform_get_drvdata(pdev);
+
+	perf_pmu_unregister(&l3t_pmu->pmu);
+
+	return 0;
+}
+
+static struct platform_driver hisi_l3t_pmu_driver = {
+	.driver = {
+		.name = "hisi_l3t_pmu",
+		.of_match_table = of_match_ptr(l3t_of_match),
+	},
+	.probe = hisi_l3t_pmu_probe,
+	.remove = hisi_l3t_pmu_remove,
+};
+
+static int __init hisi_l3t_pmu_module_init(void)
+{
+	return platform_driver_register(&hisi_l3t_pmu_driver);
+}
+module_init(hisi_l3t_pmu_module_init);
+
+static void __exit hisi_l3t_pmu_module_exit(void)
+{
+	platform_driver_unregister(&hisi_l3t_pmu_driver);
+}
+module_exit(hisi_l3t_pmu_module_exit);
+
+MODULE_DESCRIPTION("HiSilicon SoC L3T uncore PMU driver");
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("HUAWEI TECHNOLOGIES CO., LTD.");
+MODULE_AUTHOR("Fang Lijun <fanglijun3@huawei.com>");