cpufreq: ti: update OPP table for AM62Px SoCs

More speed grades for the AM62Px SoC family have been defined which
unfortunately no longer align with the AM62x table. So create a new
table with these new speed grades defined for the AM62Px

Reviewed-by: Dhruva Gole <d-gole@ti.com>
Signed-off-by: Bryan Brattlof <bb@ti.com>
Signed-off-by: Viresh Kumar <viresh.kumar@linaro.org>

diff --git a/drivers/cpufreq/ti-cpufreq.c b/drivers/cpufreq/ti-cpufreq.c
index 80f47a33420a65e169f94b610157356f2f079a54..4d3f27958fbde9f7957bdbee1c6b110025c272b0 100644 (file)
--- a/drivers/cpufreq/ti-cpufreq.c
+++ b/drivers/cpufreq/ti-cpufreq.c
@@ -69,6 +69,13 @@ enum {
 #define AM62A7_SUPPORT_R_MPU_OPP               BIT(1)
 #define AM62A7_SUPPORT_V_MPU_OPP               BIT(2)
 
+#define AM62P5_EFUSE_O_MPU_OPP                 15
+#define AM62P5_EFUSE_S_MPU_OPP                 19
+#define AM62P5_EFUSE_U_MPU_OPP                 21
+
+#define AM62P5_SUPPORT_O_MPU_OPP               BIT(0)
+#define AM62P5_SUPPORT_U_MPU_OPP               BIT(2)
+
 #define VERSION_COUNT                          2
 
 struct ti_cpufreq_data;
@@ -134,6 +141,23 @@ static unsigned long omap3_efuse_xlate(struct ti_cpufreq_data *opp_data,
        return BIT(efuse);
 }
 
+static unsigned long am62p5_efuse_xlate(struct ti_cpufreq_data *opp_data,
+                                       unsigned long efuse)
+{
+       unsigned long calculated_efuse = AM62P5_SUPPORT_O_MPU_OPP;
+
+       switch (efuse) {
+       case AM62P5_EFUSE_U_MPU_OPP:
+       case AM62P5_EFUSE_S_MPU_OPP:
+               calculated_efuse |= AM62P5_SUPPORT_U_MPU_OPP;
+               fallthrough;
+       case AM62P5_EFUSE_O_MPU_OPP:
+               calculated_efuse |= AM62P5_SUPPORT_O_MPU_OPP;
+       }
+
+       return calculated_efuse;
+}
+
 static unsigned long am62a7_efuse_xlate(struct ti_cpufreq_data *opp_data,
                                        unsigned long efuse)
 {
@@ -291,6 +315,15 @@ static struct ti_cpufreq_soc_data am62a7_soc_data = {
        .multi_regulator = false,
 };
 
+static struct ti_cpufreq_soc_data am62p5_soc_data = {
+       .efuse_xlate = am62p5_efuse_xlate,
+       .efuse_offset = 0x0,
+       .efuse_mask = 0x07c0,
+       .efuse_shift = 0x6,
+       .rev_offset = 0x0014,
+       .multi_regulator = false,
+};
+
 /**
  * ti_cpufreq_get_efuse() - Parse and return efuse value present on SoC
  * @opp_data: pointer to ti_cpufreq_data context
@@ -395,7 +428,7 @@ static const struct of_device_id ti_cpufreq_of_match[] = {
        { .compatible = "ti,omap36xx", .data = &omap36xx_soc_data, },
        { .compatible = "ti,am625", .data = &am625_soc_data, },
        { .compatible = "ti,am62a7", .data = &am62a7_soc_data, },
-       { .compatible = "ti,am62p5", .data = &am625_soc_data, },
+       { .compatible = "ti,am62p5", .data = &am62p5_soc_data, },
        /* legacy */
        { .compatible = "ti,omap3430", .data = &omap34xx_soc_data, },
        { .compatible = "ti,omap3630", .data = &omap36xx_soc_data, },