platform: xuantie: Add xuantie link pmu support

Signed-off-by: Chen Pei <cp0613@linux.alibaba.com>

Author: cp0613

platform/generic/include/xuantie/xuantie_link.h

@@ -0,0 +1,38 @@
+/*
+ * SPDX-License-Identifier: BSD-2-Clause
+ */
+
+#ifndef __RISCV_XUANTIE_LINK_H__
+#define __RISCV_XUANTIE_LINK_H__
+
+/* HPCP reg */
+#define XUANTIE_LINK_PMU_L3IMP				0x048
+#define XUANTIE_LINK_PMU_L3MAUTHCR			0x200
+#define XUANTIE_LINK_PMU_HPCPCOUNT0			0x500
+#define XUANTIE_LINK_PMU_HPCPCOUNT1			0x508
+#define XUANTIE_LINK_PMU_HPCPCOUNT2			0x510
+#define XUANTIE_LINK_PMU_HPCPCOUNT3			0x518
+#define XUANTIE_LINK_PMU_HPCPCOUNT4			0x520
+#define XUANTIE_LINK_PMU_HPCPCOUNT5			0x528
+#define XUANTIE_LINK_PMU_HPCPEVT0CR			0x540
+#define XUANTIE_LINK_PMU_HPCPEVT1CR			0x548
+#define XUANTIE_LINK_PMU_HPCPEVT2CR			0x550
+#define XUANTIE_LINK_PMU_HPCPEVT3CR			0x558
+#define XUANTIE_LINK_PMU_HPCPEVT4CR			0x560
+#define XUANTIE_LINK_PMU_HPCPEVT5CR			0x568
+#define XUANTIE_LINK_PMU_HPCPCNTOF			0x5c0
+#define XUANTIE_LINK_PMU_HPCPMAUTHCR		0x5c8
+#define XUANTIE_LINK_PMU_HPCPHAUTHCR		0x5d0 // XL300
+#define XUANTIE_LINK_PMU_HPCPSAUTHCR		0x5d8
+#define XUANTIE_LINK_PMU_HPCPINHIBIT		0x5e0
+#define XUANTIE_LINK_PMU_HPCPINTPEND		0x5e8
+#define XUANTIE_LINK_PMU_VENDOR_N_IMP_ID	0x600 // XL300
+
+/* HPCP dev type */
+#define XUANTIE_LINK_DEV_TYPE_XL100 100
+#define XUANTIE_LINK_DEV_TYPE_XL200 200
+#define XUANTIE_LINK_DEV_TYPE_XL300 300
+
+int xuantie_link_pmu_device_init(void);
+
+#endif // __RISCV_XUANTIE_LINK_H__

platform/generic/include/xuantie/xuantie_quirk.h

@@ -5,7 +5,8 @@
 #ifndef __RISCV_XUANTIE_QUIRK_H__
 #define __RISCV_XUANTIE_QUIRK_H__
 
-#define QUIRK_XUANTIE_PMC BIT(0)
+#define QUIRK_XUANTIE_PMC  BIT(0)
+#define QUIRK_XUANTIE_LINK BIT(1)
 
 struct xuantie_generic_quirks {
 	u32 quirk;

platform/generic/xuantie/objects.mk

@@ -3,4 +3,4 @@
 #
 
 carray-platform_override_modules-$(CONFIG_PLATFORM_XUANTIE) += xuantie_dummy
-platform-objs-$(CONFIG_PLATFORM_XUANTIE) += xuantie/xuantie_dummy.o xuantie/xuantie_pmc.o
+platform-objs-$(CONFIG_PLATFORM_XUANTIE) += xuantie/xuantie_dummy.o xuantie/xuantie_pmc.o xuantie/xuantie_link.o

platform/generic/xuantie/xuantie_dummy.c

@@ -12,11 +12,17 @@
 
 #include <xuantie/xuantie_quirk.h>
 #include <xuantie/xuantie_pmc.h>
+#include <xuantie/xuantie_link.h>
+
+static u32 gquirk = 0;
 
 int xuantie_final_init(bool cold_boot)
 {
 	if (cold_boot) {
-		xuantie_pmc_device_init();
+		if (gquirk & QUIRK_XUANTIE_PMC)
+			xuantie_pmc_device_init();
+		if (gquirk & QUIRK_XUANTIE_LINK)
+			xuantie_link_pmu_device_init();
 	}
 
 	return generic_final_init(cold_boot);
@@ -27,19 +33,28 @@ static int xuantie_dummy_platform_init(const void *fdt, int nodeoff,
 {
 	const struct xuantie_generic_quirks *data = match->data;
 
-	if (data->quirk & QUIRK_XUANTIE_PMC)
-		generic_platform_ops.final_init = xuantie_final_init;
+	gquirk = data->quirk;
+	generic_platform_ops.final_init = xuantie_final_init;
 
 	return 0;
 }
 
+static const struct xuantie_generic_quirks xuantie_quirks = {
+	.quirk = QUIRK_XUANTIE_PMC | QUIRK_XUANTIE_LINK,
+};
+
 static const struct xuantie_generic_quirks xuantie_pmc_quirks = {
 	.quirk = QUIRK_XUANTIE_PMC,
 };
 
+static const struct xuantie_generic_quirks xuantie_link_quirks = {
+	.quirk = QUIRK_XUANTIE_LINK,
+};
+
 static const struct fdt_match xuantie_dummy_match[] = {
-	{ .compatible = "xuantie,dummy", .data = &xuantie_pmc_quirks },
+	{ .compatible = "xuantie,dummy", .data = &xuantie_quirks },
 	{ .compatible = "xuantie,pmc", .data = &xuantie_pmc_quirks },
+	{ .compatible = "xuantie,link", .data = &xuantie_link_quirks },
 	{ },
 };
 

platform/generic/xuantie/xuantie_link.c

@@ -0,0 +1,40 @@
+/*
+ * SPDX-License-Identifier: BSD-2-Clause
+ */
+
+#include <libfdt.h>
+#include <sbi/sbi_error.h>
+#include <sbi/riscv_io.h>
+#include <sbi_utils/fdt/fdt_fixup.h>
+#include <sbi_utils/fdt/fdt_helper.h>
+#include <xuantie/xuantie_link.h>
+
+int xuantie_link_pmu_device_init(void)
+{
+#if __riscv_xlen == 64
+	int nodeoffset, rc, dev_type;
+	uint64_t addr;
+	void *fdt = fdt_get_address_rw();
+
+	if ((nodeoffset = fdt_node_offset_by_compatible(fdt, -1, "xuantie,xl100-pmu")) > 0)
+		dev_type = XUANTIE_LINK_DEV_TYPE_XL100;
+	else if ((nodeoffset = fdt_node_offset_by_compatible(fdt, -1, "xuantie,xl200-pmu")) > 0)
+		dev_type = XUANTIE_LINK_DEV_TYPE_XL200;
+	else if ((nodeoffset = fdt_node_offset_by_compatible(fdt, -1, "xuantie,xl300-pmu")) > 0)
+		dev_type = XUANTIE_LINK_DEV_TYPE_XL300;
+	else
+		return SBI_ENODEV;
+
+	rc = fdt_get_node_addr_size(fdt, nodeoffset, 0, &addr, NULL);
+	if (rc)
+		return SBI_ENODEV;
+
+	if (dev_type == XUANTIE_LINK_DEV_TYPE_XL300)
+		writeq(BIT_ULL(40) | BIT_ULL(32) | 0x3f, (void *)addr + XUANTIE_LINK_PMU_HPCPHAUTHCR);
+	writeq(0x3f, (void *)addr + XUANTIE_LINK_PMU_HPCPMAUTHCR);
+	writeq(0x3f, (void *)addr + XUANTIE_LINK_PMU_HPCPSAUTHCR);
+	writeq(0x1, (void *)addr + XUANTIE_LINK_PMU_L3MAUTHCR);
+	writeq(0x0, (void *)addr + XUANTIE_LINK_PMU_HPCPINHIBIT);
+#endif
+	return SBI_OK;
+}