drivers/misc/k3_avs.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Texas Instruments' K3 Clas 0 Adaptive Voltage Scaling driver
   4  *
   5  * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
   6  *      Tero Kristo <t-kristo@ti.com>
   7  *
   8  */
   9
  10 #include <common.h>
  11 #include <dm.h>
  12 #include <errno.h>
  13 #include <asm/io.h>
  14 #include <i2c.h>
  15 #include <k3-avs.h>
  16 #include <dm/device_compat.h>
  17 #include <power/regulator.h>
  18
  19 #define AM6_VTM_DEVINFO(i)      (priv->base + 0x100 + 0x20 * (i))
  20 #define AM6_VTM_OPPVID_VD(i)    (priv->base + 0x104 + 0x20 * (i))
  21
  22 #define AM6_VTM_AVS0_SUPPORTED  BIT(12)
  23
  24 #define AM6_VTM_OPP_SHIFT(opp)  (8 * (opp))
  25 #define AM6_VTM_OPP_MASK        0xff
  26
  27 #define VD_FLAG_INIT_DONE       BIT(0)
  28
  29 struct k3_avs_privdata {
  30         void *base;
  31         struct vd_config *vd_config;
  32 };
  33
  34 struct opp {
  35         u32 freq;
  36         u32 volt;
  37 };
  38
  39 struct vd_data {
  40         int id;
  41         u8 opp;
  42         u8 flags;
  43         int dev_id;
  44         int clk_id;
  45         struct opp opps[NUM_OPPS];
  46         struct udevice *supply;
  47 };
  48
  49 struct vd_config {
  50         struct vd_data *vds;
  51         u32 (*efuse_xlate)(struct k3_avs_privdata *priv, int idx, int opp);
  52 };
  53
  54 static struct k3_avs_privdata *k3_avs_priv;
  55
  56 /**
  57  * am6_efuse_voltage: read efuse voltage from VTM
  58  * @priv: driver private data
  59  * @idx: VD to read efuse for
  60  * @opp: opp id to read
  61  *
  62  * Reads efuse value for the specified OPP, and converts the register
  63  * value to a voltage. Returns the voltage in uV, or 0 if nominal voltage
  64  * should be used.
  65  *
  66  * Efuse val to volt conversion logic:
  67  *
  68  * val > 171 volt increments in 20mV steps with base 171 => 1.66V
  69  * val between 115 to 11 increments in 10mV steps with base 115 => 1.1V
  70  * val between 15 to 115 increments in 5mV steps with base 15 => .6V
  71  * val between 1 to 15 increments in 20mv steps with base 0 => .3V
  72  * val 0 is invalid
  73  */
  74 static u32 am6_efuse_xlate(struct k3_avs_privdata *priv, int idx, int opp)
  75 {
  76         u32 val = readl(AM6_VTM_OPPVID_VD(idx));
  77
  78         val >>= AM6_VTM_OPP_SHIFT(opp);
  79         val &= AM6_VTM_OPP_MASK;
  80
  81         if (!val)
  82                 return 0;
  83
  84         if (val > 171)
  85                 return 1660000 + 20000 * (val - 171);
  86
  87         if (val > 115)
  88                 return 1100000 + 10000 * (val - 115);
  89
  90         if (val > 15)
  91                 return 600000 + 5000 * (val - 15);
  92
  93         return 300000 + 20000 * val;
  94 }
  95
  96 static int k3_avs_program_voltage(struct k3_avs_privdata *priv,
  97                                   struct vd_data *vd,
  98                                   int opp_id)
  99 {
 100         u32 volt = vd->opps[opp_id].volt;
 101         struct vd_data *vd2;
 102
 103         if (!vd->supply)
 104                 return -ENODEV;
 105
 106         vd->opp = opp_id;
 107         vd->flags |= VD_FLAG_INIT_DONE;
 108
 109         /* Take care of ganged rails and pick the Max amongst them*/
 110         for (vd2 = priv->vd_config->vds; vd2->id >= 0; vd2++) {
 111                 if (vd == vd2)
 112                         continue;
 113
 114                 if (vd2->supply != vd->supply)
 115                         continue;
 116
 117                 if (vd2->opps[vd2->opp].volt > volt)
 118                         volt = vd2->opps[vd2->opp].volt;
 119
 120                 vd2->flags |= VD_FLAG_INIT_DONE;
 121         }
 122
 123         return regulator_set_value(vd->supply, volt);
 124 }
 125
 126 static struct vd_data *get_vd(struct k3_avs_privdata *priv, int idx)
 127 {
 128         struct vd_data *vd;
 129
 130         for (vd = priv->vd_config->vds; vd->id >= 0 && vd->id != idx; vd++)
 131                 ;
 132
 133         if (vd->id < 0)
 134                 return NULL;
 135
 136         return vd;
 137 }
 138
 139 /**
 140  * k3_avs_set_opp: Sets the voltage for an arbitrary VD rail
 141  * @dev: AVS device
 142  * @vdd_id: voltage domain ID
 143  * @opp_id: OPP ID
 144  *
 145  * Programs the desired OPP value for the defined voltage rail. This
 146  * should be called from board files if reconfiguration is desired.
 147  * Returns 0 on success, negative error value on failure.
 148  */
 149 int k3_avs_set_opp(struct udevice *dev, int vdd_id, int opp_id)
 150 {
 151         struct k3_avs_privdata *priv = dev_get_priv(dev);
 152         struct vd_data *vd;
 153
 154         vd = get_vd(priv, vdd_id);
 155         if (!vd)
 156                 return -EINVAL;
 157
 158         return k3_avs_program_voltage(priv, vd, opp_id);
 159 }
 160
 161 static int match_opp(struct vd_data *vd, u32 freq)
 162 {
 163         struct opp *opp;
 164         int opp_id;
 165
 166         for (opp_id = 0; opp_id < NUM_OPPS; opp_id++) {
 167                 opp = &vd->opps[opp_id];
 168                 if (opp->freq == freq)
 169                         return opp_id;
 170         }
 171
 172         printf("No matching OPP found for freq %d.\n", freq);
 173
 174         return -EINVAL;
 175 }
 176
 177 /**
 178  * k3_avs_notify_freq: Notify clock rate change towards AVS subsystem
 179  * @dev_id: Device ID for the clock to be changed
 180  * @clk_id: Clock ID for the clock to be changed
 181  * @freq: New frequency for clock
 182  *
 183  * Checks if the provided clock is the MPU clock or not, if not, return
 184  * immediately. If MPU clock is provided, maps the provided MPU frequency
 185  * towards an MPU OPP, and programs the voltage to the regulator. Return 0
 186  * on success, negative error value on failure.
 187  */
 188 int k3_avs_notify_freq(int dev_id, int clk_id, u32 freq)
 189 {
 190         int opp_id;
 191         struct k3_avs_privdata *priv = k3_avs_priv;
 192         struct vd_data *vd;
 193
 194         /* Driver may not be probed yet */
 195         if (!priv)
 196                 return -EINVAL;
 197
 198         for (vd = priv->vd_config->vds; vd->id >= 0; vd++) {
 199                 if (vd->dev_id != dev_id || vd->clk_id != clk_id)
 200                         continue;
 201
 202                 opp_id = match_opp(vd, freq);
 203                 if (opp_id < 0)
 204                         return opp_id;
 205
 206                 vd->opp = opp_id;
 207                 return k3_avs_program_voltage(priv, vd, opp_id);
 208         }
 209
 210         return -EINVAL;
 211 }
 212
 213 static int k3_avs_configure(struct udevice *dev, struct k3_avs_privdata *priv)
 214 {
 215         struct vd_config *conf;
 216         int ret;
 217         char pname[20];
 218         struct vd_data *vd;
 219
 220         conf = (void *)dev_get_driver_data(dev);
 221
 222         priv->vd_config = conf;
 223
 224         for (vd = conf->vds; vd->id >= 0; vd++) {
 225                 sprintf(pname, "vdd-supply-%d", vd->id);
 226                 ret = device_get_supply_regulator(dev, pname, &vd->supply);
 227                 if (ret)
 228                         dev_warn(dev, "supply not found for VD%d.\n", vd->id);
 229
 230                 sprintf(pname, "ti,default-opp-%d", vd->id);
 231                 ret = dev_read_u32_default(dev, pname, -1);
 232                 if (ret != -1)
 233                         vd->opp = ret;
 234         }
 235
 236         return 0;
 237 }
 238
 239 /**
 240  * k3_avs_probe: parses VD info from VTM, and re-configures the OPP data
 241  *
 242  * Parses all VDs on a device calculating the AVS class-0 voltages for them,
 243  * and updates the vd_data based on this. The vd_data itself shall be used
 244  * to program the required OPPs later on. Returns 0 on success, negative
 245  * error value on failure.
 246  */
 247 static int k3_avs_probe(struct udevice *dev)
 248 {
 249         int opp_id;
 250         u32 volt;
 251         struct opp *opp;
 252         struct k3_avs_privdata *priv;
 253         struct vd_data *vd;
 254         int ret;
 255
 256         priv = dev_get_priv(dev);
 257
 258         k3_avs_priv = priv;
 259
 260         ret = k3_avs_configure(dev, priv);
 261         if (ret)
 262                 return ret;
 263
 264         priv->base = dev_read_addr_ptr(dev);
 265         if (!priv->base)
 266                 return -ENODEV;
 267
 268         for (vd = priv->vd_config->vds; vd->id >= 0; vd++) {
 269                 if (!(readl(AM6_VTM_DEVINFO(vd->id)) &
 270                       AM6_VTM_AVS0_SUPPORTED)) {
 271                         dev_warn(dev, "AVS-class 0 not supported for VD%d\n",
 272                                  vd->id);
 273                         continue;
 274                 }
 275
 276                 for (opp_id = 0; opp_id < NUM_OPPS; opp_id++) {
 277                         opp = &vd->opps[opp_id];
 278
 279                         if (!opp->freq)
 280                                 continue;
 281
 282                         volt = priv->vd_config->efuse_xlate(priv, vd->id,
 283                                                             opp_id);
 284                         if (volt)
 285                                 opp->volt = volt;
 286                 }
 287         }
 288
 289         for (vd = priv->vd_config->vds; vd->id >= 0; vd++) {
 290                 if (vd->flags & VD_FLAG_INIT_DONE)
 291                         continue;
 292
 293                 k3_avs_program_voltage(priv, vd, vd->opp);
 294         }
 295
 296         return 0;
 297 }
 298
 299 static struct vd_data am654_vd_data[] = {
 300         {
 301                 .id = AM6_VDD_CORE,
 302                 .dev_id = 82, /* AM6_DEV_CBASS0 */
 303                 .clk_id = 0, /* main sysclk0 */
 304                 .opp = AM6_OPP_NOM,
 305                 .opps = {
 306                         [AM6_OPP_NOM] = {
 307                                 .volt = 1000000,
 308                                 .freq = 250000000, /* CBASS0 */
 309                         },
 310                 },
 311         },
 312         {
 313                 .id = AM6_VDD_MPU0,
 314                 .dev_id = 202, /* AM6_DEV_COMPUTE_CLUSTER_A53_0 */
 315                 .clk_id = 0, /* ARM clock */
 316                 .opp = AM6_OPP_NOM,
 317                 .opps = {
 318                         [AM6_OPP_NOM] = {
 319                                 .volt = 1100000,
 320                                 .freq = 800000000,
 321                         },
 322                         [AM6_OPP_OD] = {
 323                                 .volt = 1200000,
 324                                 .freq = 1000000000,
 325                         },
 326                         [AM6_OPP_TURBO] = {
 327                                 .volt = 1240000,
 328                                 .freq = 1100000000,
 329                         },
 330                 },
 331         },
 332         {
 333                 .id = AM6_VDD_MPU1,
 334                 .opp = AM6_OPP_NOM,
 335                 .dev_id = 204, /* AM6_DEV_COMPUTE_CLUSTER_A53_2 */
 336                 .clk_id = 0, /* ARM clock */
 337                 .opps = {
 338                         [AM6_OPP_NOM] = {
 339                                 .volt = 1100000,
 340                                 .freq = 800000000,
 341                         },
 342                         [AM6_OPP_OD] = {
 343                                 .volt = 1200000,
 344                                 .freq = 1000000000,
 345                         },
 346                         [AM6_OPP_TURBO] = {
 347                                 .volt = 1240000,
 348                                 .freq = 1100000000,
 349                         },
 350                 },
 351         },
 352         { .id = -1 },
 353 };
 354
 355 static struct vd_data j721e_vd_data[] = {
 356         {
 357                 .id = J721E_VDD_MPU,
 358                 .opp = AM6_OPP_NOM,
 359                 .dev_id = 202, /* J721E_DEV_A72SS0_CORE0 */
 360                 .clk_id = 2, /* ARM clock */
 361                 .opps = {
 362                         [AM6_OPP_NOM] = {
 363                                 .volt = 880000, /* TBD in DM */
 364                                 .freq = 2000000000,
 365                         },
 366                 },
 367         },
 368         { .id = -1 },
 369 };
 370
 371 static struct vd_config j721e_vd_config = {
 372         .efuse_xlate = am6_efuse_xlate,
 373         .vds = j721e_vd_data,
 374 };
 375
 376 static struct vd_config am654_vd_config = {
 377         .efuse_xlate = am6_efuse_xlate,
 378         .vds = am654_vd_data,
 379 };
 380
 381 static const struct udevice_id k3_avs_ids[] = {
 382         { .compatible = "ti,am654-avs", .data = (ulong)&am654_vd_config },
 383         { .compatible = "ti,j721e-avs", .data = (ulong)&j721e_vd_config },
 384         {}
 385 };
 386
 387 U_BOOT_DRIVER(k3_avs) = {
 388         .name = "k3_avs",
 389         .of_match = k3_avs_ids,
 390         .id = UCLASS_MISC,
 391         .probe = k3_avs_probe,
 392         .priv_auto_alloc_size = sizeof(struct k3_avs_privdata),
 393 };