1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Raspberry Pi cpufreq driver
4 *
5 * Copyright (C) 2019, Nicolas Saenz Julienne <nsaenzjulienne@suse.de>
6 */
7
8 #include <linux/clk.h>
9 #include <linux/cpu.h>
10 #include <linux/cpufreq.h>
11 #include <linux/module.h>
12 #include <linux/platform_device.h>
13 #include <linux/pm_opp.h>
14
15 #define RASPBERRYPI_FREQ_INTERVAL 100000000
16
17 static struct platform_device *cpufreq_dt;
18
raspberrypi_cpufreq_probe(struct platform_device * pdev)19 static int raspberrypi_cpufreq_probe(struct platform_device *pdev)
20 {
21 struct device *cpu_dev;
22 unsigned long min, max;
23 unsigned long rate;
24 struct clk *clk;
25 int ret;
26
27 cpu_dev = get_cpu_device(0);
28 if (!cpu_dev) {
29 pr_err("Cannot get CPU for cpufreq driver\n");
30 return -ENODEV;
31 }
32
33 clk = clk_get(cpu_dev, NULL);
34 if (IS_ERR(clk)) {
35 dev_err(cpu_dev, "Cannot get clock for CPU0\n");
36 return PTR_ERR(clk);
37 }
38
39 /*
40 * The max and min frequencies are configurable in the Raspberry Pi
41 * firmware, so we query them at runtime.
42 */
43 min = roundup(clk_round_rate(clk, 0), RASPBERRYPI_FREQ_INTERVAL);
44 max = roundup(clk_round_rate(clk, ULONG_MAX), RASPBERRYPI_FREQ_INTERVAL);
45 clk_put(clk);
46
47 for (rate = min; rate <= max; rate += RASPBERRYPI_FREQ_INTERVAL) {
48 ret = dev_pm_opp_add(cpu_dev, rate, 0);
49 if (ret)
50 goto remove_opp;
51 }
52
53 cpufreq_dt = platform_device_register_simple("cpufreq-dt", -1, NULL, 0);
54 ret = PTR_ERR_OR_ZERO(cpufreq_dt);
55 if (ret) {
56 dev_err(cpu_dev, "Failed to create platform device, %d\n", ret);
57 goto remove_opp;
58 }
59
60 return 0;
61
62 remove_opp:
63 dev_pm_opp_remove_all_dynamic(cpu_dev);
64
65 return ret;
66 }
67
raspberrypi_cpufreq_remove(struct platform_device * pdev)68 static int raspberrypi_cpufreq_remove(struct platform_device *pdev)
69 {
70 struct device *cpu_dev;
71
72 cpu_dev = get_cpu_device(0);
73 if (cpu_dev)
74 dev_pm_opp_remove_all_dynamic(cpu_dev);
75
76 platform_device_unregister(cpufreq_dt);
77
78 return 0;
79 }
80
81 /*
82 * Since the driver depends on clk-raspberrypi, which may return EPROBE_DEFER,
83 * all the activity is performed in the probe, which may be defered as well.
84 */
85 static struct platform_driver raspberrypi_cpufreq_driver = {
86 .driver = {
87 .name = "raspberrypi-cpufreq",
88 },
89 .probe = raspberrypi_cpufreq_probe,
90 .remove = raspberrypi_cpufreq_remove,
91 };
92 module_platform_driver(raspberrypi_cpufreq_driver);
93
94 MODULE_AUTHOR("Nicolas Saenz Julienne <nsaenzjulienne@suse.de");
95 MODULE_DESCRIPTION("Raspberry Pi cpufreq driver");
96 MODULE_LICENSE("GPL");
97 MODULE_ALIAS("platform:raspberrypi-cpufreq");
98
