sdram_mpu_init.mac 9.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249
  1. /*****************************************************************************/
  2. SDRAM_WaitIpCmdDone()
  3. {
  4. __var reg;
  5. do
  6. {
  7. reg = __readMemory32(0x402F003C, "Memory");
  8. }while((reg & 0x3) == 0);
  9. }
  10. _clock_init()
  11. {
  12. // Enable all clocks
  13. __writeMemory32(0xffffffff, 0x400FC068, "Memory");
  14. __writeMemory32(0xffffffff, 0x400FC06C, "Memory");
  15. __writeMemory32(0xffffffff, 0x400FC070, "Memory");
  16. __writeMemory32(0xffffffff, 0x400FC074, "Memory");
  17. __writeMemory32(0xffffffff, 0x400FC078, "Memory");
  18. __writeMemory32(0xffffffff, 0x400FC07C, "Memory");
  19. __writeMemory32(0xffffffff, 0x400FC080, "Memory");
  20. __writeMemory32(0x00002001, 0x400D8030, "Memory");
  21. __writeMemory32(0x00100000, 0x400D8100, "Memory");
  22. __writeMemory32(0x00050D40, 0x400FC014, "Memory");
  23. }
  24. _sdr_Init()
  25. {
  26. // Config IOMUX
  27. __writeMemory32(0x00000000, 0x401F8014, "Memory");
  28. __writeMemory32(0x00000000, 0x401F8018, "Memory");
  29. __writeMemory32(0x00000000, 0x401F801C, "Memory");
  30. __writeMemory32(0x00000000, 0x401F8020, "Memory");
  31. __writeMemory32(0x00000000, 0x401F8024, "Memory");
  32. __writeMemory32(0x00000000, 0x401F8028, "Memory");
  33. __writeMemory32(0x00000000, 0x401F802C, "Memory");
  34. __writeMemory32(0x00000000, 0x401F8030, "Memory");
  35. __writeMemory32(0x00000000, 0x401F8034, "Memory");
  36. __writeMemory32(0x00000000, 0x401F8038, "Memory");
  37. __writeMemory32(0x00000000, 0x401F803C, "Memory");
  38. __writeMemory32(0x00000000, 0x401F8040, "Memory");
  39. __writeMemory32(0x00000000, 0x401F8044, "Memory");
  40. __writeMemory32(0x00000000, 0x401F8048, "Memory");
  41. __writeMemory32(0x00000000, 0x401F804C, "Memory");
  42. __writeMemory32(0x00000000, 0x401F8050, "Memory");
  43. __writeMemory32(0x00000000, 0x401F8054, "Memory");
  44. __writeMemory32(0x00000000, 0x401F8058, "Memory");
  45. __writeMemory32(0x00000000, 0x401F805C, "Memory");
  46. __writeMemory32(0x00000000, 0x401F8060, "Memory");
  47. __writeMemory32(0x00000000, 0x401F8064, "Memory");
  48. __writeMemory32(0x00000000, 0x401F8068, "Memory");
  49. __writeMemory32(0x00000000, 0x401F806C, "Memory");
  50. __writeMemory32(0x00000000, 0x401F8070, "Memory");
  51. __writeMemory32(0x00000000, 0x401F8074, "Memory");
  52. __writeMemory32(0x00000000, 0x401F8078, "Memory");
  53. __writeMemory32(0x00000000, 0x401F807C, "Memory");
  54. __writeMemory32(0x00000000, 0x401F8080, "Memory");
  55. __writeMemory32(0x00000000, 0x401F8084, "Memory");
  56. __writeMemory32(0x00000000, 0x401F8088, "Memory");
  57. __writeMemory32(0x00000000, 0x401F808C, "Memory");
  58. __writeMemory32(0x00000000, 0x401F8090, "Memory");
  59. __writeMemory32(0x00000000, 0x401F8094, "Memory");
  60. __writeMemory32(0x00000000, 0x401F8098, "Memory");
  61. __writeMemory32(0x00000000, 0x401F809C, "Memory");
  62. __writeMemory32(0x00000000, 0x401F80A0, "Memory");
  63. __writeMemory32(0x00000000, 0x401F80A4, "Memory");
  64. __writeMemory32(0x00000000, 0x401F80A8, "Memory");
  65. __writeMemory32(0x00000000, 0x401F80AC, "Memory");
  66. __writeMemory32(0x00000000, 0x401F80B0, "Memory");
  67. __writeMemory32(0x00000000, 0x401F80B4, "Memory");
  68. __writeMemory32(0x00000000, 0x401F80B8, "Memory");
  69. // PAD ctrl
  70. __writeMemory32(0x000000F1, 0x401F8204, "Memory");
  71. __writeMemory32(0x000000F1, 0x401F8208, "Memory");
  72. __writeMemory32(0x000000F1, 0x401F820C, "Memory");
  73. __writeMemory32(0x000000F1, 0x401F8210, "Memory");
  74. __writeMemory32(0x000000F1, 0x401F8214, "Memory");
  75. __writeMemory32(0x000000F1, 0x401F8218, "Memory");
  76. __writeMemory32(0x000000F1, 0x401F821C, "Memory");
  77. __writeMemory32(0x000000F1, 0x401F8220, "Memory");
  78. __writeMemory32(0x000000F1, 0x401F8224, "Memory");
  79. __writeMemory32(0x000000F1, 0x401F8228, "Memory");
  80. __writeMemory32(0x000000F1, 0x401F822C, "Memory");
  81. __writeMemory32(0x000000F1, 0x401F8230, "Memory");
  82. __writeMemory32(0x000000F1, 0x401F8234, "Memory");
  83. __writeMemory32(0x000000F1, 0x401F8238, "Memory");
  84. __writeMemory32(0x000000F1, 0x401F823C, "Memory");
  85. __writeMemory32(0x000000F1, 0x401F8240, "Memory");
  86. __writeMemory32(0x000000F1, 0x401F8244, "Memory");
  87. __writeMemory32(0x000000F1, 0x401F8248, "Memory");
  88. __writeMemory32(0x000000F1, 0x401F824C, "Memory");
  89. __writeMemory32(0x000000F1, 0x401F8250, "Memory");
  90. __writeMemory32(0x000000F1, 0x401F8254, "Memory");
  91. __writeMemory32(0x000000F1, 0x401F8258, "Memory");
  92. __writeMemory32(0x000000F1, 0x401F825C, "Memory");
  93. __writeMemory32(0x000000F1, 0x401F8260, "Memory");
  94. __writeMemory32(0x000000F1, 0x401F8264, "Memory");
  95. __writeMemory32(0x000000F1, 0x401F8268, "Memory");
  96. __writeMemory32(0x000000F1, 0x401F826C, "Memory");
  97. __writeMemory32(0x000000F1, 0x401F8270, "Memory");
  98. __writeMemory32(0x000000F1, 0x401F8274, "Memory");
  99. __writeMemory32(0x000000F1, 0x401F8278, "Memory");
  100. __writeMemory32(0x000000F1, 0x401F827C, "Memory");
  101. __writeMemory32(0x000000F1, 0x401F8280, "Memory");
  102. __writeMemory32(0x000000F1, 0x401F8284, "Memory");
  103. __writeMemory32(0x000000F1, 0x401F8288, "Memory");
  104. __writeMemory32(0x000000F1, 0x401F828C, "Memory");
  105. __writeMemory32(0x000000F1, 0x401F8290, "Memory");
  106. __writeMemory32(0x000000F1, 0x401F8294, "Memory");
  107. __writeMemory32(0x000000F1, 0x401F8298, "Memory");
  108. __writeMemory32(0x000000F1, 0x401F829C, "Memory");
  109. __writeMemory32(0x000000F1, 0x401F82A0, "Memory");
  110. __writeMemory32(0x000000F1, 0x401F82A4, "Memory");
  111. __writeMemory32(0x000000F1, 0x401F82A8, "Memory");
  112. __writeMemory32(0x1000E000, 0x402F0000, "Memory");
  113. __writeMemory32(0x00030524, 0x402F0008, "Memory");
  114. __writeMemory32(0x06030524, 0x402F000C, "Memory");
  115. __writeMemory32(0x8000001B, 0x402F0010, "Memory");
  116. __writeMemory32(0x90000021, 0x402F0014, "Memory");
  117. __writeMemory32(0x00000008, 0x402F0004, "Memory");
  118. __writeMemory32(0x00000B27, 0x402F0040, "Memory");
  119. __writeMemory32(0x00100100, 0x402F0044, "Memory");
  120. __writeMemory32(0x00020201, 0x402F0048, "Memory");
  121. __writeMemory32(0x08193D0E, 0x402F004C, "Memory");
  122. __writeMemory32(0x00000021, 0x402F0080, "Memory");
  123. __writeMemory32(0x00888888, 0x402F0084, "Memory");
  124. __writeMemory32(0x00000002, 0x402F0094, "Memory");
  125. __writeMemory32(0x00000000, 0x402F0098, "Memory");
  126. __writeMemory32(0x80000000, 0x402F0090, "Memory");
  127. __writeMemory32(0xA55A000F, 0x402F009C, "Memory");
  128. SDRAM_WaitIpCmdDone();
  129. __writeMemory32(0x80000000, 0x402F0090, "Memory");
  130. __writeMemory32(0xA55A000C, 0x402F009C, "Memory");
  131. SDRAM_WaitIpCmdDone();
  132. __writeMemory32(0x80000000, 0x402F0090, "Memory");
  133. __writeMemory32(0xA55A000C, 0x402F009C, "Memory");
  134. SDRAM_WaitIpCmdDone();
  135. __writeMemory32(0x00000022, 0x402F00A0, "Memory");
  136. __writeMemory32(0x80000000, 0x402F0090, "Memory");
  137. __writeMemory32(0xA55A000A, 0x402F009C, "Memory");
  138. SDRAM_WaitIpCmdDone();
  139. __message "SDRAM init done\n";
  140. }
  141. _mpu_Init()
  142. {
  143. __var rbar0, rbar1, rbar2, rbar3, rbar4, rbar5, rbar6;
  144. rbar0 = ((0xC0000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (0U << 0U));
  145. rbar1 = ((0x80000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (1U << 0U));
  146. rbar2 = ((0x60000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (2U << 0U));
  147. rbar3 = ((0x10000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (3U << 0U));
  148. rbar4 = ((0x08000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (4U << 0U));
  149. rbar5 = ((0x80000000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (5U << 0U));
  150. rbar6 = ((0x81E00000U & ((0x7FFFFFFUL << 5U))) | (1UL << 4U) | (6U << 0U));
  151. __var rasr0, rasr1, rasr2, rasr3, rasr4, rasr5, rasr6;
  152. rasr0 = (0x3U << 24U) | (2UL << 19U) | (0xC0U << 8U) | (28U << 1U) | (1U << 0U);
  153. rasr1 = (0x3U << 24U) | (2UL << 19U) | (0xC0U << 8U) | (29U << 1U) | (1U << 0U);
  154. rasr2 = (0x3U << 24U) | (2UL << 19U) | (0xC0U << 8U) | (28U << 1U) | (1U << 0U);
  155. rasr3 = (0x3U << 24U) | (2UL << 19U) | (0xC0U << 8U) | (27U << 1U) | (1U << 0U);
  156. rasr4 = (0x3U << 24U) | (2UL << 19U) | (0xC0U << 8U) | (26U << 1U) | (1U << 0U);
  157. rasr5 = (0x3U << 24U) | (3UL << 16U) | (0xC0U << 8U) | (25U << 1U) | (1U << 0U);
  158. rasr6 = (0x3U << 24U) | (1UL << 19U) | (0xC0U << 8U) | (20U << 1U) | (1U << 0U);
  159. /* Enable Privileged default memory map and the MPU. */
  160. __var ctrl;
  161. ctrl = (0x1U << 0) | (1U << 2U);
  162. /* MPU_CTRL. */
  163. __writeMemory32(0x0, 0xE000ED94, "Memory");
  164. /* MPU_RBAR. */
  165. __writeMemory32(rbar6, 0xE000ED9C, "Memory");
  166. /* MPU_RASR. */
  167. __writeMemory32(rasr6, 0xE000EDA0, "Memory");
  168. /* MPU_RBAR. */
  169. __writeMemory32(rbar5, 0xE000ED9C, "Memory");
  170. /* MPU_RASR. */
  171. __writeMemory32(rasr5, 0xE000EDA0, "Memory");
  172. /* MPU_RBAR. */
  173. __writeMemory32(rbar4, 0xE000ED9C, "Memory");
  174. /* MPU_RASR. */
  175. __writeMemory32(rasr4, 0xE000EDA0, "Memory");
  176. /* MPU_RBAR. */
  177. __writeMemory32(rbar3, 0xE000ED9C, "Memory");
  178. /* MPU_RASR. */
  179. __writeMemory32(rasr3, 0xE000EDA0, "Memory");
  180. /* MPU_RBAR. */
  181. __writeMemory32(rbar2, 0xE000ED9C, "Memory");
  182. /* MPU_RASR. */
  183. __writeMemory32(rasr2, 0xE000EDA0, "Memory");
  184. /* MPU_RBAR. */
  185. __writeMemory32(rbar1, 0xE000ED9C, "Memory");
  186. /* MPU_RASR. */
  187. __writeMemory32(rasr1, 0xE000EDA0, "Memory");
  188. /* MPU_RBAR. */
  189. __writeMemory32(rbar0, 0xE000ED9C, "Memory");
  190. /* MPU_RASR. */
  191. __writeMemory32(rasr0, 0xE000EDA0, "Memory");
  192. /* MPU_CTRL. */
  193. __writeMemory32(ctrl, 0xE000ED94, "Memory");
  194. }
  195. _flexram_init()
  196. {
  197. __message "flexram init\n";
  198. __writeMemory32(0x80000000, 0x400AC040, "Memory"); //IOMUXC_GPR_GPR16
  199. //__writeMemory32(0xFFFFAA55, 0x400AC044, "Memory"); //IOMUXC_GPR_GPR17
  200. __writeMemory32(0xFFFFFFFF, 0x400AC044, "Memory"); //IOMUXC_GPR_GPR17
  201. __writeMemory32(0x00890000, 0x400AC038, "Memory"); //IOMUXC_GPR_GPR14
  202. __writeMemory32(0x80000007, 0x400AC040, "Memory"); //IOMUXC_GPR_GPR16
  203. }
  204. execUserPreload()
  205. {
  206. __message "execUserPreload() start.\n";
  207. _clock_init();
  208. _flexram_init();
  209. _sdr_Init();
  210. _mpu_Init();
  211. __message "execUserPreload() done.\n";
  212. }
  213. execUserReset()
  214. {
  215. __message "execUserReset() start.\n";
  216. _clock_init();
  217. _flexram_init();
  218. _sdr_Init();
  219. _mpu_Init();
  220. __message "execUserReset() done.\n";
  221. }