123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright 2020 Martin Blumenstingl <martin.blumenstingl@googlemail.com>
- *
- * Based on panfrost_devfreq.c:
- * Copyright 2019 Collabora ltd.
- */
- #include <linux/clk.h>
- #include <linux/devfreq.h>
- #include <linux/devfreq_cooling.h>
- #include <linux/device.h>
- #include <linux/platform_device.h>
- #include <linux/pm_opp.h>
- #include <linux/property.h>
- #include "lima_device.h"
- #include "lima_devfreq.h"
- static void lima_devfreq_update_utilization(struct lima_devfreq *devfreq)
- {
- ktime_t now, last;
- now = ktime_get();
- last = devfreq->time_last_update;
- if (devfreq->busy_count > 0)
- devfreq->busy_time += ktime_sub(now, last);
- else
- devfreq->idle_time += ktime_sub(now, last);
- devfreq->time_last_update = now;
- }
- static int lima_devfreq_target(struct device *dev, unsigned long *freq,
- u32 flags)
- {
- struct dev_pm_opp *opp;
- int err;
- opp = devfreq_recommended_opp(dev, freq, flags);
- if (IS_ERR(opp))
- return PTR_ERR(opp);
- dev_pm_opp_put(opp);
- err = dev_pm_opp_set_rate(dev, *freq);
- if (err)
- return err;
- return 0;
- }
- static void lima_devfreq_reset(struct lima_devfreq *devfreq)
- {
- devfreq->busy_time = 0;
- devfreq->idle_time = 0;
- devfreq->time_last_update = ktime_get();
- }
- static int lima_devfreq_get_dev_status(struct device *dev,
- struct devfreq_dev_status *status)
- {
- struct lima_device *ldev = dev_get_drvdata(dev);
- struct lima_devfreq *devfreq = &ldev->devfreq;
- unsigned long irqflags;
- status->current_frequency = clk_get_rate(ldev->clk_gpu);
- spin_lock_irqsave(&devfreq->lock, irqflags);
- lima_devfreq_update_utilization(devfreq);
- status->total_time = ktime_to_ns(ktime_add(devfreq->busy_time,
- devfreq->idle_time));
- status->busy_time = ktime_to_ns(devfreq->busy_time);
- lima_devfreq_reset(devfreq);
- spin_unlock_irqrestore(&devfreq->lock, irqflags);
- dev_dbg(ldev->dev, "busy %lu total %lu %lu %% freq %lu MHz\n",
- status->busy_time, status->total_time,
- status->busy_time / (status->total_time / 100),
- status->current_frequency / 1000 / 1000);
- return 0;
- }
- static struct devfreq_dev_profile lima_devfreq_profile = {
- .polling_ms = 50, /* ~3 frames */
- .target = lima_devfreq_target,
- .get_dev_status = lima_devfreq_get_dev_status,
- };
- void lima_devfreq_fini(struct lima_device *ldev)
- {
- struct lima_devfreq *devfreq = &ldev->devfreq;
- if (devfreq->cooling) {
- devfreq_cooling_unregister(devfreq->cooling);
- devfreq->cooling = NULL;
- }
- if (devfreq->devfreq) {
- devm_devfreq_remove_device(ldev->dev, devfreq->devfreq);
- devfreq->devfreq = NULL;
- }
- if (devfreq->opp_of_table_added) {
- dev_pm_opp_of_remove_table(ldev->dev);
- devfreq->opp_of_table_added = false;
- }
- if (devfreq->regulators_opp_table) {
- dev_pm_opp_put_regulators(devfreq->regulators_opp_table);
- devfreq->regulators_opp_table = NULL;
- }
- if (devfreq->clkname_opp_table) {
- dev_pm_opp_put_clkname(devfreq->clkname_opp_table);
- devfreq->clkname_opp_table = NULL;
- }
- }
- int lima_devfreq_init(struct lima_device *ldev)
- {
- struct thermal_cooling_device *cooling;
- struct device *dev = ldev->dev;
- struct opp_table *opp_table;
- struct devfreq *devfreq;
- struct lima_devfreq *ldevfreq = &ldev->devfreq;
- struct dev_pm_opp *opp;
- unsigned long cur_freq;
- int ret;
- if (!device_property_present(dev, "operating-points-v2"))
- /* Optional, continue without devfreq */
- return 0;
- spin_lock_init(&ldevfreq->lock);
- opp_table = dev_pm_opp_set_clkname(dev, "core");
- if (IS_ERR(opp_table)) {
- ret = PTR_ERR(opp_table);
- goto err_fini;
- }
- ldevfreq->clkname_opp_table = opp_table;
- opp_table = dev_pm_opp_set_regulators(dev,
- (const char *[]){ "mali" },
- 1);
- if (IS_ERR(opp_table)) {
- ret = PTR_ERR(opp_table);
- /* Continue if the optional regulator is missing */
- if (ret != -ENODEV)
- goto err_fini;
- } else {
- ldevfreq->regulators_opp_table = opp_table;
- }
- ret = dev_pm_opp_of_add_table(dev);
- if (ret)
- goto err_fini;
- ldevfreq->opp_of_table_added = true;
- lima_devfreq_reset(ldevfreq);
- cur_freq = clk_get_rate(ldev->clk_gpu);
- opp = devfreq_recommended_opp(dev, &cur_freq, 0);
- if (IS_ERR(opp)) {
- ret = PTR_ERR(opp);
- goto err_fini;
- }
- lima_devfreq_profile.initial_freq = cur_freq;
- dev_pm_opp_put(opp);
- devfreq = devm_devfreq_add_device(dev, &lima_devfreq_profile,
- DEVFREQ_GOV_SIMPLE_ONDEMAND, NULL);
- if (IS_ERR(devfreq)) {
- dev_err(dev, "Couldn't initialize GPU devfreq\n");
- ret = PTR_ERR(devfreq);
- goto err_fini;
- }
- ldevfreq->devfreq = devfreq;
- cooling = of_devfreq_cooling_register(dev->of_node, devfreq);
- if (IS_ERR(cooling))
- dev_info(dev, "Failed to register cooling device\n");
- else
- ldevfreq->cooling = cooling;
- return 0;
- err_fini:
- lima_devfreq_fini(ldev);
- return ret;
- }
- void lima_devfreq_record_busy(struct lima_devfreq *devfreq)
- {
- unsigned long irqflags;
- if (!devfreq->devfreq)
- return;
- spin_lock_irqsave(&devfreq->lock, irqflags);
- lima_devfreq_update_utilization(devfreq);
- devfreq->busy_count++;
- spin_unlock_irqrestore(&devfreq->lock, irqflags);
- }
- void lima_devfreq_record_idle(struct lima_devfreq *devfreq)
- {
- unsigned long irqflags;
- if (!devfreq->devfreq)
- return;
- spin_lock_irqsave(&devfreq->lock, irqflags);
- lima_devfreq_update_utilization(devfreq);
- WARN_ON(--devfreq->busy_count < 0);
- spin_unlock_irqrestore(&devfreq->lock, irqflags);
- }
- int lima_devfreq_resume(struct lima_devfreq *devfreq)
- {
- unsigned long irqflags;
- if (!devfreq->devfreq)
- return 0;
- spin_lock_irqsave(&devfreq->lock, irqflags);
- lima_devfreq_reset(devfreq);
- spin_unlock_irqrestore(&devfreq->lock, irqflags);
- return devfreq_resume_device(devfreq->devfreq);
- }
- int lima_devfreq_suspend(struct lima_devfreq *devfreq)
- {
- if (!devfreq->devfreq)
- return 0;
- return devfreq_suspend_device(devfreq->devfreq);
- }
|