ps7_init_gpl.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) Xilinx, Inc.
  4. */
  5. #include <asm/arch/ps7_init_gpl.h>
  6. static unsigned long ps7_pll_init_data[] = {
  7. EMIT_WRITE(0xF8000008, 0x0000DF0DU),
  8. EMIT_MASKWRITE(0xF8000110, 0x003FFFF0U, 0x000FA220U),
  9. EMIT_MASKWRITE(0xF8000100, 0x0007F000U, 0x00028000U),
  10. EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000010U),
  11. EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000001U),
  12. EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000000U),
  13. EMIT_MASKPOLL(0xF800010C, 0x00000001U),
  14. EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000000U),
  15. EMIT_MASKWRITE(0xF8000120, 0x1F003F30U, 0x1F000200U),
  16. EMIT_MASKWRITE(0xF8000114, 0x003FFFF0U, 0x0012C220U),
  17. EMIT_MASKWRITE(0xF8000104, 0x0007F000U, 0x00020000U),
  18. EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000010U),
  19. EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000001U),
  20. EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000000U),
  21. EMIT_MASKPOLL(0xF800010C, 0x00000002U),
  22. EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000000U),
  23. EMIT_MASKWRITE(0xF8000124, 0xFFF00003U, 0x0C200003U),
  24. EMIT_MASKWRITE(0xF8000118, 0x003FFFF0U, 0x001452C0U),
  25. EMIT_MASKWRITE(0xF8000108, 0x0007F000U, 0x0001E000U),
  26. EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000010U),
  27. EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000001U),
  28. EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000000U),
  29. EMIT_MASKPOLL(0xF800010C, 0x00000004U),
  30. EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000000U),
  31. EMIT_WRITE(0xF8000004, 0x0000767BU),
  32. EMIT_EXIT(),
  33. };
  34. static unsigned long ps7_clock_init_data[] = {
  35. EMIT_WRITE(0xF8000008, 0x0000DF0DU),
  36. EMIT_MASKWRITE(0xF8000128, 0x03F03F01U, 0x00700F01U),
  37. EMIT_MASKWRITE(0xF8000138, 0x00000011U, 0x00000001U),
  38. EMIT_MASKWRITE(0xF8000140, 0x03F03F71U, 0x00100801U),
  39. EMIT_MASKWRITE(0xF800014C, 0x00003F31U, 0x00000501U),
  40. EMIT_MASKWRITE(0xF8000150, 0x00003F33U, 0x00001401U),
  41. EMIT_MASKWRITE(0xF8000154, 0x00003F33U, 0x00000A03U),
  42. EMIT_MASKWRITE(0xF800015C, 0x03F03F33U, 0x00200501U),
  43. EMIT_MASKWRITE(0xF8000160, 0x007F007FU, 0x00000000U),
  44. EMIT_MASKWRITE(0xF8000168, 0x00003F31U, 0x00000501U),
  45. EMIT_MASKWRITE(0xF8000170, 0x03F03F30U, 0x00200500U),
  46. EMIT_MASKWRITE(0xF8000180, 0x03F03F30U, 0x00400500U),
  47. EMIT_MASKWRITE(0xF80001C4, 0x00000001U, 0x00000001U),
  48. EMIT_MASKWRITE(0xF800012C, 0x01FFCCCDU, 0x01FD044DU),
  49. EMIT_WRITE(0xF8000004, 0x0000767BU),
  50. EMIT_EXIT(),
  51. };
  52. static unsigned long ps7_ddr_init_data[] = {
  53. EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000080U),
  54. EMIT_MASKWRITE(0xF8006004, 0x0007FFFFU, 0x00001082U),
  55. EMIT_MASKWRITE(0xF8006008, 0x03FFFFFFU, 0x03C0780FU),
  56. EMIT_MASKWRITE(0xF800600C, 0x03FFFFFFU, 0x02001001U),
  57. EMIT_MASKWRITE(0xF8006010, 0x03FFFFFFU, 0x00014001U),
  58. EMIT_MASKWRITE(0xF8006014, 0x001FFFFFU, 0x0004285BU),
  59. EMIT_MASKWRITE(0xF8006018, 0xF7FFFFFFU, 0x44E458D3U),
  60. EMIT_MASKWRITE(0xF800601C, 0xFFFFFFFFU, 0x7282BCE5U),
  61. EMIT_MASKWRITE(0xF8006020, 0x7FDFFFFCU, 0x270872D0U),
  62. EMIT_MASKWRITE(0xF8006024, 0x0FFFFFC3U, 0x00000000U),
  63. EMIT_MASKWRITE(0xF8006028, 0x00003FFFU, 0x00002007U),
  64. EMIT_MASKWRITE(0xF800602C, 0xFFFFFFFFU, 0x00000008U),
  65. EMIT_MASKWRITE(0xF8006030, 0xFFFFFFFFU, 0x00040B30U),
  66. EMIT_MASKWRITE(0xF8006034, 0x13FF3FFFU, 0x000116D4U),
  67. EMIT_MASKWRITE(0xF8006038, 0x00000003U, 0x00000000U),
  68. EMIT_MASKWRITE(0xF800603C, 0x000FFFFFU, 0x00000777U),
  69. EMIT_MASKWRITE(0xF8006040, 0xFFFFFFFFU, 0xFFF00000U),
  70. EMIT_MASKWRITE(0xF8006044, 0x0FFFFFFFU, 0x0F666666U),
  71. EMIT_MASKWRITE(0xF8006048, 0x0003F03FU, 0x0003C008U),
  72. EMIT_MASKWRITE(0xF8006050, 0xFF0F8FFFU, 0x77010800U),
  73. EMIT_MASKWRITE(0xF8006058, 0x00010000U, 0x00000000U),
  74. EMIT_MASKWRITE(0xF800605C, 0x0000FFFFU, 0x00005003U),
  75. EMIT_MASKWRITE(0xF8006060, 0x000017FFU, 0x0000003EU),
  76. EMIT_MASKWRITE(0xF8006064, 0x00021FE0U, 0x00020000U),
  77. EMIT_MASKWRITE(0xF8006068, 0x03FFFFFFU, 0x00284141U),
  78. EMIT_MASKWRITE(0xF800606C, 0x0000FFFFU, 0x00001610U),
  79. EMIT_MASKWRITE(0xF8006078, 0x03FFFFFFU, 0x00466111U),
  80. EMIT_MASKWRITE(0xF800607C, 0x000FFFFFU, 0x00032222U),
  81. EMIT_MASKWRITE(0xF80060A4, 0xFFFFFFFFU, 0x10200802U),
  82. EMIT_MASKWRITE(0xF80060A8, 0x0FFFFFFFU, 0x0690CB73U),
  83. EMIT_MASKWRITE(0xF80060AC, 0x000001FFU, 0x000001FEU),
  84. EMIT_MASKWRITE(0xF80060B0, 0x1FFFFFFFU, 0x1CFFFFFFU),
  85. EMIT_MASKWRITE(0xF80060B4, 0x00000200U, 0x00000200U),
  86. EMIT_MASKWRITE(0xF80060B8, 0x01FFFFFFU, 0x00200066U),
  87. EMIT_MASKWRITE(0xF80060C4, 0x00000003U, 0x00000000U),
  88. EMIT_MASKWRITE(0xF80060C8, 0x000000FFU, 0x00000000U),
  89. EMIT_MASKWRITE(0xF80060DC, 0x00000001U, 0x00000000U),
  90. EMIT_MASKWRITE(0xF80060F0, 0x0000FFFFU, 0x00000000U),
  91. EMIT_MASKWRITE(0xF80060F4, 0x0000000FU, 0x00000008U),
  92. EMIT_MASKWRITE(0xF8006114, 0x000000FFU, 0x00000000U),
  93. EMIT_MASKWRITE(0xF8006118, 0x7FFFFFCFU, 0x40000001U),
  94. EMIT_MASKWRITE(0xF800611C, 0x7FFFFFCFU, 0x40000001U),
  95. EMIT_MASKWRITE(0xF8006120, 0x7FFFFFCFU, 0x40000001U),
  96. EMIT_MASKWRITE(0xF8006124, 0x7FFFFFCFU, 0x40000001U),
  97. EMIT_MASKWRITE(0xF800612C, 0x000FFFFFU, 0x0002A81FU),
  98. EMIT_MASKWRITE(0xF8006130, 0x000FFFFFU, 0x00029822U),
  99. EMIT_MASKWRITE(0xF8006134, 0x000FFFFFU, 0x00026C10U),
  100. EMIT_MASKWRITE(0xF8006138, 0x000FFFFFU, 0x00026013U),
  101. EMIT_MASKWRITE(0xF8006140, 0x000FFFFFU, 0x00000035U),
  102. EMIT_MASKWRITE(0xF8006144, 0x000FFFFFU, 0x00000035U),
  103. EMIT_MASKWRITE(0xF8006148, 0x000FFFFFU, 0x00000035U),
  104. EMIT_MASKWRITE(0xF800614C, 0x000FFFFFU, 0x00000035U),
  105. EMIT_MASKWRITE(0xF8006154, 0x000FFFFFU, 0x0000009FU),
  106. EMIT_MASKWRITE(0xF8006158, 0x000FFFFFU, 0x000000A2U),
  107. EMIT_MASKWRITE(0xF800615C, 0x000FFFFFU, 0x00000090U),
  108. EMIT_MASKWRITE(0xF8006160, 0x000FFFFFU, 0x00000093U),
  109. EMIT_MASKWRITE(0xF8006168, 0x001FFFFFU, 0x000000FFU),
  110. EMIT_MASKWRITE(0xF800616C, 0x001FFFFFU, 0x000000FBU),
  111. EMIT_MASKWRITE(0xF8006170, 0x001FFFFFU, 0x000000F0U),
  112. EMIT_MASKWRITE(0xF8006174, 0x001FFFFFU, 0x000000EDU),
  113. EMIT_MASKWRITE(0xF800617C, 0x000FFFFFU, 0x000000DFU),
  114. EMIT_MASKWRITE(0xF8006180, 0x000FFFFFU, 0x000000E2U),
  115. EMIT_MASKWRITE(0xF8006184, 0x000FFFFFU, 0x000000D0U),
  116. EMIT_MASKWRITE(0xF8006188, 0x000FFFFFU, 0x000000D3U),
  117. EMIT_MASKWRITE(0xF8006190, 0x6FFFFEFEU, 0x00040080U),
  118. EMIT_MASKWRITE(0xF8006194, 0x000FFFFFU, 0x0001FC82U),
  119. EMIT_MASKWRITE(0xF8006204, 0xFFFFFFFFU, 0x00000000U),
  120. EMIT_MASKWRITE(0xF8006208, 0x000703FFU, 0x000003FFU),
  121. EMIT_MASKWRITE(0xF800620C, 0x000703FFU, 0x000003FFU),
  122. EMIT_MASKWRITE(0xF8006210, 0x000703FFU, 0x000003FFU),
  123. EMIT_MASKWRITE(0xF8006214, 0x000703FFU, 0x000003FFU),
  124. EMIT_MASKWRITE(0xF8006218, 0x000F03FFU, 0x000003FFU),
  125. EMIT_MASKWRITE(0xF800621C, 0x000F03FFU, 0x000003FFU),
  126. EMIT_MASKWRITE(0xF8006220, 0x000F03FFU, 0x000003FFU),
  127. EMIT_MASKWRITE(0xF8006224, 0x000F03FFU, 0x000003FFU),
  128. EMIT_MASKWRITE(0xF80062A8, 0x00000FF5U, 0x00000000U),
  129. EMIT_MASKWRITE(0xF80062AC, 0xFFFFFFFFU, 0x00000000U),
  130. EMIT_MASKWRITE(0xF80062B0, 0x003FFFFFU, 0x00005125U),
  131. EMIT_MASKWRITE(0xF80062B4, 0x0003FFFFU, 0x000012A8U),
  132. EMIT_MASKPOLL(0xF8000B74, 0x00002000U),
  133. EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000081U),
  134. EMIT_MASKPOLL(0xF8006054, 0x00000007U),
  135. EMIT_EXIT(),
  136. };
  137. static unsigned long ps7_mio_init_data[] = {
  138. EMIT_WRITE(0xF8000008, 0x0000DF0DU),
  139. EMIT_MASKWRITE(0xF8000B40, 0x00000FFFU, 0x00000600U),
  140. EMIT_MASKWRITE(0xF8000B44, 0x00000FFFU, 0x00000600U),
  141. EMIT_MASKWRITE(0xF8000B48, 0x00000FFFU, 0x00000672U),
  142. EMIT_MASKWRITE(0xF8000B4C, 0x00000FFFU, 0x00000672U),
  143. EMIT_MASKWRITE(0xF8000B50, 0x00000FFFU, 0x00000674U),
  144. EMIT_MASKWRITE(0xF8000B54, 0x00000FFFU, 0x00000674U),
  145. EMIT_MASKWRITE(0xF8000B58, 0x00000FFFU, 0x00000600U),
  146. EMIT_MASKWRITE(0xF8000B5C, 0xFFFFFFFFU, 0x0018C61CU),
  147. EMIT_MASKWRITE(0xF8000B60, 0xFFFFFFFFU, 0x00F9861CU),
  148. EMIT_MASKWRITE(0xF8000B64, 0xFFFFFFFFU, 0x00F9861CU),
  149. EMIT_MASKWRITE(0xF8000B68, 0xFFFFFFFFU, 0x00F9861CU),
  150. EMIT_MASKWRITE(0xF8000B6C, 0x00007FFFU, 0x00000260U),
  151. EMIT_MASKWRITE(0xF8000B70, 0x00000001U, 0x00000001U),
  152. EMIT_MASKWRITE(0xF8000B70, 0x00000021U, 0x00000020U),
  153. EMIT_MASKWRITE(0xF8000B70, 0x07FEFFFFU, 0x00000823U),
  154. EMIT_MASKWRITE(0xF8000700, 0x00003FFFU, 0x00001600U),
  155. EMIT_MASKWRITE(0xF8000704, 0x00003FFFU, 0x00000602U),
  156. EMIT_MASKWRITE(0xF8000708, 0x00003FFFU, 0x00000602U),
  157. EMIT_MASKWRITE(0xF800070C, 0x00003FFFU, 0x00000602U),
  158. EMIT_MASKWRITE(0xF8000710, 0x00003FFFU, 0x00000602U),
  159. EMIT_MASKWRITE(0xF8000714, 0x00003FFFU, 0x00000602U),
  160. EMIT_MASKWRITE(0xF8000718, 0x00003FFFU, 0x00000602U),
  161. EMIT_MASKWRITE(0xF800071C, 0x00003FFFU, 0x00000600U),
  162. EMIT_MASKWRITE(0xF8000720, 0x00003FFFU, 0x00000602U),
  163. EMIT_MASKWRITE(0xF8000724, 0x00003FFFU, 0x00000600U),
  164. EMIT_MASKWRITE(0xF8000728, 0x00003FFFU, 0x000016E1U),
  165. EMIT_MASKWRITE(0xF800072C, 0x00003FFFU, 0x000016E0U),
  166. EMIT_MASKWRITE(0xF8000730, 0x00003FFFU, 0x00001640U),
  167. EMIT_MASKWRITE(0xF8000734, 0x00003FFFU, 0x00001640U),
  168. EMIT_MASKWRITE(0xF8000738, 0x00003FFFU, 0x00001621U),
  169. EMIT_MASKWRITE(0xF800073C, 0x00003FFFU, 0x00001620U),
  170. EMIT_MASKWRITE(0xF8000740, 0x00003FFFU, 0x00001202U),
  171. EMIT_MASKWRITE(0xF8000744, 0x00003FFFU, 0x00001202U),
  172. EMIT_MASKWRITE(0xF8000748, 0x00003FFFU, 0x00001202U),
  173. EMIT_MASKWRITE(0xF800074C, 0x00003FFFU, 0x00001202U),
  174. EMIT_MASKWRITE(0xF8000750, 0x00003FFFU, 0x00001202U),
  175. EMIT_MASKWRITE(0xF8000754, 0x00003FFFU, 0x00001202U),
  176. EMIT_MASKWRITE(0xF8000758, 0x00003FFFU, 0x00001203U),
  177. EMIT_MASKWRITE(0xF800075C, 0x00003FFFU, 0x00001203U),
  178. EMIT_MASKWRITE(0xF8000760, 0x00003FFFU, 0x00001203U),
  179. EMIT_MASKWRITE(0xF8000764, 0x00003FFFU, 0x00001203U),
  180. EMIT_MASKWRITE(0xF8000768, 0x00003FFFU, 0x00001203U),
  181. EMIT_MASKWRITE(0xF800076C, 0x00003FFFU, 0x00001203U),
  182. EMIT_MASKWRITE(0xF8000770, 0x00003FFFU, 0x00001204U),
  183. EMIT_MASKWRITE(0xF8000774, 0x00003FFFU, 0x00001205U),
  184. EMIT_MASKWRITE(0xF8000778, 0x00003FFFU, 0x00001204U),
  185. EMIT_MASKWRITE(0xF800077C, 0x00003FFFU, 0x00001205U),
  186. EMIT_MASKWRITE(0xF8000780, 0x00003FFFU, 0x00001204U),
  187. EMIT_MASKWRITE(0xF8000784, 0x00003FFFU, 0x00001204U),
  188. EMIT_MASKWRITE(0xF8000788, 0x00003FFFU, 0x00001204U),
  189. EMIT_MASKWRITE(0xF800078C, 0x00003FFFU, 0x00001204U),
  190. EMIT_MASKWRITE(0xF8000790, 0x00003FFFU, 0x00001205U),
  191. EMIT_MASKWRITE(0xF8000794, 0x00003FFFU, 0x00001204U),
  192. EMIT_MASKWRITE(0xF8000798, 0x00003FFFU, 0x00001204U),
  193. EMIT_MASKWRITE(0xF800079C, 0x00003FFFU, 0x00001204U),
  194. EMIT_MASKWRITE(0xF80007A0, 0x00003FFFU, 0x00001280U),
  195. EMIT_MASKWRITE(0xF80007A4, 0x00003FFFU, 0x00001280U),
  196. EMIT_MASKWRITE(0xF80007A8, 0x00003FFFU, 0x00001280U),
  197. EMIT_MASKWRITE(0xF80007AC, 0x00003FFFU, 0x00001280U),
  198. EMIT_MASKWRITE(0xF80007B0, 0x00003FFFU, 0x00001280U),
  199. EMIT_MASKWRITE(0xF80007B4, 0x00003FFFU, 0x00001280U),
  200. EMIT_MASKWRITE(0xF80007B8, 0x00003F01U, 0x00000201U),
  201. EMIT_MASKWRITE(0xF80007BC, 0x00003F01U, 0x00000201U),
  202. EMIT_MASKWRITE(0xF80007C0, 0x00003FFFU, 0x000012E0U),
  203. EMIT_MASKWRITE(0xF80007C4, 0x00003FFFU, 0x000012E1U),
  204. EMIT_MASKWRITE(0xF80007C8, 0x00003FFFU, 0x00000200U),
  205. EMIT_MASKWRITE(0xF80007CC, 0x00003FFFU, 0x00000200U),
  206. EMIT_MASKWRITE(0xF80007D0, 0x00003FFFU, 0x00001280U),
  207. EMIT_MASKWRITE(0xF80007D4, 0x00003FFFU, 0x00001280U),
  208. EMIT_MASKWRITE(0xF8000830, 0x003F003FU, 0x002E002FU),
  209. EMIT_WRITE(0xF8000004, 0x0000767BU),
  210. EMIT_EXIT(),
  211. };
  212. static unsigned long ps7_peripherals_init_data[] = {
  213. EMIT_WRITE(0xF8000008, 0x0000DF0DU),
  214. EMIT_MASKWRITE(0xF8000B48, 0x00000180U, 0x00000180U),
  215. EMIT_MASKWRITE(0xF8000B4C, 0x00000180U, 0x00000180U),
  216. EMIT_MASKWRITE(0xF8000B50, 0x00000180U, 0x00000180U),
  217. EMIT_MASKWRITE(0xF8000B54, 0x00000180U, 0x00000180U),
  218. EMIT_WRITE(0xF8000004, 0x0000767BU),
  219. EMIT_MASKWRITE(0xE000D000, 0x00080000U, 0x00080000U),
  220. EMIT_MASKWRITE(0xF8007000, 0x20000000U, 0x00000000U),
  221. EMIT_MASKWRITE(0xE000A244, 0x003FFFFFU, 0x00080000U),
  222. EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370008U),
  223. EMIT_MASKWRITE(0xE000A248, 0x003FFFFFU, 0x00080000U),
  224. EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370000U),
  225. EMIT_MASKDELAY(0xF8F00200, 1),
  226. EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370008U),
  227. EMIT_EXIT(),
  228. };
  229. static unsigned long ps7_post_config_0[] = {
  230. EMIT_WRITE(0xF8000008, 0x0000DF0DU),
  231. EMIT_MASKWRITE(0xF8000900, 0x0000000FU, 0x0000000FU),
  232. EMIT_MASKWRITE(0xF8000240, 0xFFFFFFFFU, 0x00000000U),
  233. EMIT_WRITE(0xF8000004, 0x0000767BU),
  234. EMIT_EXIT(),
  235. };
  236. int ps7_post_config(void)
  237. {
  238. return ps7_config(ps7_post_config_0);
  239. }
  240. int ps7_init(void)
  241. {
  242. int ret;
  243. ret = ps7_config(ps7_mio_init_data);
  244. if (ret != PS7_INIT_SUCCESS)
  245. return ret;
  246. ret = ps7_config(ps7_pll_init_data);
  247. if (ret != PS7_INIT_SUCCESS)
  248. return ret;
  249. ret = ps7_config(ps7_clock_init_data);
  250. if (ret != PS7_INIT_SUCCESS)
  251. return ret;
  252. ret = ps7_config(ps7_ddr_init_data);
  253. if (ret != PS7_INIT_SUCCESS)
  254. return ret;
  255. ret = ps7_config(ps7_peripherals_init_data);
  256. if (ret != PS7_INIT_SUCCESS)
  257. return ret;
  258. return PS7_INIT_SUCCESS;
  259. }