sdram_mpu_init.ini 7.5 KB

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