PM / devfreq: rockchip-dfi: Add RK3568 support

[linux-2.6-microblaze.git] / drivers / devfreq / event / rockchip-dfi.c

diff --git a/drivers/devfreq/event/rockchip-dfi.c b/drivers/devfreq/event/rockchip-dfi.c
index 12f9096..571d72d 100644 (file)
--- a/drivers/devfreq/event/rockchip-dfi.c
+++ b/drivers/devfreq/event/rockchip-dfi.c
@@ -23,6 +23,7 @@
 
 #include <soc/rockchip/rockchip_grf.h>
 #include <soc/rockchip/rk3399_grf.h>
+#include <soc/rockchip/rk3568_grf.h>
 
 #define DMC_MAX_CHANNELS       2
 
@@ -211,10 +212,36 @@ static int rk3399_dfi_init(struct rockchip_dfi *dfi)
        return 0;
 };
 
+static int rk3568_dfi_init(struct rockchip_dfi *dfi)
+{
+       struct regmap *regmap_pmu = dfi->regmap_pmu;
+       u32 reg2, reg3;
+
+       regmap_read(regmap_pmu, RK3568_PMUGRF_OS_REG2, &reg2);
+       regmap_read(regmap_pmu, RK3568_PMUGRF_OS_REG3, &reg3);
+
+       /* lower 3 bits of the DDR type */
+       dfi->ddr_type = FIELD_GET(RK3568_PMUGRF_OS_REG2_DRAMTYPE_INFO, reg2);
+
+       /*
+        * For version three and higher the upper two bits of the DDR type are
+        * in RK3568_PMUGRF_OS_REG3
+        */
+       if (FIELD_GET(RK3568_PMUGRF_OS_REG3_SYSREG_VERSION, reg3) >= 0x3)
+               dfi->ddr_type |= FIELD_GET(RK3568_PMUGRF_OS_REG3_DRAMTYPE_INFO_V3, reg3) << 3;
+
+       dfi->channel_mask = BIT(0);
+       dfi->max_channels = 1;
+
+       return 0;
+};
+
 static const struct of_device_id rockchip_dfi_id_match[] = {
        { .compatible = "rockchip,rk3399-dfi", .data = rk3399_dfi_init },
+       { .compatible = "rockchip,rk3568-dfi", .data = rk3568_dfi_init },
        { },
 };
+
 MODULE_DEVICE_TABLE(of, rockchip_dfi_id_match);
 
 static int rockchip_dfi_probe(struct platform_device *pdev)