Blame view

kernel/linux-rt-4.4.41/drivers/soc/tegra/fuse/speedo-tegra20.c 3.07 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
  /*
   * Copyright (c) 2012-2014, NVIDIA CORPORATION.  All rights reserved.
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms and conditions of the GNU General Public License,
   * version 2, as published by the Free Software Foundation.
   *
   * This program is distributed in the hope it will be useful, but WITHOUT
   * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
   * more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program.  If not, see <http://www.gnu.org/licenses/>.
   */
  
  #include <linux/bug.h>
  #include <linux/device.h>
  #include <linux/kernel.h>
  
  #include <soc/tegra/fuse.h>
  
  #include "fuse.h"
  
  #define CPU_SPEEDO_LSBIT		20
  #define CPU_SPEEDO_MSBIT		29
  #define CPU_SPEEDO_REDUND_LSBIT		30
  #define CPU_SPEEDO_REDUND_MSBIT		39
  #define CPU_SPEEDO_REDUND_OFFS	(CPU_SPEEDO_REDUND_MSBIT - CPU_SPEEDO_MSBIT)
  
  #define SOC_SPEEDO_LSBIT		40
  #define SOC_SPEEDO_MSBIT		47
  #define SOC_SPEEDO_REDUND_LSBIT		48
  #define SOC_SPEEDO_REDUND_MSBIT		55
  #define SOC_SPEEDO_REDUND_OFFS	(SOC_SPEEDO_REDUND_MSBIT - SOC_SPEEDO_MSBIT)
  
  #define SPEEDO_MULT			4
  
  #define PROCESS_CORNERS_NUM		4
  
  #define SPEEDO_ID_SELECT_0(rev)		((rev) <= 2)
  #define SPEEDO_ID_SELECT_1(sku)		\
  	(((sku) != 20) && ((sku) != 23) && ((sku) != 24) && \
  	 ((sku) != 27) && ((sku) != 28))
  
  enum {
  	SPEEDO_ID_0,
  	SPEEDO_ID_1,
  	SPEEDO_ID_2,
  	SPEEDO_ID_COUNT,
  };
  
  static const u32 __initconst cpu_process_speedos[][PROCESS_CORNERS_NUM] = {
  	{315, 366, 420, UINT_MAX},
  	{303, 368, 419, UINT_MAX},
  	{316, 331, 383, UINT_MAX},
  };
  
  static const u32 __initconst soc_process_speedos[][PROCESS_CORNERS_NUM] = {
  	{165, 195, 224, UINT_MAX},
  	{165, 195, 224, UINT_MAX},
  	{165, 195, 224, UINT_MAX},
  };
  
  void __init tegra20_init_speedo_data(struct tegra_sku_info *sku_info)
  {
  	u32 reg;
  	u32 val;
  	int i;
  
  	BUILD_BUG_ON(ARRAY_SIZE(cpu_process_speedos) != SPEEDO_ID_COUNT);
  	BUILD_BUG_ON(ARRAY_SIZE(soc_process_speedos) != SPEEDO_ID_COUNT);
  
  	if (SPEEDO_ID_SELECT_0(sku_info->revision))
  		sku_info->soc_speedo_id = SPEEDO_ID_0;
  	else if (SPEEDO_ID_SELECT_1(sku_info->sku_id))
  		sku_info->soc_speedo_id = SPEEDO_ID_1;
  	else
  		sku_info->soc_speedo_id = SPEEDO_ID_2;
  
  	val = 0;
  	for (i = CPU_SPEEDO_MSBIT; i >= CPU_SPEEDO_LSBIT; i--) {
  		reg = tegra_fuse_read_spare(i) |
  			tegra_fuse_read_spare(i + CPU_SPEEDO_REDUND_OFFS);
  		val = (val << 1) | (reg & 0x1);
  	}
  	val = val * SPEEDO_MULT;
  	pr_debug("Tegra CPU speedo value %u
  ", val);
  
  	for (i = 0; i < (PROCESS_CORNERS_NUM - 1); i++) {
  		if (val <= cpu_process_speedos[sku_info->soc_speedo_id][i])
  			break;
  	}
  	sku_info->cpu_process_id = i;
  
  	val = 0;
  	for (i = SOC_SPEEDO_MSBIT; i >= SOC_SPEEDO_LSBIT; i--) {
  		reg = tegra_fuse_read_spare(i) |
  			tegra_fuse_read_spare(i + SOC_SPEEDO_REDUND_OFFS);
  		val = (val << 1) | (reg & 0x1);
  	}
  	val = val * SPEEDO_MULT;
  	pr_debug("Core speedo value %u
  ", val);
  
  	for (i = 0; i < (PROCESS_CORNERS_NUM - 1); i++) {
  		if (val <= soc_process_speedos[sku_info->soc_speedo_id][i])
  			break;
  	}
  	sku_info->soc_process_id = i;
  }