drivers/gpu/drm/lima/lima_devfreq.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright 2020 Martin Blumenstingl <[email protected]>
   4  *
   5  * Based on panfrost_devfreq.c:
   6  *   Copyright 2019 Collabora ltd.
   7  */
   8 #include <linux/clk.h>
   9 #include <linux/devfreq.h>
  10 #include <linux/devfreq_cooling.h>
  11 #include <linux/device.h>
  12 #include <linux/platform_device.h>
  13 #include <linux/pm_opp.h>
  14 #include <linux/property.h>
  15
  16 #include "lima_device.h"
  17 #include "lima_devfreq.h"
  18
  19 static void lima_devfreq_update_utilization(struct lima_devfreq *devfreq)
  20 {
  21         ktime_t now, last;
  22
  23         now = ktime_get();
  24         last = devfreq->time_last_update;
  25
  26         if (devfreq->busy_count > 0)
  27                 devfreq->busy_time += ktime_sub(now, last);
  28         else
  29                 devfreq->idle_time += ktime_sub(now, last);
  30
  31         devfreq->time_last_update = now;
  32 }
  33
  34 static int lima_devfreq_target(struct device *dev, unsigned long *freq,
  35                                u32 flags)
  36 {
  37         struct dev_pm_opp *opp;
  38
  39         opp = devfreq_recommended_opp(dev, freq, flags);
  40         if (IS_ERR(opp))
  41                 return PTR_ERR(opp);
  42         dev_pm_opp_put(opp);
  43
  44         return dev_pm_opp_set_rate(dev, *freq);
  45 }
  46
  47 static void lima_devfreq_reset(struct lima_devfreq *devfreq)
  48 {
  49         devfreq->busy_time = 0;
  50         devfreq->idle_time = 0;
  51         devfreq->time_last_update = ktime_get();
  52 }
  53
  54 static int lima_devfreq_get_dev_status(struct device *dev,
  55                                        struct devfreq_dev_status *status)
  56 {
  57         struct lima_device *ldev = dev_get_drvdata(dev);
  58         struct lima_devfreq *devfreq = &ldev->devfreq;
  59         unsigned long irqflags;
  60
  61         status->current_frequency = clk_get_rate(ldev->clk_gpu);
  62
  63         spin_lock_irqsave(&devfreq->lock, irqflags);
  64
  65         lima_devfreq_update_utilization(devfreq);
  66
  67         status->total_time = ktime_to_ns(ktime_add(devfreq->busy_time,
  68                                                    devfreq->idle_time));
  69         status->busy_time = ktime_to_ns(devfreq->busy_time);
  70
  71         lima_devfreq_reset(devfreq);
  72
  73         spin_unlock_irqrestore(&devfreq->lock, irqflags);
  74
  75         dev_dbg(ldev->dev, "busy %lu total %lu %lu %% freq %lu MHz\n",
  76                 status->busy_time, status->total_time,
  77                 status->busy_time / (status->total_time / 100),
  78                 status->current_frequency / 1000 / 1000);
  79
  80         return 0;
  81 }
  82
  83 static struct devfreq_dev_profile lima_devfreq_profile = {
  84         .timer = DEVFREQ_TIMER_DELAYED,
  85         .polling_ms = 50, /* ~3 frames */
  86         .target = lima_devfreq_target,
  87         .get_dev_status = lima_devfreq_get_dev_status,
  88 };
  89
  90 void lima_devfreq_fini(struct lima_device *ldev)
  91 {
  92         struct lima_devfreq *devfreq = &ldev->devfreq;
  93
  94         if (devfreq->cooling) {
  95                 devfreq_cooling_unregister(devfreq->cooling);
  96                 devfreq->cooling = NULL;
  97         }
  98
  99         if (devfreq->devfreq) {
 100                 devm_devfreq_remove_device(ldev->dev, devfreq->devfreq);
 101                 devfreq->devfreq = NULL;
 102         }
 103
 104         dev_pm_opp_of_remove_table(ldev->dev);
 105
 106         dev_pm_opp_put_regulators(devfreq->regulators_opp_table);
 107         dev_pm_opp_put_clkname(devfreq->clkname_opp_table);
 108         devfreq->regulators_opp_table = NULL;
 109         devfreq->clkname_opp_table = NULL;
 110 }
 111
 112 int lima_devfreq_init(struct lima_device *ldev)
 113 {
 114         struct thermal_cooling_device *cooling;
 115         struct device *dev = ldev->dev;
 116         struct opp_table *opp_table;
 117         struct devfreq *devfreq;
 118         struct lima_devfreq *ldevfreq = &ldev->devfreq;
 119         struct dev_pm_opp *opp;
 120         unsigned long cur_freq;
 121         int ret;
 122
 123         if (!device_property_present(dev, "operating-points-v2"))
 124                 /* Optional, continue without devfreq */
 125                 return 0;
 126
 127         spin_lock_init(&ldevfreq->lock);
 128
 129         opp_table = dev_pm_opp_set_clkname(dev, "core");
 130         if (IS_ERR(opp_table)) {
 131                 ret = PTR_ERR(opp_table);
 132                 goto err_fini;
 133         }
 134
 135         ldevfreq->clkname_opp_table = opp_table;
 136
 137         opp_table = dev_pm_opp_set_regulators(dev,
 138                                               (const char *[]){ "mali" },
 139                                               1);
 140         if (IS_ERR(opp_table)) {
 141                 ret = PTR_ERR(opp_table);
 142
 143                 /* Continue if the optional regulator is missing */
 144                 if (ret != -ENODEV)
 145                         goto err_fini;
 146         } else {
 147                 ldevfreq->regulators_opp_table = opp_table;
 148         }
 149
 150         ret = dev_pm_opp_of_add_table(dev);
 151         if (ret)
 152                 goto err_fini;
 153
 154         lima_devfreq_reset(ldevfreq);
 155
 156         cur_freq = clk_get_rate(ldev->clk_gpu);
 157
 158         opp = devfreq_recommended_opp(dev, &cur_freq, 0);
 159         if (IS_ERR(opp)) {
 160                 ret = PTR_ERR(opp);
 161                 goto err_fini;
 162         }
 163
 164         lima_devfreq_profile.initial_freq = cur_freq;
 165         dev_pm_opp_put(opp);
 166
 167         devfreq = devm_devfreq_add_device(dev, &lima_devfreq_profile,
 168                                           DEVFREQ_GOV_SIMPLE_ONDEMAND, NULL);
 169         if (IS_ERR(devfreq)) {
 170                 dev_err(dev, "Couldn't initialize GPU devfreq\n");
 171                 ret = PTR_ERR(devfreq);
 172                 goto err_fini;
 173         }
 174
 175         ldevfreq->devfreq = devfreq;
 176
 177         cooling = of_devfreq_cooling_register(dev->of_node, devfreq);
 178         if (IS_ERR(cooling))
 179                 dev_info(dev, "Failed to register cooling device\n");
 180         else
 181                 ldevfreq->cooling = cooling;
 182
 183         return 0;
 184
 185 err_fini:
 186         lima_devfreq_fini(ldev);
 187         return ret;
 188 }
 189
 190 void lima_devfreq_record_busy(struct lima_devfreq *devfreq)
 191 {
 192         unsigned long irqflags;
 193
 194         if (!devfreq->devfreq)
 195                 return;
 196
 197         spin_lock_irqsave(&devfreq->lock, irqflags);
 198
 199         lima_devfreq_update_utilization(devfreq);
 200
 201         devfreq->busy_count++;
 202
 203         spin_unlock_irqrestore(&devfreq->lock, irqflags);
 204 }
 205
 206 void lima_devfreq_record_idle(struct lima_devfreq *devfreq)
 207 {
 208         unsigned long irqflags;
 209
 210         if (!devfreq->devfreq)
 211                 return;
 212
 213         spin_lock_irqsave(&devfreq->lock, irqflags);
 214
 215         lima_devfreq_update_utilization(devfreq);
 216
 217         WARN_ON(--devfreq->busy_count < 0);
 218
 219         spin_unlock_irqrestore(&devfreq->lock, irqflags);
 220 }
 221
 222 int lima_devfreq_resume(struct lima_devfreq *devfreq)
 223 {
 224         unsigned long irqflags;
 225
 226         if (!devfreq->devfreq)
 227                 return 0;
 228
 229         spin_lock_irqsave(&devfreq->lock, irqflags);
 230
 231         lima_devfreq_reset(devfreq);
 232
 233         spin_unlock_irqrestore(&devfreq->lock, irqflags);
 234
 235         return devfreq_resume_device(devfreq->devfreq);
 236 }
 237
 238 int lima_devfreq_suspend(struct lima_devfreq *devfreq)
 239 {
 240         if (!devfreq->devfreq)
 241                 return 0;
 242
 243         return devfreq_suspend_device(devfreq->devfreq);
 244 }