1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2019 Samsung Electronics Co., Ltd.
4  *	      http://www.samsung.com/
5  *
6  * Samsung Exynos 5422 SoC Adaptive Supply Voltage support
7  */
8 
9 #include <linux/bitrev.h>
10 #include <linux/errno.h>
11 #include <linux/regmap.h>
12 #include <linux/soc/samsung/exynos-chipid.h>
13 #include <linux/slab.h>
14 
15 #include "exynos-asv.h"
16 #include "exynos5422-asv.h"
17 
18 #define ASV_GROUPS_NUM		14
19 #define ASV_ARM_DVFS_NUM	20
20 #define ASV_ARM_BIN2_DVFS_NUM	17
21 #define ASV_KFC_DVFS_NUM	14
22 #define ASV_KFC_BIN2_DVFS_NUM	12
23 
24 /*
25  * This array is a set of 4 ASV data tables, first column of each ASV table
26  * contains frequency value in MHz and subsequent columns contain the CPU
27  * cluster's supply voltage values in uV.
28  * In order to create a set of OPPs for specific SoC revision one of the voltage
29  * columns (1...14) from one of the tables (0...3) is selected during
30  * initialization. There are separate ASV tables for the big (ARM) and little
31  * (KFC) CPU cluster. Only OPPs which are already defined in devicetree
32  * will be updated.
33  */
34 
35 static const u32 asv_arm_table[][ASV_ARM_DVFS_NUM][ASV_GROUPS_NUM + 1] = {
36 {
37 	/* ARM 0, 1 */
38 	{ 2100,    1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
39 	  1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
40 	{ 2000,    1312500, 1312500, 1300000, 1287500, 1275000, 1262500, 1250000,
41 	  1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
42 	{ 1900,    1250000, 1237500, 1225000, 1212500, 1200000, 1187500, 1175000,
43 	  1162500, 1150000, 1162500, 1150000, 1137500, 1125000, 1112500 },
44 	{ 1800,    1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
45 	  1112500, 1100000, 1112500, 1100000, 1087500, 1075000, 1062500 },
46 	{ 1700,    1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
47 	  1075000, 1062500, 1075000, 1062500, 1050000, 1037500, 1025000 },
48 	{ 1600,    1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
49 	  1037500, 1025000, 1037500, 1025000, 1012500, 1000000, 987500 },
50 	{ 1500,    1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
51 	  1000000, 987500,  1000000, 987500,  975000,  962500,  950000 },
52 	{ 1400,    1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
53 	  975000,  962500,  975000,  962500,  950000,  937500,  925000 },
54 	{ 1300,    1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000,
55 	  962500,  950000,  962500,  950000,  937500,  925000,  912500 },
56 	{ 1200,    1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
57 	  937500,  925000,  937500,  925000,  912500,  900000,  900000 },
58 	{ 1100,    1000000, 987500,  975000,  962500,  950000,  937500,  925000,
59 	  912500,  900000,  900000,  900000,  900000,  900000,  900000 },
60 	{ 1000,    975000,  962500,  950000,  937500,  925000,  912500,  900000,
61 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
62 	{ 900,     950000,  937500,  925000,  912500,  900000,  900000,  900000,
63 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
64 	{ 800,     925000,  912500,  900000,  900000,  900000,  900000,  900000,
65 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
66 	{ 700,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
67 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
68 	{ 600,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
69 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
70 	{ 500,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
71 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
72 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
73 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
74 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
75 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
76 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
77 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
78 }, {
79 	/* ARM 2 */
80 	{ 2100,    1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
81 	  1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
82 	{ 2000,    1312500, 1312500, 1312500, 1300000, 1275000, 1262500, 1250000,
83 	  1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
84 	{ 1900,    1262500, 1250000, 1250000, 1237500, 1212500, 1200000, 1187500,
85 	  1175000, 1162500, 1175000, 1162500, 1150000, 1137500, 1125000 },
86 	{ 1800,    1212500, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500,
87 	  1125000, 1112500, 1125000, 1112500, 1100000, 1087500, 1075000 },
88 	{ 1700,    1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
89 	  1087500, 1075000, 1087500, 1075000, 1062500, 1050000, 1037500 },
90 	{ 1600,    1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
91 	  1050000, 1037500, 1050000, 1037500, 1025000, 1012500, 1000000 },
92 	{ 1500,    1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
93 	  1012500, 1000000, 1012500, 1000000, 987500,  975000,  962500 },
94 	{ 1400,    1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000,
95 	  987500,  975000,  987500,  975000,  962500,  950000,  937500 },
96 	{ 1300,    1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000,
97 	  962500,  950000,  962500,  950000,  937500,  925000,  912500 },
98 	{ 1200,    1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
99 	  937500,  925000,  937500,  925000,  912500,  900000,  900000 },
100 	{ 1100,    1000000, 987500,  975000,  962500,  950000,  937500,  925000,
101 	  912500,  900000,  900000,  900000,  900000,  900000,  900000 },
102 	{ 1000,    975000,  962500,  950000,  937500,  925000,  912500,  900000,
103 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
104 	{ 900,     950000,  937500,  925000,  912500,  900000,  900000,  900000,
105 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
106 	{ 800,     925000,  912500,  900000,  900000,  900000,  900000,  900000,
107 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
108 	{ 700,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
109 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
110 	{ 600,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
111 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
112 	{ 500,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
113 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
114 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
115 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
116 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
117 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
118 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
119 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
120 }, {
121 	/* ARM 3 */
122 	{ 2100,    1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
123 	  1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
124 	{ 2000,    1312500, 1312500, 1300000, 1287500, 1275000, 1262500, 1250000,
125 	  1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
126 	{ 1900,    1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500,
127 	  1175000, 1162500, 1175000, 1162500, 1150000, 1137500, 1125000 },
128 	{ 1800,    1212500, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500,
129 	  1125000, 1112500, 1125000, 1112500, 1100000, 1087500, 1075000 },
130 	{ 1700,    1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
131 	  1087500, 1075000, 1087500, 1075000, 1062500, 1050000, 1037500 },
132 	{ 1600,    1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
133 	  1050000, 1037500, 1050000, 1037500, 1025000, 1012500, 1000000 },
134 	{ 1500,    1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
135 	  1012500, 1000000, 1012500, 1000000, 987500,  975000,  962500 },
136 	{ 1400,    1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000,
137 	  987500,  975000,  987500,  975000,  962500,  950000,  937500 },
138 	{ 1300,    1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000,
139 	  962500,  950000,  962500,  950000,  937500,  925000,  912500 },
140 	{ 1200,    1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
141 	  937500,  925000,  937500,  925000,  912500,  900000,  900000 },
142 	{ 1100,    1000000, 987500,  975000,  962500,  950000,  937500,  925000,
143 	  912500,  900000,  900000,  900000,  900000,  900000,  900000 },
144 	{ 1000,    975000,  962500,  950000,  937500,  925000,  912500,  900000,
145 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
146 	{ 900,     950000,  937500,  925000,  912500,  900000,  900000,  900000,
147 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
148 	{ 800,     925000,  912500,  900000,  900000,  900000,  900000,  900000,
149 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
150 	{ 700,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
151 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
152 	{ 600,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
153 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
154 	{ 500,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
155 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
156 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
157 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
158 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
159 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
160 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
161 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
162 }, {
163 	/* ARM bin 2 */
164 	{ 1800,    1237500, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500,
165 	  1150000, 1137500, 1150000, 1137500, 1125000, 1112500, 1100000 },
166 	{ 1700,    1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
167 	  1112500, 1100000, 1112500, 1100000, 1087500, 1075000, 1062500 },
168 	{ 1600,    1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
169 	  1075000, 1062500, 1075000, 1062500, 1050000, 1037500, 1025000 },
170 	{ 1500,    1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
171 	  1037500, 1025000, 1037500, 1025000, 1012500, 1000000, 987500 },
172 	{ 1400,    1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
173 	  1012500, 1000000, 1012500, 1000000, 987500,  975000,  962500 },
174 	{ 1300,    1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
175 	  1000000, 987500,  1000000, 987500,  975000,  962500,  950000 },
176 	{ 1200,    1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
177 	  975000,  962500,  975000,  962500,  950000,  937500,  925000 },
178 	{ 1100,    1037500, 1025000, 1012500, 1000000, 987500,  975000,  962500,
179 	  950000,  937500,  950000,  937500,  925000,  912500,  900000 },
180 	{ 1000,    1012500, 1000000, 987500,  975000,  962500,  950000,  937500,
181 	  925000,  912500,  925000,  912500,  900000,  900000,  900000 },
182 	{ 900,     987500,  975000,  962500,  950000,  937500,  925000,  912500,
183 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
184 	{ 800,     962500,  950000,  937500,  925000,  912500,  900000,  900000,
185 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
186 	{ 700,     937500,  925000,  912500,  900000,  900000,  900000,  900000,
187 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
188 	{ 600,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
189 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
190 	{ 500,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
191 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
192 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
193 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
194 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
195 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
196 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
197 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
198 }
199 };
200 
201 static const u32 asv_kfc_table[][ASV_KFC_DVFS_NUM][ASV_GROUPS_NUM + 1] = {
202 {
203 	/* KFC 0, 1 */
204 	{ 1500000, 1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
205 	  1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
206 	{ 1400000, 1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
207 	  1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
208 	{ 1300000, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
209 	  1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
210 	{ 1200000, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
211 	  1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
212 	{ 1100000, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
213 	  1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000 },
214 	{ 1000000, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
215 	  1012500, 1000000, 987500,  975000,  962500,  950000,  937500 },
216 	{ 900000,  1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
217 	  975000,  962500,  950000,  937500,  925000,  912500,  900000 },
218 	{ 800000,  1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
219 	  937500,  925000,  912500,  900000,  900000,  900000,  900000 },
220 	{ 700000,  987500,  975000,  962500,  950000,  937500,  925000,  912500,
221 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
222 	{ 600000,  950000,  937500,  925000,  912500,  900000,  900000,  900000,
223 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
224 	{ 500000,  912500,  900000,  900000,  900000,  900000,  900000,  900000,
225 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
226 	{ 400000,  900000,  900000,  900000,  900000,  900000,  900000,  900000,
227 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
228 	{ 300000,  900000,  900000,  900000,  900000,  900000,  900000,  900000,
229 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
230 	{ 200000,  900000,  900000,  900000,  900000,  900000,  900000,  900000,
231 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
232 }, {
233 	/* KFC 2 */
234 	{ 1500,    1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
235 	  1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
236 	{ 1400,    1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
237 	  1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
238 	{ 1300,    1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
239 	  1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
240 	{ 1200,    1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
241 	  1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
242 	{ 1100,    1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
243 	  1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000 },
244 	{ 1000,    1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
245 	  1012500, 1000000, 987500,  975000,  962500,  950000,  937500 },
246 	{ 900,     1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
247 	  975000,  962500,  950000,  937500,  925000,  912500,  900000 },
248 	{ 800,     1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
249 	  937500,  925000,  912500,  900000,  900000,  900000,  900000 },
250 	{ 700,     987500,  975000,  962500,  950000,  937500,  925000,  912500,
251 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
252 	{ 600,     950000,  937500,  925000,  912500,  900000,  900000,  900000,
253 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
254 	{ 500,     912500,  900000,  900000,  900000,  900000,  900000,  900000,
255 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
256 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
257 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
258 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
259 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
260 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
261 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
262 }, {
263 	/* KFC 3 */
264 	{ 1500,    1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
265 	  1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
266 	{ 1400,    1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
267 	  1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
268 	{ 1300,    1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
269 	  1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
270 	{ 1200,    1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
271 	  1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
272 	{ 1100,    1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
273 	  1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000 },
274 	{ 1000,    1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
275 	  1012500, 1000000, 987500,  975000,  962500,  950000,  937500 },
276 	{ 900,     1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
277 	  975000,  962500,  950000,  937500,  925000,  912500,  900000 },
278 	{ 800,     1025000, 1012500, 1000000, 987500,  975000,  962500,  950000,
279 	  937500,  925000,  912500,  900000,  900000,  900000,  900000 },
280 	{ 700,     987500,  975000,  962500,  950000,  937500,  925000,  912500,
281 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
282 	{ 600,     950000,  937500,  925000,  912500,  900000,  900000,  900000,
283 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
284 	{ 500,     912500,  900000,  900000,  900000,  900000,  900000,  900000,
285 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
286 	{ 400,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
287 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
288 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
289 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
290 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
291 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
292 }, {
293 	/* KFC bin 2 */
294 	{ 1300,    1250000, 1237500, 1225000, 1212500, 1200000, 1187500, 1175000,
295 	  1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500 },
296 	{ 1200,    1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
297 	  1112500, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500 },
298 	{ 1100,    1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
299 	  1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000 },
300 	{ 1000,    1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
301 	  1037500, 1025000, 1012500, 1000000, 987500,  975000,  962500 },
302 	{ 900,     1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
303 	  1000000, 987500,  975000,  962500,  950000,  937500,  925000 },
304 	{ 800,     1050000, 1037500, 1025000, 1012500, 1000000, 987500,  975000,
305 	  962500,  950000,  937500,  925000,  912500,  900000,  900000 },
306 	{ 700,     1012500, 1000000, 987500,  975000,  962500,  950000,  937500,
307 	  925000,  912500,  900000,  900000,  900000,  900000,  900000 },
308 	{ 600,     975000,  962500,  950000,  937500,  925000,  912500,  900000,
309 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
310 	{ 500,     937500,  925000,  912500,  900000,  900000,  900000,  900000,
311 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
312 	{ 400,     925000,  912500,  900000,  900000,  900000,  900000,  900000,
313 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
314 	{ 300,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
315 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
316 	{ 200,     900000,  900000,  900000,  900000,  900000,  900000,  900000,
317 	  900000,  900000,  900000,  900000,  900000,  900000,  900000 },
318 }
319 };
320 
321 static const struct asv_limit_entry __asv_limits[ASV_GROUPS_NUM] = {
322 	{ 13, 55 },
323 	{ 21, 65 },
324 	{ 25, 69 },
325 	{ 30, 72 },
326 	{ 36, 74 },
327 	{ 43, 76 },
328 	{ 51, 78 },
329 	{ 65, 80 },
330 	{ 81, 82 },
331 	{ 98, 84 },
332 	{ 119, 87 },
333 	{ 135, 89 },
334 	{ 150, 92 },
335 	{ 999, 999 },
336 };
337 
338 static int exynos5422_asv_get_group(struct exynos_asv *asv)
339 {
340 	unsigned int pkgid_reg, auxi_reg;
341 	int hpm, ids, i;
342 
343 	regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_PKG_ID, &pkgid_reg);
344 	regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_AUX_INFO, &auxi_reg);
345 
346 	if (asv->use_sg) {
347 		u32 sga = (pkgid_reg >> EXYNOS5422_SG_A_OFFSET) &
348 			   EXYNOS5422_SG_A_MASK;
349 
350 		u32 sgb = (pkgid_reg >> EXYNOS5422_SG_B_OFFSET) &
351 			   EXYNOS5422_SG_B_MASK;
352 
353 		if ((pkgid_reg >> EXYNOS5422_SG_BSIGN_OFFSET) &
354 		     EXYNOS5422_SG_BSIGN_MASK)
355 			return sga + sgb;
356 		else
357 			return sga - sgb;
358 	}
359 
360 	hpm = (auxi_reg >> EXYNOS5422_TMCB_OFFSET) & EXYNOS5422_TMCB_MASK;
361 	ids = (pkgid_reg >> EXYNOS5422_IDS_OFFSET) & EXYNOS5422_IDS_MASK;
362 
363 	for (i = 0; i < ASV_GROUPS_NUM; i++) {
364 		if (ids <= __asv_limits[i].ids)
365 			break;
366 		if (hpm <= __asv_limits[i].hpm)
367 			break;
368 	}
369 	if (i < ASV_GROUPS_NUM)
370 		return i;
371 
372 	return 0;
373 }
374 
375 static int __asv_offset_voltage(unsigned int index)
376 {
377 	switch (index) {
378 	case 1:
379 		return 12500;
380 	case 2:
381 		return 50000;
382 	case 3:
383 		return 25000;
384 	default:
385 		return 0;
386 	};
387 }
388 
389 static void exynos5422_asv_offset_voltage_setup(struct exynos_asv *asv)
390 {
391 	struct exynos_asv_subsys *subsys;
392 	unsigned int reg, value;
393 
394 	regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_AUX_INFO, &reg);
395 
396 	/* ARM offset voltage setup */
397 	subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_ARM];
398 
399 	subsys->base_volt = 1000000;
400 
401 	value = (reg >> EXYNOS5422_ARM_UP_OFFSET) & EXYNOS5422_ARM_UP_MASK;
402 	subsys->offset_volt_h = __asv_offset_voltage(value);
403 
404 	value = (reg >> EXYNOS5422_ARM_DN_OFFSET) & EXYNOS5422_ARM_DN_MASK;
405 	subsys->offset_volt_l = __asv_offset_voltage(value);
406 
407 	/* KFC offset voltage setup */
408 	subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_KFC];
409 
410 	subsys->base_volt = 1000000;
411 
412 	value = (reg >> EXYNOS5422_KFC_UP_OFFSET) & EXYNOS5422_KFC_UP_MASK;
413 	subsys->offset_volt_h = __asv_offset_voltage(value);
414 
415 	value = (reg >> EXYNOS5422_KFC_DN_OFFSET) & EXYNOS5422_KFC_DN_MASK;
416 	subsys->offset_volt_l = __asv_offset_voltage(value);
417 }
418 
419 static int exynos5422_asv_opp_get_voltage(const struct exynos_asv_subsys *subsys,
420 					  int level, unsigned int volt)
421 {
422 	unsigned int asv_volt;
423 
424 	if (level >= subsys->table.num_rows)
425 		return volt;
426 
427 	asv_volt = exynos_asv_opp_get_voltage(subsys, level,
428 					      subsys->asv->group);
429 
430 	if (volt > subsys->base_volt)
431 		asv_volt += subsys->offset_volt_h;
432 	else
433 		asv_volt += subsys->offset_volt_l;
434 
435 	return asv_volt;
436 }
437 
438 static unsigned int exynos5422_asv_parse_table(unsigned int pkg_id)
439 {
440 	return (pkg_id >> EXYNOS5422_TABLE_OFFSET) & EXYNOS5422_TABLE_MASK;
441 }
442 
443 static bool exynos5422_asv_parse_bin2(unsigned int pkg_id)
444 {
445 	return (pkg_id >> EXYNOS5422_BIN2_OFFSET) & EXYNOS5422_BIN2_MASK;
446 }
447 
448 static bool exynos5422_asv_parse_sg(unsigned int pkg_id)
449 {
450 	return (pkg_id >> EXYNOS5422_USESG_OFFSET) & EXYNOS5422_USESG_MASK;
451 }
452 
453 int exynos5422_asv_init(struct exynos_asv *asv)
454 {
455 	struct exynos_asv_subsys *subsys;
456 	unsigned int table_index;
457 	unsigned int pkg_id;
458 	bool bin2;
459 
460 	regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_PKG_ID, &pkg_id);
461 
462 	if (asv->of_bin == 2) {
463 		bin2 = true;
464 		asv->use_sg = false;
465 	} else {
466 		asv->use_sg = exynos5422_asv_parse_sg(pkg_id);
467 		bin2 = exynos5422_asv_parse_bin2(pkg_id);
468 	}
469 
470 	asv->group = exynos5422_asv_get_group(asv);
471 	asv->table = exynos5422_asv_parse_table(pkg_id);
472 
473 	exynos5422_asv_offset_voltage_setup(asv);
474 
475 	if (bin2) {
476 		table_index = 3;
477 	} else {
478 		if (asv->table == 2 || asv->table == 3)
479 			table_index = asv->table - 1;
480 		else
481 			table_index = 0;
482 	}
483 
484 	subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_ARM];
485 	subsys->cpu_dt_compat = "arm,cortex-a15";
486 	if (bin2)
487 		subsys->table.num_rows = ASV_ARM_BIN2_DVFS_NUM;
488 	else
489 		subsys->table.num_rows = ASV_ARM_DVFS_NUM;
490 	subsys->table.num_cols = ASV_GROUPS_NUM + 1;
491 	subsys->table.buf = (u32 *)asv_arm_table[table_index];
492 
493 	subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_KFC];
494 	subsys->cpu_dt_compat = "arm,cortex-a7";
495 	if (bin2)
496 		subsys->table.num_rows = ASV_KFC_BIN2_DVFS_NUM;
497 	else
498 		subsys->table.num_rows = ASV_KFC_DVFS_NUM;
499 	subsys->table.num_cols = ASV_GROUPS_NUM + 1;
500 	subsys->table.buf = (u32 *)asv_kfc_table[table_index];
501 
502 	asv->opp_get_voltage = exynos5422_asv_opp_get_voltage;
503 
504 	return 0;
505 }
506