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
35static 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
201static 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
321static 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
338static 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
375static 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
389static 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
419static 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
438static unsigned int exynos5422_asv_parse_table(unsigned int pkg_id)
439{
440	return (pkg_id >> EXYNOS5422_TABLE_OFFSET) & EXYNOS5422_TABLE_MASK;
441}
442
443static bool exynos5422_asv_parse_bin2(unsigned int pkg_id)
444{
445	return (pkg_id >> EXYNOS5422_BIN2_OFFSET) & EXYNOS5422_BIN2_MASK;
446}
447
448static bool exynos5422_asv_parse_sg(unsigned int pkg_id)
449{
450	return (pkg_id >> EXYNOS5422_USESG_OFFSET) & EXYNOS5422_USESG_MASK;
451}
452
453int 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