exynos5422-asv.c 24 KB

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