Commit | Line | Data |
---|---|---|
9c92ab61 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
7056d423 | 2 | /* |
7056d423 CC |
3 | * Copyright (C) 2010 Google, Inc. |
4 | * | |
5 | * Author: | |
6 | * Colin Cross <ccross@google.com> | |
7 | * Based on arch/arm/plat-omap/cpu-omap.c, (C) 2005 Nokia Corporation | |
7056d423 CC |
8 | */ |
9 | ||
9ce27463 DO |
10 | #include <linux/bits.h> |
11 | #include <linux/cpu.h> | |
7056d423 | 12 | #include <linux/err.h> |
9a25ba9a DO |
13 | #include <linux/init.h> |
14 | #include <linux/module.h> | |
9ce27463 | 15 | #include <linux/of_device.h> |
dc628cdf | 16 | #include <linux/platform_device.h> |
9ce27463 | 17 | #include <linux/pm_opp.h> |
9a25ba9a | 18 | #include <linux/types.h> |
7056d423 | 19 | |
9ce27463 DO |
20 | #include <soc/tegra/common.h> |
21 | #include <soc/tegra/fuse.h> | |
7056d423 | 22 | |
9ce27463 | 23 | static bool cpu0_node_has_opp_v2_prop(void) |
00917ddc | 24 | { |
9ce27463 DO |
25 | struct device_node *np = of_cpu_device_node_get(0); |
26 | bool ret = false; | |
00917ddc | 27 | |
9ce27463 DO |
28 | if (of_get_property(np, "operating-points-v2", NULL)) |
29 | ret = true; | |
ce32ddaa | 30 | |
9ce27463 | 31 | of_node_put(np); |
ce32ddaa SW |
32 | return ret; |
33 | } | |
34 | ||
763ec5da DO |
35 | static void tegra20_cpufreq_put_supported_hw(void *opp_table) |
36 | { | |
37 | dev_pm_opp_put_supported_hw(opp_table); | |
38 | } | |
39 | ||
40 | static void tegra20_cpufreq_dt_unregister(void *cpufreq_dt) | |
41 | { | |
42 | platform_device_unregister(cpufreq_dt); | |
43 | } | |
44 | ||
dc628cdf | 45 | static int tegra20_cpufreq_probe(struct platform_device *pdev) |
7056d423 | 46 | { |
9ce27463 DO |
47 | struct platform_device *cpufreq_dt; |
48 | struct opp_table *opp_table; | |
49 | struct device *cpu_dev; | |
50 | u32 versions[2]; | |
64cd64e7 DO |
51 | int err; |
52 | ||
9ce27463 DO |
53 | if (!cpu0_node_has_opp_v2_prop()) { |
54 | dev_err(&pdev->dev, "operating points not found\n"); | |
55 | dev_err(&pdev->dev, "please update your device tree\n"); | |
56 | return -ENODEV; | |
57 | } | |
58 | ||
59 | if (of_machine_is_compatible("nvidia,tegra20")) { | |
60 | versions[0] = BIT(tegra_sku_info.cpu_process_id); | |
61 | versions[1] = BIT(tegra_sku_info.soc_speedo_id); | |
62 | } else { | |
63 | versions[0] = BIT(tegra_sku_info.cpu_process_id); | |
64 | versions[1] = BIT(tegra_sku_info.cpu_speedo_id); | |
65 | } | |
66 | ||
67 | dev_info(&pdev->dev, "hardware version 0x%x 0x%x\n", | |
68 | versions[0], versions[1]); | |
a413d2ce | 69 | |
9ce27463 DO |
70 | cpu_dev = get_cpu_device(0); |
71 | if (WARN_ON(!cpu_dev)) | |
72 | return -ENODEV; | |
c26cefd0 | 73 | |
9ce27463 DO |
74 | opp_table = dev_pm_opp_set_supported_hw(cpu_dev, versions, 2); |
75 | err = PTR_ERR_OR_ZERO(opp_table); | |
76 | if (err) { | |
77 | dev_err(&pdev->dev, "failed to set supported hw: %d\n", err); | |
78 | return err; | |
64cd64e7 | 79 | } |
c26cefd0 | 80 | |
763ec5da DO |
81 | err = devm_add_action_or_reset(&pdev->dev, |
82 | tegra20_cpufreq_put_supported_hw, | |
83 | opp_table); | |
84 | if (err) | |
85 | return err; | |
86 | ||
9ce27463 DO |
87 | cpufreq_dt = platform_device_register_simple("cpufreq-dt", -1, NULL, 0); |
88 | err = PTR_ERR_OR_ZERO(cpufreq_dt); | |
89 | if (err) { | |
90 | dev_err(&pdev->dev, | |
91 | "failed to create cpufreq-dt device: %d\n", err); | |
763ec5da | 92 | return err; |
64cd64e7 DO |
93 | } |
94 | ||
763ec5da DO |
95 | err = devm_add_action_or_reset(&pdev->dev, |
96 | tegra20_cpufreq_dt_unregister, | |
97 | cpufreq_dt); | |
98 | if (err) | |
99 | return err; | |
dc628cdf DO |
100 | |
101 | return 0; | |
7056d423 CC |
102 | } |
103 | ||
dc628cdf DO |
104 | static struct platform_driver tegra20_cpufreq_driver = { |
105 | .probe = tegra20_cpufreq_probe, | |
dc628cdf DO |
106 | .driver = { |
107 | .name = "tegra20-cpufreq", | |
108 | }, | |
109 | }; | |
110 | module_platform_driver(tegra20_cpufreq_driver); | |
111 | ||
112 | MODULE_ALIAS("platform:tegra20-cpufreq"); | |
7056d423 | 113 | MODULE_AUTHOR("Colin Cross <ccross@android.com>"); |
49640277 | 114 | MODULE_DESCRIPTION("NVIDIA Tegra20 cpufreq driver"); |
7056d423 | 115 | MODULE_LICENSE("GPL"); |