1*9952f691SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2783c8f4cSPeter De Schrijver /*
3783c8f4cSPeter De Schrijver * Copyright (c) 2013-2014, NVIDIA CORPORATION. All rights reserved.
4783c8f4cSPeter De Schrijver */
5783c8f4cSPeter De Schrijver
6783c8f4cSPeter De Schrijver #include <linux/bug.h>
7783c8f4cSPeter De Schrijver #include <linux/device.h>
8783c8f4cSPeter De Schrijver #include <linux/kernel.h>
9783c8f4cSPeter De Schrijver
10783c8f4cSPeter De Schrijver #include <soc/tegra/fuse.h>
11783c8f4cSPeter De Schrijver
12783c8f4cSPeter De Schrijver #include "fuse.h"
13783c8f4cSPeter De Schrijver
1403b3f4c8SThierry Reding #define SOC_PROCESS_CORNERS 2
15783c8f4cSPeter De Schrijver #define CPU_PROCESS_CORNERS 2
16783c8f4cSPeter De Schrijver
17783c8f4cSPeter De Schrijver enum {
18783c8f4cSPeter De Schrijver THRESHOLD_INDEX_0,
19783c8f4cSPeter De Schrijver THRESHOLD_INDEX_1,
20783c8f4cSPeter De Schrijver THRESHOLD_INDEX_COUNT,
21783c8f4cSPeter De Schrijver };
22783c8f4cSPeter De Schrijver
2303b3f4c8SThierry Reding static const u32 __initconst soc_process_speedos[][SOC_PROCESS_CORNERS] = {
24783c8f4cSPeter De Schrijver {1123, UINT_MAX},
25783c8f4cSPeter De Schrijver {0, UINT_MAX},
26783c8f4cSPeter De Schrijver };
27783c8f4cSPeter De Schrijver
28783c8f4cSPeter De Schrijver static const u32 __initconst cpu_process_speedos[][CPU_PROCESS_CORNERS] = {
29783c8f4cSPeter De Schrijver {1695, UINT_MAX},
30783c8f4cSPeter De Schrijver {0, UINT_MAX},
31783c8f4cSPeter De Schrijver };
32783c8f4cSPeter De Schrijver
rev_sku_to_speedo_ids(struct tegra_sku_info * sku_info,int * threshold)33783c8f4cSPeter De Schrijver static void __init rev_sku_to_speedo_ids(struct tegra_sku_info *sku_info,
34783c8f4cSPeter De Schrijver int *threshold)
35783c8f4cSPeter De Schrijver {
36783c8f4cSPeter De Schrijver u32 tmp;
37783c8f4cSPeter De Schrijver u32 sku = sku_info->sku_id;
38783c8f4cSPeter De Schrijver enum tegra_revision rev = sku_info->revision;
39783c8f4cSPeter De Schrijver
40783c8f4cSPeter De Schrijver switch (sku) {
41783c8f4cSPeter De Schrijver case 0x00:
42783c8f4cSPeter De Schrijver case 0x10:
43783c8f4cSPeter De Schrijver case 0x05:
44783c8f4cSPeter De Schrijver case 0x06:
45783c8f4cSPeter De Schrijver sku_info->cpu_speedo_id = 1;
46783c8f4cSPeter De Schrijver sku_info->soc_speedo_id = 0;
47783c8f4cSPeter De Schrijver *threshold = THRESHOLD_INDEX_0;
48783c8f4cSPeter De Schrijver break;
49783c8f4cSPeter De Schrijver
50783c8f4cSPeter De Schrijver case 0x03:
51783c8f4cSPeter De Schrijver case 0x04:
52783c8f4cSPeter De Schrijver sku_info->cpu_speedo_id = 2;
53783c8f4cSPeter De Schrijver sku_info->soc_speedo_id = 1;
54783c8f4cSPeter De Schrijver *threshold = THRESHOLD_INDEX_1;
55783c8f4cSPeter De Schrijver break;
56783c8f4cSPeter De Schrijver
57783c8f4cSPeter De Schrijver default:
58783c8f4cSPeter De Schrijver pr_err("Tegra Unknown SKU %d\n", sku);
59783c8f4cSPeter De Schrijver sku_info->cpu_speedo_id = 0;
60783c8f4cSPeter De Schrijver sku_info->soc_speedo_id = 0;
61783c8f4cSPeter De Schrijver *threshold = THRESHOLD_INDEX_0;
62783c8f4cSPeter De Schrijver break;
63783c8f4cSPeter De Schrijver }
64783c8f4cSPeter De Schrijver
65783c8f4cSPeter De Schrijver if (rev == TEGRA_REVISION_A01) {
667e939de1SThierry Reding tmp = tegra_fuse_read_early(0x270) << 1;
677e939de1SThierry Reding tmp |= tegra_fuse_read_early(0x26c);
68783c8f4cSPeter De Schrijver if (!tmp)
69783c8f4cSPeter De Schrijver sku_info->cpu_speedo_id = 0;
70783c8f4cSPeter De Schrijver }
71783c8f4cSPeter De Schrijver }
72783c8f4cSPeter De Schrijver
tegra114_init_speedo_data(struct tegra_sku_info * sku_info)73783c8f4cSPeter De Schrijver void __init tegra114_init_speedo_data(struct tegra_sku_info *sku_info)
74783c8f4cSPeter De Schrijver {
75783c8f4cSPeter De Schrijver u32 cpu_speedo_val;
7603b3f4c8SThierry Reding u32 soc_speedo_val;
77783c8f4cSPeter De Schrijver int threshold;
78783c8f4cSPeter De Schrijver int i;
79783c8f4cSPeter De Schrijver
80783c8f4cSPeter De Schrijver BUILD_BUG_ON(ARRAY_SIZE(cpu_process_speedos) !=
81783c8f4cSPeter De Schrijver THRESHOLD_INDEX_COUNT);
8203b3f4c8SThierry Reding BUILD_BUG_ON(ARRAY_SIZE(soc_process_speedos) !=
83783c8f4cSPeter De Schrijver THRESHOLD_INDEX_COUNT);
84783c8f4cSPeter De Schrijver
85783c8f4cSPeter De Schrijver rev_sku_to_speedo_ids(sku_info, &threshold);
86783c8f4cSPeter De Schrijver
877e939de1SThierry Reding cpu_speedo_val = tegra_fuse_read_early(0x12c) + 1024;
8803b3f4c8SThierry Reding soc_speedo_val = tegra_fuse_read_early(0x134);
89783c8f4cSPeter De Schrijver
90783c8f4cSPeter De Schrijver for (i = 0; i < CPU_PROCESS_CORNERS; i++)
91783c8f4cSPeter De Schrijver if (cpu_speedo_val < cpu_process_speedos[threshold][i])
92783c8f4cSPeter De Schrijver break;
93783c8f4cSPeter De Schrijver sku_info->cpu_process_id = i;
94783c8f4cSPeter De Schrijver
9503b3f4c8SThierry Reding for (i = 0; i < SOC_PROCESS_CORNERS; i++)
9603b3f4c8SThierry Reding if (soc_speedo_val < soc_process_speedos[threshold][i])
97783c8f4cSPeter De Schrijver break;
9803b3f4c8SThierry Reding sku_info->soc_process_id = i;
99783c8f4cSPeter De Schrijver }
100