Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include <linux/cpu.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/clk.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/pm_opp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) static const struct of_device_id machines[] __initconst = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 	{ .compatible = "sigma,tango4" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 	{ /* sentinel */ }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) static int __init tango_cpufreq_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	struct device *cpu_dev = get_cpu_device(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	unsigned long max_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	struct clk *cpu_clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	void *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	if (!of_match_node(machines, of_root))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	cpu_clk = clk_get(cpu_dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	if (IS_ERR(cpu_clk))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	max_freq = clk_get_rate(cpu_clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	dev_pm_opp_add(cpu_dev, max_freq / 1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	dev_pm_opp_add(cpu_dev, max_freq / 2, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	dev_pm_opp_add(cpu_dev, max_freq / 3, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	dev_pm_opp_add(cpu_dev, max_freq / 5, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	dev_pm_opp_add(cpu_dev, max_freq / 9, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	res = platform_device_register_data(NULL, "cpufreq-dt", -1, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	return PTR_ERR_OR_ZERO(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) device_initcall(tango_cpufreq_init);