1
2
3
4
5
6#include <linux/bug.h>
7#include <linux/device.h>
8#include <linux/kernel.h>
9
10#include <soc/tegra/fuse.h>
11
12#include "fuse.h"
13
14#define SOC_PROCESS_CORNERS 1
15#define CPU_PROCESS_CORNERS 6
16
17#define FUSE_SPEEDO_CALIB_0 0x14
18#define FUSE_PACKAGE_INFO 0XFC
19#define FUSE_TEST_PROG_VER 0X28
20
21#define G_SPEEDO_BIT_MINUS1 58
22#define G_SPEEDO_BIT_MINUS1_R 59
23#define G_SPEEDO_BIT_MINUS2 60
24#define G_SPEEDO_BIT_MINUS2_R 61
25#define LP_SPEEDO_BIT_MINUS1 62
26#define LP_SPEEDO_BIT_MINUS1_R 63
27#define LP_SPEEDO_BIT_MINUS2 64
28#define LP_SPEEDO_BIT_MINUS2_R 65
29
30enum {
31 THRESHOLD_INDEX_0,
32 THRESHOLD_INDEX_1,
33 THRESHOLD_INDEX_2,
34 THRESHOLD_INDEX_3,
35 THRESHOLD_INDEX_4,
36 THRESHOLD_INDEX_5,
37 THRESHOLD_INDEX_6,
38 THRESHOLD_INDEX_7,
39 THRESHOLD_INDEX_8,
40 THRESHOLD_INDEX_9,
41 THRESHOLD_INDEX_10,
42 THRESHOLD_INDEX_11,
43 THRESHOLD_INDEX_COUNT,
44};
45
46static const u32 __initconst soc_process_speedos[][SOC_PROCESS_CORNERS] = {
47 {180},
48 {170},
49 {195},
50 {180},
51 {168},
52 {192},
53 {180},
54 {170},
55 {195},
56 {180},
57 {180},
58 {180},
59};
60
61static const u32 __initconst cpu_process_speedos[][CPU_PROCESS_CORNERS] = {
62 {306, 338, 360, 376, UINT_MAX},
63 {295, 336, 358, 375, UINT_MAX},
64 {325, 325, 358, 375, UINT_MAX},
65 {325, 325, 358, 375, UINT_MAX},
66 {292, 324, 348, 364, UINT_MAX},
67 {324, 324, 348, 364, UINT_MAX},
68 {324, 324, 348, 364, UINT_MAX},
69 {295, 336, 358, 375, UINT_MAX},
70 {358, 358, 358, 358, 397, UINT_MAX},
71 {364, 364, 364, 364, 397, UINT_MAX},
72 {295, 336, 358, 375, 391, UINT_MAX},
73 {295, 336, 358, 375, 391, UINT_MAX},
74};
75
76static int threshold_index __initdata;
77
78static void __init fuse_speedo_calib(u32 *speedo_g, u32 *speedo_lp)
79{
80 u32 reg;
81 int ate_ver;
82 int bit_minus1;
83 int bit_minus2;
84
85 reg = tegra_fuse_read_early(FUSE_SPEEDO_CALIB_0);
86
87 *speedo_lp = (reg & 0xFFFF) * 4;
88 *speedo_g = ((reg >> 16) & 0xFFFF) * 4;
89
90 ate_ver = tegra_fuse_read_early(FUSE_TEST_PROG_VER);
91 pr_debug("Tegra ATE prog ver %d.%d\n", ate_ver/10, ate_ver%10);
92
93 if (ate_ver >= 26) {
94 bit_minus1 = tegra_fuse_read_spare(LP_SPEEDO_BIT_MINUS1);
95 bit_minus1 |= tegra_fuse_read_spare(LP_SPEEDO_BIT_MINUS1_R);
96 bit_minus2 = tegra_fuse_read_spare(LP_SPEEDO_BIT_MINUS2);
97 bit_minus2 |= tegra_fuse_read_spare(LP_SPEEDO_BIT_MINUS2_R);
98 *speedo_lp |= (bit_minus1 << 1) | bit_minus2;
99
100 bit_minus1 = tegra_fuse_read_spare(G_SPEEDO_BIT_MINUS1);
101 bit_minus1 |= tegra_fuse_read_spare(G_SPEEDO_BIT_MINUS1_R);
102 bit_minus2 = tegra_fuse_read_spare(G_SPEEDO_BIT_MINUS2);
103 bit_minus2 |= tegra_fuse_read_spare(G_SPEEDO_BIT_MINUS2_R);
104 *speedo_g |= (bit_minus1 << 1) | bit_minus2;
105 } else {
106 *speedo_lp |= 0x3;
107 *speedo_g |= 0x3;
108 }
109}
110
111static void __init rev_sku_to_speedo_ids(struct tegra_sku_info *sku_info)
112{
113 int package_id = tegra_fuse_read_early(FUSE_PACKAGE_INFO) & 0x0F;
114
115 switch (sku_info->revision) {
116 case TEGRA_REVISION_A01:
117 sku_info->cpu_speedo_id = 0;
118 sku_info->soc_speedo_id = 0;
119 threshold_index = THRESHOLD_INDEX_0;
120 break;
121 case TEGRA_REVISION_A02:
122 case TEGRA_REVISION_A03:
123 switch (sku_info->sku_id) {
124 case 0x87:
125 case 0x82:
126 sku_info->cpu_speedo_id = 1;
127 sku_info->soc_speedo_id = 1;
128 threshold_index = THRESHOLD_INDEX_1;
129 break;
130 case 0x81:
131 switch (package_id) {
132 case 1:
133 sku_info->cpu_speedo_id = 2;
134 sku_info->soc_speedo_id = 2;
135 threshold_index = THRESHOLD_INDEX_2;
136 break;
137 case 2:
138 sku_info->cpu_speedo_id = 4;
139 sku_info->soc_speedo_id = 1;
140 threshold_index = THRESHOLD_INDEX_7;
141 break;
142 default:
143 pr_err("Tegra Unknown pkg %d\n", package_id);
144 break;
145 }
146 break;
147 case 0x80:
148 switch (package_id) {
149 case 1:
150 sku_info->cpu_speedo_id = 5;
151 sku_info->soc_speedo_id = 2;
152 threshold_index = THRESHOLD_INDEX_8;
153 break;
154 case 2:
155 sku_info->cpu_speedo_id = 6;
156 sku_info->soc_speedo_id = 2;
157 threshold_index = THRESHOLD_INDEX_9;
158 break;
159 default:
160 pr_err("Tegra Unknown pkg %d\n", package_id);
161 break;
162 }
163 break;
164 case 0x83:
165 switch (package_id) {
166 case 1:
167 sku_info->cpu_speedo_id = 7;
168 sku_info->soc_speedo_id = 1;
169 threshold_index = THRESHOLD_INDEX_10;
170 break;
171 case 2:
172 sku_info->cpu_speedo_id = 3;
173 sku_info->soc_speedo_id = 2;
174 threshold_index = THRESHOLD_INDEX_3;
175 break;
176 default:
177 pr_err("Tegra Unknown pkg %d\n", package_id);
178 break;
179 }
180 break;
181 case 0x8F:
182 sku_info->cpu_speedo_id = 8;
183 sku_info->soc_speedo_id = 1;
184 threshold_index = THRESHOLD_INDEX_11;
185 break;
186 case 0x08:
187 sku_info->cpu_speedo_id = 1;
188 sku_info->soc_speedo_id = 1;
189 threshold_index = THRESHOLD_INDEX_4;
190 break;
191 case 0x02:
192 sku_info->cpu_speedo_id = 2;
193 sku_info->soc_speedo_id = 2;
194 threshold_index = THRESHOLD_INDEX_5;
195 break;
196 case 0x04:
197 sku_info->cpu_speedo_id = 3;
198 sku_info->soc_speedo_id = 2;
199 threshold_index = THRESHOLD_INDEX_6;
200 break;
201 case 0:
202 switch (package_id) {
203 case 1:
204 sku_info->cpu_speedo_id = 2;
205 sku_info->soc_speedo_id = 2;
206 threshold_index = THRESHOLD_INDEX_2;
207 break;
208 case 2:
209 sku_info->cpu_speedo_id = 3;
210 sku_info->soc_speedo_id = 2;
211 threshold_index = THRESHOLD_INDEX_3;
212 break;
213 default:
214 pr_err("Tegra Unknown pkg %d\n", package_id);
215 break;
216 }
217 break;
218 default:
219 pr_warn("Tegra Unknown SKU %d\n", sku_info->sku_id);
220 sku_info->cpu_speedo_id = 0;
221 sku_info->soc_speedo_id = 0;
222 threshold_index = THRESHOLD_INDEX_0;
223 break;
224 }
225 break;
226 default:
227 pr_warn("Tegra Unknown chip rev %d\n", sku_info->revision);
228 sku_info->cpu_speedo_id = 0;
229 sku_info->soc_speedo_id = 0;
230 threshold_index = THRESHOLD_INDEX_0;
231 break;
232 }
233}
234
235void __init tegra30_init_speedo_data(struct tegra_sku_info *sku_info)
236{
237 u32 cpu_speedo_val;
238 u32 soc_speedo_val;
239 int i;
240
241 BUILD_BUG_ON(ARRAY_SIZE(cpu_process_speedos) !=
242 THRESHOLD_INDEX_COUNT);
243 BUILD_BUG_ON(ARRAY_SIZE(soc_process_speedos) !=
244 THRESHOLD_INDEX_COUNT);
245
246
247 rev_sku_to_speedo_ids(sku_info);
248 fuse_speedo_calib(&cpu_speedo_val, &soc_speedo_val);
249 pr_debug("Tegra CPU speedo value %u\n", cpu_speedo_val);
250 pr_debug("Tegra Core speedo value %u\n", soc_speedo_val);
251
252 for (i = 0; i < CPU_PROCESS_CORNERS; i++) {
253 if (cpu_speedo_val < cpu_process_speedos[threshold_index][i])
254 break;
255 }
256 sku_info->cpu_process_id = i - 1;
257
258 if (sku_info->cpu_process_id == -1) {
259 pr_warn("Tegra CPU speedo value %3d out of range",
260 cpu_speedo_val);
261 sku_info->cpu_process_id = 0;
262 sku_info->cpu_speedo_id = 1;
263 }
264
265 for (i = 0; i < SOC_PROCESS_CORNERS; i++) {
266 if (soc_speedo_val < soc_process_speedos[threshold_index][i])
267 break;
268 }
269 sku_info->soc_process_id = i - 1;
270
271 if (sku_info->soc_process_id == -1) {
272 pr_warn("Tegra SoC speedo value %3d out of range",
273 soc_speedo_val);
274 sku_info->soc_process_id = 0;
275 sku_info->soc_speedo_id = 1;
276 }
277}
278
