drivers/devfreq/rk3399_dmc.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2016, Fuzhou Rockchip Electronics Co., Ltd.
   4  * Author: Lin Huang <[email protected]>
   5  */
   6
   7 #include <linux/arm-smccc.h>
   8 #include <linux/bitfield.h>
   9 #include <linux/clk.h>
  10 #include <linux/delay.h>
  11 #include <linux/devfreq.h>
  12 #include <linux/devfreq-event.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/mfd/syscon.h>
  15 #include <linux/module.h>
  16 #include <linux/of.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/pm_opp.h>
  19 #include <linux/regmap.h>
  20 #include <linux/regulator/consumer.h>
  21 #include <linux/rwsem.h>
  22 #include <linux/suspend.h>
  23
  24 #include <soc/rockchip/pm_domains.h>
  25 #include <soc/rockchip/rockchip_grf.h>
  26 #include <soc/rockchip/rk3399_grf.h>
  27 #include <soc/rockchip/rockchip_sip.h>
  28
  29 #define NS_TO_CYCLE(NS, MHz)                            (((NS) * (MHz)) / NSEC_PER_USEC)
  30
  31 #define RK3399_SET_ODT_PD_0_SR_IDLE                     GENMASK(7, 0)
  32 #define RK3399_SET_ODT_PD_0_SR_MC_GATE_IDLE             GENMASK(15, 8)
  33 #define RK3399_SET_ODT_PD_0_STANDBY_IDLE                GENMASK(31, 16)
  34
  35 #define RK3399_SET_ODT_PD_1_PD_IDLE                     GENMASK(11, 0)
  36 #define RK3399_SET_ODT_PD_1_SRPD_LITE_IDLE              GENMASK(27, 16)
  37
  38 #define RK3399_SET_ODT_PD_2_ODT_ENABLE                  BIT(0)
  39
  40 struct rk3399_dmcfreq {
  41         struct device *dev;
  42         struct devfreq *devfreq;
  43         struct devfreq_dev_profile profile;
  44         struct devfreq_simple_ondemand_data ondemand_data;
  45         struct clk *dmc_clk;
  46         struct devfreq_event_dev *edev;
  47         struct mutex lock;
  48         struct regulator *vdd_center;
  49         struct regmap *regmap_pmu;
  50         unsigned long rate, target_rate;
  51         unsigned long volt, target_volt;
  52         unsigned int odt_dis_freq;
  53
  54         unsigned int pd_idle_ns;
  55         unsigned int sr_idle_ns;
  56         unsigned int sr_mc_gate_idle_ns;
  57         unsigned int srpd_lite_idle_ns;
  58         unsigned int standby_idle_ns;
  59         unsigned int ddr3_odt_dis_freq;
  60         unsigned int lpddr3_odt_dis_freq;
  61         unsigned int lpddr4_odt_dis_freq;
  62
  63         unsigned int pd_idle_dis_freq;
  64         unsigned int sr_idle_dis_freq;
  65         unsigned int sr_mc_gate_idle_dis_freq;
  66         unsigned int srpd_lite_idle_dis_freq;
  67         unsigned int standby_idle_dis_freq;
  68 };
  69
  70 static int rk3399_dmcfreq_target(struct device *dev, unsigned long *freq,
  71                                  u32 flags)
  72 {
  73         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(dev);
  74         struct dev_pm_opp *opp;
  75         unsigned long old_clk_rate = dmcfreq->rate;
  76         unsigned long target_volt, target_rate;
  77         unsigned int ddrcon_mhz;
  78         struct arm_smccc_res res;
  79         int err;
  80
  81         u32 odt_pd_arg0 = 0;
  82         u32 odt_pd_arg1 = 0;
  83         u32 odt_pd_arg2 = 0;
  84
  85         opp = devfreq_recommended_opp(dev, freq, flags);
  86         if (IS_ERR(opp))
  87                 return PTR_ERR(opp);
  88
  89         target_rate = dev_pm_opp_get_freq(opp);
  90         target_volt = dev_pm_opp_get_voltage(opp);
  91         dev_pm_opp_put(opp);
  92
  93         if (dmcfreq->rate == target_rate)
  94                 return 0;
  95
  96         mutex_lock(&dmcfreq->lock);
  97
  98         /*
  99          * Ensure power-domain transitions don't interfere with ARM Trusted
 100          * Firmware power-domain idling.
 101          */
 102         err = rockchip_pmu_block();
 103         if (err) {
 104                 dev_err(dev, "Failed to block PMU: %d\n", err);
 105                 goto out_unlock;
 106         }
 107
 108         /*
 109          * Some idle parameters may be based on the DDR controller clock, which
 110          * is half of the DDR frequency.
 111          * pd_idle and standby_idle are based on the controller clock cycle.
 112          * sr_idle_cycle, sr_mc_gate_idle_cycle, and srpd_lite_idle_cycle
 113          * are based on the 1024 controller clock cycle
 114          */
 115         ddrcon_mhz = target_rate / USEC_PER_SEC / 2;
 116
 117         u32p_replace_bits(&odt_pd_arg1,
 118                           NS_TO_CYCLE(dmcfreq->pd_idle_ns, ddrcon_mhz),
 119                           RK3399_SET_ODT_PD_1_PD_IDLE);
 120         u32p_replace_bits(&odt_pd_arg0,
 121                           NS_TO_CYCLE(dmcfreq->standby_idle_ns, ddrcon_mhz),
 122                           RK3399_SET_ODT_PD_0_STANDBY_IDLE);
 123         u32p_replace_bits(&odt_pd_arg0,
 124                           DIV_ROUND_UP(NS_TO_CYCLE(dmcfreq->sr_idle_ns,
 125                                                    ddrcon_mhz), 1024),
 126                           RK3399_SET_ODT_PD_0_SR_IDLE);
 127         u32p_replace_bits(&odt_pd_arg0,
 128                           DIV_ROUND_UP(NS_TO_CYCLE(dmcfreq->sr_mc_gate_idle_ns,
 129                                                    ddrcon_mhz), 1024),
 130                           RK3399_SET_ODT_PD_0_SR_MC_GATE_IDLE);
 131         u32p_replace_bits(&odt_pd_arg1,
 132                           DIV_ROUND_UP(NS_TO_CYCLE(dmcfreq->srpd_lite_idle_ns,
 133                                                    ddrcon_mhz), 1024),
 134                           RK3399_SET_ODT_PD_1_SRPD_LITE_IDLE);
 135
 136         if (dmcfreq->regmap_pmu) {
 137                 if (target_rate >= dmcfreq->sr_idle_dis_freq)
 138                         odt_pd_arg0 &= ~RK3399_SET_ODT_PD_0_SR_IDLE;
 139
 140                 if (target_rate >= dmcfreq->sr_mc_gate_idle_dis_freq)
 141                         odt_pd_arg0 &= ~RK3399_SET_ODT_PD_0_SR_MC_GATE_IDLE;
 142
 143                 if (target_rate >= dmcfreq->standby_idle_dis_freq)
 144                         odt_pd_arg0 &= ~RK3399_SET_ODT_PD_0_STANDBY_IDLE;
 145
 146                 if (target_rate >= dmcfreq->pd_idle_dis_freq)
 147                         odt_pd_arg1 &= ~RK3399_SET_ODT_PD_1_PD_IDLE;
 148
 149                 if (target_rate >= dmcfreq->srpd_lite_idle_dis_freq)
 150                         odt_pd_arg1 &= ~RK3399_SET_ODT_PD_1_SRPD_LITE_IDLE;
 151
 152                 if (target_rate >= dmcfreq->odt_dis_freq)
 153                         odt_pd_arg2 |= RK3399_SET_ODT_PD_2_ODT_ENABLE;
 154
 155                 /*
 156                  * This makes a SMC call to the TF-A to set the DDR PD
 157                  * (power-down) timings and to enable or disable the
 158                  * ODT (on-die termination) resistors.
 159                  */
 160                 arm_smccc_smc(ROCKCHIP_SIP_DRAM_FREQ, odt_pd_arg0, odt_pd_arg1,
 161                               ROCKCHIP_SIP_CONFIG_DRAM_SET_ODT_PD, odt_pd_arg2,
 162                               0, 0, 0, &res);
 163         }
 164
 165         /*
 166          * If frequency scaling from low to high, adjust voltage first.
 167          * If frequency scaling from high to low, adjust frequency first.
 168          */
 169         if (old_clk_rate < target_rate) {
 170                 err = regulator_set_voltage(dmcfreq->vdd_center, target_volt,
 171                                             target_volt);
 172                 if (err) {
 173                         dev_err(dev, "Cannot set voltage %lu uV\n",
 174                                 target_volt);
 175                         goto out;
 176                 }
 177         }
 178
 179         err = clk_set_rate(dmcfreq->dmc_clk, target_rate);
 180         if (err) {
 181                 dev_err(dev, "Cannot set frequency %lu (%d)\n", target_rate,
 182                         err);
 183                 regulator_set_voltage(dmcfreq->vdd_center, dmcfreq->volt,
 184                                       dmcfreq->volt);
 185                 goto out;
 186         }
 187
 188         /*
 189          * Check the dpll rate,
 190          * There only two result we will get,
 191          * 1. Ddr frequency scaling fail, we still get the old rate.
 192          * 2. Ddr frequency scaling sucessful, we get the rate we set.
 193          */
 194         dmcfreq->rate = clk_get_rate(dmcfreq->dmc_clk);
 195
 196         /* If get the incorrect rate, set voltage to old value. */
 197         if (dmcfreq->rate != target_rate) {
 198                 dev_err(dev, "Got wrong frequency, Request %lu, Current %lu\n",
 199                         target_rate, dmcfreq->rate);
 200                 regulator_set_voltage(dmcfreq->vdd_center, dmcfreq->volt,
 201                                       dmcfreq->volt);
 202                 goto out;
 203         } else if (old_clk_rate > target_rate)
 204                 err = regulator_set_voltage(dmcfreq->vdd_center, target_volt,
 205                                             target_volt);
 206         if (err)
 207                 dev_err(dev, "Cannot set voltage %lu uV\n", target_volt);
 208
 209         dmcfreq->rate = target_rate;
 210         dmcfreq->volt = target_volt;
 211
 212 out:
 213         rockchip_pmu_unblock();
 214 out_unlock:
 215         mutex_unlock(&dmcfreq->lock);
 216         return err;
 217 }
 218
 219 static int rk3399_dmcfreq_get_dev_status(struct device *dev,
 220                                          struct devfreq_dev_status *stat)
 221 {
 222         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(dev);
 223         struct devfreq_event_data edata;
 224         int ret = 0;
 225
 226         ret = devfreq_event_get_event(dmcfreq->edev, &edata);
 227         if (ret < 0)
 228                 return ret;
 229
 230         stat->current_frequency = dmcfreq->rate;
 231         stat->busy_time = edata.load_count;
 232         stat->total_time = edata.total_count;
 233
 234         return ret;
 235 }
 236
 237 static int rk3399_dmcfreq_get_cur_freq(struct device *dev, unsigned long *freq)
 238 {
 239         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(dev);
 240
 241         *freq = dmcfreq->rate;
 242
 243         return 0;
 244 }
 245
 246 static __maybe_unused int rk3399_dmcfreq_suspend(struct device *dev)
 247 {
 248         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(dev);
 249         int ret = 0;
 250
 251         ret = devfreq_event_disable_edev(dmcfreq->edev);
 252         if (ret < 0) {
 253                 dev_err(dev, "failed to disable the devfreq-event devices\n");
 254                 return ret;
 255         }
 256
 257         ret = devfreq_suspend_device(dmcfreq->devfreq);
 258         if (ret < 0) {
 259                 dev_err(dev, "failed to suspend the devfreq devices\n");
 260                 return ret;
 261         }
 262
 263         return 0;
 264 }
 265
 266 static __maybe_unused int rk3399_dmcfreq_resume(struct device *dev)
 267 {
 268         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(dev);
 269         int ret = 0;
 270
 271         ret = devfreq_event_enable_edev(dmcfreq->edev);
 272         if (ret < 0) {
 273                 dev_err(dev, "failed to enable the devfreq-event devices\n");
 274                 return ret;
 275         }
 276
 277         ret = devfreq_resume_device(dmcfreq->devfreq);
 278         if (ret < 0) {
 279                 dev_err(dev, "failed to resume the devfreq devices\n");
 280                 return ret;
 281         }
 282         return ret;
 283 }
 284
 285 static SIMPLE_DEV_PM_OPS(rk3399_dmcfreq_pm, rk3399_dmcfreq_suspend,
 286                          rk3399_dmcfreq_resume);
 287
 288 static int rk3399_dmcfreq_of_props(struct rk3399_dmcfreq *data,
 289                                    struct device_node *np)
 290 {
 291         int ret = 0;
 292
 293         /*
 294          * These are all optional, and serve as minimum bounds. Give them large
 295          * (i.e., never "disabled") values if the DT doesn't specify one.
 296          */
 297         data->pd_idle_dis_freq =
 298                 data->sr_idle_dis_freq =
 299                 data->sr_mc_gate_idle_dis_freq =
 300                 data->srpd_lite_idle_dis_freq =
 301                 data->standby_idle_dis_freq = UINT_MAX;
 302
 303         ret |= of_property_read_u32(np, "rockchip,pd-idle-ns",
 304                                     &data->pd_idle_ns);
 305         ret |= of_property_read_u32(np, "rockchip,sr-idle-ns",
 306                                     &data->sr_idle_ns);
 307         ret |= of_property_read_u32(np, "rockchip,sr-mc-gate-idle-ns",
 308                                     &data->sr_mc_gate_idle_ns);
 309         ret |= of_property_read_u32(np, "rockchip,srpd-lite-idle-ns",
 310                                     &data->srpd_lite_idle_ns);
 311         ret |= of_property_read_u32(np, "rockchip,standby-idle-ns",
 312                                     &data->standby_idle_ns);
 313         ret |= of_property_read_u32(np, "rockchip,ddr3_odt_dis_freq",
 314                                     &data->ddr3_odt_dis_freq);
 315         ret |= of_property_read_u32(np, "rockchip,lpddr3_odt_dis_freq",
 316                                     &data->lpddr3_odt_dis_freq);
 317         ret |= of_property_read_u32(np, "rockchip,lpddr4_odt_dis_freq",
 318                                     &data->lpddr4_odt_dis_freq);
 319
 320         ret |= of_property_read_u32(np, "rockchip,pd-idle-dis-freq-hz",
 321                                     &data->pd_idle_dis_freq);
 322         ret |= of_property_read_u32(np, "rockchip,sr-idle-dis-freq-hz",
 323                                     &data->sr_idle_dis_freq);
 324         ret |= of_property_read_u32(np, "rockchip,sr-mc-gate-idle-dis-freq-hz",
 325                                     &data->sr_mc_gate_idle_dis_freq);
 326         ret |= of_property_read_u32(np, "rockchip,srpd-lite-idle-dis-freq-hz",
 327                                     &data->srpd_lite_idle_dis_freq);
 328         ret |= of_property_read_u32(np, "rockchip,standby-idle-dis-freq-hz",
 329                                     &data->standby_idle_dis_freq);
 330
 331         return ret;
 332 }
 333
 334 static int rk3399_dmcfreq_probe(struct platform_device *pdev)
 335 {
 336         struct arm_smccc_res res;
 337         struct device *dev = &pdev->dev;
 338         struct device_node *np = pdev->dev.of_node, *node;
 339         struct rk3399_dmcfreq *data;
 340         int ret;
 341         struct dev_pm_opp *opp;
 342         u32 ddr_type;
 343         u32 val;
 344
 345         data = devm_kzalloc(dev, sizeof(struct rk3399_dmcfreq), GFP_KERNEL);
 346         if (!data)
 347                 return -ENOMEM;
 348
 349         mutex_init(&data->lock);
 350
 351         data->vdd_center = devm_regulator_get(dev, "center");
 352         if (IS_ERR(data->vdd_center))
 353                 return dev_err_probe(dev, PTR_ERR(data->vdd_center),
 354                                      "Cannot get the regulator \"center\"\n");
 355
 356         data->dmc_clk = devm_clk_get(dev, "dmc_clk");
 357         if (IS_ERR(data->dmc_clk))
 358                 return dev_err_probe(dev, PTR_ERR(data->dmc_clk),
 359                                      "Cannot get the clk dmc_clk\n");
 360
 361         data->edev = devfreq_event_get_edev_by_phandle(dev, "devfreq-events", 0);
 362         if (IS_ERR(data->edev))
 363                 return -EPROBE_DEFER;
 364
 365         ret = devfreq_event_enable_edev(data->edev);
 366         if (ret < 0) {
 367                 dev_err(dev, "failed to enable devfreq-event devices\n");
 368                 return ret;
 369         }
 370
 371         rk3399_dmcfreq_of_props(data, np);
 372
 373         node = of_parse_phandle(np, "rockchip,pmu", 0);
 374         if (!node)
 375                 goto no_pmu;
 376
 377         data->regmap_pmu = syscon_node_to_regmap(node);
 378         of_node_put(node);
 379         if (IS_ERR(data->regmap_pmu)) {
 380                 ret = PTR_ERR(data->regmap_pmu);
 381                 goto err_edev;
 382         }
 383
 384         regmap_read(data->regmap_pmu, RK3399_PMUGRF_OS_REG2, &val);
 385         ddr_type = FIELD_GET(RK3399_PMUGRF_OS_REG2_DDRTYPE, val);
 386
 387         switch (ddr_type) {
 388         case ROCKCHIP_DDRTYPE_DDR3:
 389                 data->odt_dis_freq = data->ddr3_odt_dis_freq;
 390                 break;
 391         case ROCKCHIP_DDRTYPE_LPDDR3:
 392                 data->odt_dis_freq = data->lpddr3_odt_dis_freq;
 393                 break;
 394         case ROCKCHIP_DDRTYPE_LPDDR4:
 395                 data->odt_dis_freq = data->lpddr4_odt_dis_freq;
 396                 break;
 397         default:
 398                 ret = -EINVAL;
 399                 goto err_edev;
 400         }
 401
 402 no_pmu:
 403         arm_smccc_smc(ROCKCHIP_SIP_DRAM_FREQ, 0, 0,
 404                       ROCKCHIP_SIP_CONFIG_DRAM_INIT,
 405                       0, 0, 0, 0, &res);
 406
 407         /*
 408          * We add a devfreq driver to our parent since it has a device tree node
 409          * with operating points.
 410          */
 411         if (devm_pm_opp_of_add_table(dev)) {
 412                 dev_err(dev, "Invalid operating-points in device tree.\n");
 413                 ret = -EINVAL;
 414                 goto err_edev;
 415         }
 416
 417         data->ondemand_data.upthreshold = 25;
 418         data->ondemand_data.downdifferential = 15;
 419
 420         data->rate = clk_get_rate(data->dmc_clk);
 421
 422         opp = devfreq_recommended_opp(dev, &data->rate, 0);
 423         if (IS_ERR(opp)) {
 424                 ret = PTR_ERR(opp);
 425                 goto err_edev;
 426         }
 427
 428         data->rate = dev_pm_opp_get_freq(opp);
 429         data->volt = dev_pm_opp_get_voltage(opp);
 430         dev_pm_opp_put(opp);
 431
 432         data->profile = (struct devfreq_dev_profile) {
 433                 .polling_ms     = 200,
 434                 .target         = rk3399_dmcfreq_target,
 435                 .get_dev_status = rk3399_dmcfreq_get_dev_status,
 436                 .get_cur_freq   = rk3399_dmcfreq_get_cur_freq,
 437                 .initial_freq   = data->rate,
 438         };
 439
 440         data->devfreq = devm_devfreq_add_device(dev,
 441                                            &data->profile,
 442                                            DEVFREQ_GOV_SIMPLE_ONDEMAND,
 443                                            &data->ondemand_data);
 444         if (IS_ERR(data->devfreq)) {
 445                 ret = PTR_ERR(data->devfreq);
 446                 goto err_edev;
 447         }
 448
 449         devm_devfreq_register_opp_notifier(dev, data->devfreq);
 450
 451         data->dev = dev;
 452         platform_set_drvdata(pdev, data);
 453
 454         return 0;
 455
 456 err_edev:
 457         devfreq_event_disable_edev(data->edev);
 458
 459         return ret;
 460 }
 461
 462 static void rk3399_dmcfreq_remove(struct platform_device *pdev)
 463 {
 464         struct rk3399_dmcfreq *dmcfreq = dev_get_drvdata(&pdev->dev);
 465
 466         devfreq_event_disable_edev(dmcfreq->edev);
 467 }
 468
 469 static const struct of_device_id rk3399dmc_devfreq_of_match[] = {
 470         { .compatible = "rockchip,rk3399-dmc" },
 471         { },
 472 };
 473 MODULE_DEVICE_TABLE(of, rk3399dmc_devfreq_of_match);
 474
 475 static struct platform_driver rk3399_dmcfreq_driver = {
 476         .probe  = rk3399_dmcfreq_probe,
 477         .remove_new = rk3399_dmcfreq_remove,
 478         .driver = {
 479                 .name   = "rk3399-dmc-freq",
 480                 .pm     = &rk3399_dmcfreq_pm,
 481                 .of_match_table = rk3399dmc_devfreq_of_match,
 482         },
 483 };
 484 module_platform_driver(rk3399_dmcfreq_driver);
 485
 486 MODULE_LICENSE("GPL v2");
 487 MODULE_AUTHOR("Lin Huang <[email protected]>");
 488 MODULE_DESCRIPTION("RK3399 dmcfreq driver with devfreq framework");