xref: /linux/drivers/soc/tegra/fuse/speedo-tegra114.c (revision 75bf465f0bc33e9b776a46d6a1b9b990f5fb7c37)
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