@@ -112,8 +112,19 @@ config ARM_RK3399_DMC_DEVFREQ
help
This adds the DEVFREQ driver for the RK3399 DMC(Dynamic Memory Controller).
It sets the frequency for the memory controller and reads the usage counts
from hardware.
+config DEVFREQ_DT
+ tristate "Simple DT-based DEVFREQ Driver"
+ select DEVFREQ_GOV_USERSPACE
+ help
+ This adds a generic DT based devfreq driver for frequency management
+ of arbitrary devices with no special support.
+
+ This can be used to test arbitrary OPP tables.
+
+ Only supports the userspace governor.
+
source "drivers/devfreq/event/Kconfig"
endif # PM_DEVFREQ
@@ -10,7 +10,10 @@ obj-$(CONFIG_DEVFREQ_GOV_PASSIVE) += governor_passive.o
# DEVFREQ Drivers
obj-$(CONFIG_ARM_EXYNOS_BUS_DEVFREQ) += exynos-bus.o
obj-$(CONFIG_ARM_RK3399_DMC_DEVFREQ) += rk3399_dmc.o
obj-$(CONFIG_ARM_TEGRA_DEVFREQ) += tegra-devfreq.o
+# Generic DEVFREQ driver
+obj-$(CONFIG_DEVFREQ_DT) += devfreq-dt.o
+
# DEVFREQ Event Drivers
obj-$(CONFIG_PM_DEVFREQ_EVENT) += event/
new file mode 100644
@@ -0,0 +1,166 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (c) 2019 NXP
+ */
+
+#include <linux/clk.h>
+#include <linux/devfreq.h>
+#include <linux/devfreq-event.h>
+#include <linux/device.h>
+#include <linux/module.h>
+#include <linux/of_device.h>
+#include <linux/pm_opp.h>
+#include <linux/platform_device.h>
+#include <linux/regulator/consumer.h>
+#include <linux/slab.h>
+
+// FIXME:
+#include <../opp/opp.h>
+
+struct devfreq_dt {
+ struct device *dev;
+ struct devfreq *devfreq;
+ struct mutex lock;
+
+ unsigned long curr_freq;
+};
+
+/*
+ * Must necessary function for devfreq simple-ondemand governor
+ */
+static int devfreq_dt_target(struct device *dev, unsigned long *freq, u32 flags)
+{
+ struct devfreq_dt *priv = dev_get_drvdata(dev);
+ struct dev_pm_opp *new_opp;
+ unsigned long new_freq;
+ int ret = 0;
+
+ mutex_lock(&priv->lock);
+
+ new_opp = devfreq_recommended_opp(dev, freq, flags);
+ if (IS_ERR(new_opp)) {
+ ret = PTR_ERR(new_opp);
+ dev_err(dev, "failed to get recommended opp: %d\n", ret);
+ goto out;
+ }
+
+ new_freq = dev_pm_opp_get_freq(new_opp);
+ dev_dbg(dev, "try frequency %luHz for %luHz", new_freq, *freq);
+ ret = dev_pm_opp_set_rate(priv->dev, new_freq);
+ if (ret == 0) {
+ dev_info(dev, "set frequency %luHz for %luHz", new_freq, *freq);
+ priv->curr_freq = new_freq;
+ } else {
+ dev_err(dev, "fail set frequency %luHz for %luHz", new_freq, *freq);
+ }
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int devfreq_dt_get_cur_freq(struct device *dev, unsigned long *freq)
+{
+ struct opp_table *tab;
+ struct clk* clk;
+
+ tab = dev_pm_opp_get_opp_table(dev);
+ clk = tab->clk;
+ *freq = clk_get_rate(tab->clk);
+
+ return 0;
+}
+
+static int devfreq_dt_get_dev_status(struct device *dev,
+ struct devfreq_dev_status *stat)
+{
+ struct devfreq_dt *priv = dev_get_drvdata(dev);
+
+ stat->current_frequency = priv->curr_freq;
+ stat->busy_time = 100;
+ stat->total_time = 0;
+
+ return 0;
+}
+
+static void devfreq_dt_exit(struct device *dev)
+{
+ return dev_pm_opp_of_remove_table(dev);
+}
+
+static int devfreq_dt_probe(struct platform_device *pdev)
+{
+ struct device *dev = &pdev->dev;
+ struct devfreq_dev_profile *profile;
+ struct devfreq_dt *priv;
+ int ret;
+
+ priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
+ if (!priv)
+ return -ENOMEM;
+ mutex_init(&priv->lock);
+ priv->dev = &pdev->dev;
+ platform_set_drvdata(pdev, priv);
+
+ /* Parse the device-tree to get the resource information */
+ /* Get the freq and voltage from OPP table to scale the priv freq */
+ ret = dev_pm_opp_of_add_table(dev);
+ if (ret < 0) {
+ dev_err(dev, "failed to get OPP table\n");
+ return ret;
+ }
+
+ profile = devm_kzalloc(dev, sizeof(*profile), GFP_KERNEL);
+ if (!profile) {
+ ret = -ENOMEM;
+ goto err_remove_table;
+ }
+
+ profile->polling_ms = 1000;
+ profile->target = devfreq_dt_target;
+ profile->get_dev_status = devfreq_dt_get_dev_status;
+ profile->exit = devfreq_dt_exit;
+ profile->get_cur_freq = devfreq_dt_get_cur_freq;
+ devfreq_dt_get_cur_freq(dev, &profile->initial_freq);
+
+ priv->devfreq = devm_devfreq_add_device(dev, profile,
+ DEVFREQ_GOV_USERSPACE,
+ NULL);
+ if (IS_ERR(priv->devfreq)) {
+ dev_err(dev, "failed to add devfreq device\n");
+ ret = PTR_ERR(priv->devfreq);
+ goto err_remove_table;
+ }
+
+ return 0;
+
+err_remove_table:
+ dev_pm_opp_of_remove_table(dev);
+ return ret;
+}
+
+static void devfreq_dt_shutdown(struct platform_device *pdev)
+{
+ struct devfreq_dt *priv = dev_get_drvdata(&pdev->dev);
+
+ devfreq_suspend_device(priv->devfreq);
+}
+
+static const struct of_device_id devfreq_dt_of_match[] = {
+ { .compatible = "generic-devfreq", },
+ { /* sentinel */ },
+};
+MODULE_DEVICE_TABLE(of, devfreq_dt_of_match);
+
+static struct platform_driver devfreq_dt_platdrv = {
+ .probe = devfreq_dt_probe,
+ .shutdown = devfreq_dt_shutdown,
+ .driver = {
+ .name = "devfreq-dt",
+ .of_match_table = of_match_ptr(devfreq_dt_of_match),
+ },
+};
+module_platform_driver(devfreq_dt_platdrv);
+
+MODULE_DESCRIPTION("Generic devfreq-dt driver");
+MODULE_LICENSE("GPL v2");
This is a generic devfreq driver which switches frequencies from an OPP table based on userspace requests. This can be used to testing frequency switching on buses or devices which can be manipulated with a single "clk" but don't otherwise have any smarter complex targeting logic or performance counters. It relies entirely on the dev_pm_opp subsystem and be used to test arbitrary opp tables. Signed-off-by: Leonard Crestez <leonard.crestez@nxp.com> --- I used this to test imx8mm dram freq switching in complete isolation: https://patchwork.kernel.org/patch/10968303/ Perhaps it could be useful for others? It is somewhat analogous to cpufreq-dt. It might be possible to pair this with a generic devfreq event driver based entirely on perf. drivers/devfreq/Kconfig | 11 +++ drivers/devfreq/Makefile | 3 + drivers/devfreq/devfreq-dt.c | 166 +++++++++++++++++++++++++++++++++++ 3 files changed, 180 insertions(+) create mode 100644 drivers/devfreq/devfreq-dt.c