lowlevel_init.S 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156
  1. /*
  2. * For clock initialization, see chapter 3 of the "MCIMX27 Multimedia
  3. * Applications Processor Reference Manual, Rev. 0.2".
  4. *
  5. * (C) Copyright 2008 Eric Jarrige <eric.jarrige@armadeus.org>
  6. * (C) Copyright 2009 Ilya Yanok <yanok@emcraft.com>
  7. *
  8. * SPDX-License-Identifier: GPL-2.0+
  9. */
  10. #include <config.h>
  11. #include <asm/macro.h>
  12. #include <asm/arch/imx-regs.h>
  13. #include <generated/asm-offsets.h>
  14. SOC_ESDCTL_BASE_W: .word IMX_ESD_BASE
  15. SOC_SI_ID_REG_W: .word IMX_SYSTEM_CTL_BASE
  16. SDRAM_ESDCFG_T1_W: .word SDRAM_ESDCFG_REGISTER_VAL(0)
  17. SDRAM_ESDCFG_T2_W: .word SDRAM_ESDCFG_REGISTER_VAL(3)
  18. SDRAM_PRECHARGE_CMD_W: .word (ESDCTL_SDE | ESDCTL_SMODE_PRECHARGE | \
  19. ESDCTL_ROW13 | ESDCTL_COL10)
  20. SDRAM_AUTOREF_CMD_W: .word (ESDCTL_SDE | ESDCTL_SMODE_AUTO_REF | \
  21. ESDCTL_ROW13 | ESDCTL_COL10)
  22. SDRAM_LOADMODE_CMD_W: .word (ESDCTL_SDE | ESDCTL_SMODE_LOAD_MODE | \
  23. ESDCTL_ROW13 | ESDCTL_COL10)
  24. SDRAM_NORMAL_CMD_W: .word SDRAM_ESDCTL_REGISTER_VAL
  25. .macro init_aipi
  26. /*
  27. * setup AIPI1 and AIPI2
  28. */
  29. write32 AIPI1_PSR0, AIPI1_PSR0_VAL
  30. write32 AIPI1_PSR1, AIPI1_PSR1_VAL
  31. write32 AIPI2_PSR0, AIPI2_PSR0_VAL
  32. write32 AIPI2_PSR1, AIPI2_PSR1_VAL
  33. .endm /* init_aipi */
  34. .macro init_clock
  35. ldr r0, =CSCR
  36. /* disable MPLL/SPLL first */
  37. ldr r1, [r0]
  38. bic r1, r1, #(CSCR_MPEN|CSCR_SPEN)
  39. str r1, [r0]
  40. write32 MPCTL0, MPCTL0_VAL
  41. write32 SPCTL0, SPCTL0_VAL
  42. write32 CSCR, CSCR_VAL | CSCR_MPLL_RESTART | CSCR_SPLL_RESTART
  43. /*
  44. * add some delay here
  45. */
  46. wait_timer 0x1000
  47. /* peripheral clock divider */
  48. write32 PCDR0, PCDR0_VAL
  49. write32 PCDR1, PCDR1_VAL
  50. /* Configure PCCR0 and PCCR1 */
  51. write32 PCCR0, PCCR0_VAL
  52. write32 PCCR1, PCCR1_VAL
  53. .endm /* init_clock */
  54. .macro sdram_init
  55. ldr r0, SOC_ESDCTL_BASE_W
  56. mov r2, #PHYS_SDRAM_1
  57. /* Do initial reset */
  58. mov r1, #ESDMISC_MDDR_DL_RST
  59. str r1, [r0, #ESDMISC_ROF]
  60. /* Hold for more than 200ns */
  61. wait_timer 0x10000
  62. /* Activate LPDDR iface */
  63. mov r1, #ESDMISC_MDDREN
  64. str r1, [r0, #ESDMISC_ROF]
  65. /* Check The chip version TO1 or TO2 */
  66. ldr r1, SOC_SI_ID_REG_W
  67. ldr r1, [r1]
  68. ands r1, r1, #0xF0000000
  69. /* add Latency on CAS only for TO2 */
  70. ldreq r1, SDRAM_ESDCFG_T2_W
  71. ldrne r1, SDRAM_ESDCFG_T1_W
  72. str r1, [r0, #ESDCFG0_ROF]
  73. /* Run initialization sequence */
  74. ldr r1, SDRAM_PRECHARGE_CMD_W
  75. str r1, [r0, #ESDCTL0_ROF]
  76. ldr r1, [r2, #SDRAM_ALL_VAL]
  77. ldr r1, SDRAM_AUTOREF_CMD_W
  78. str r1, [r0, #ESDCTL0_ROF]
  79. ldr r1, [r2, #SDRAM_ALL_VAL]
  80. ldr r1, [r2, #SDRAM_ALL_VAL]
  81. ldr r1, SDRAM_LOADMODE_CMD_W
  82. str r1, [r0, #ESDCTL0_ROF]
  83. ldrb r1, [r2, #SDRAM_MODE_REGISTER_VAL]
  84. add r3, r2, #SDRAM_EXT_MODE_REGISTER_VAL
  85. ldrb r1, [r3]
  86. ldr r1, SDRAM_NORMAL_CMD_W
  87. str r1, [r0, #ESDCTL0_ROF]
  88. #if (CONFIG_NR_DRAM_BANKS > 1)
  89. /* 2nd sdram */
  90. mov r2, #PHYS_SDRAM_2
  91. /* Check The chip version TO1 or TO2 */
  92. ldr r1, SOC_SI_ID_REG_W
  93. ldr r1, [r1]
  94. ands r1, r1, #0xF0000000
  95. /* add Latency on CAS only for TO2 */
  96. ldreq r1, SDRAM_ESDCFG_T2_W
  97. ldrne r1, SDRAM_ESDCFG_T1_W
  98. str r1, [r0, #ESDCFG1_ROF]
  99. /* Run initialization sequence */
  100. ldr r1, SDRAM_PRECHARGE_CMD_W
  101. str r1, [r0, #ESDCTL1_ROF]
  102. ldr r1, [r2, #SDRAM_ALL_VAL]
  103. ldr r1, SDRAM_AUTOREF_CMD_W
  104. str r1, [r0, #ESDCTL1_ROF]
  105. ldr r1, [r2, #SDRAM_ALL_VAL]
  106. ldr r1, [r2, #SDRAM_ALL_VAL]
  107. ldr r1, SDRAM_LOADMODE_CMD_W
  108. str r1, [r0, #ESDCTL1_ROF]
  109. ldrb r1, [r2, #SDRAM_MODE_REGISTER_VAL]
  110. add r3, r2, #SDRAM_EXT_MODE_REGISTER_VAL
  111. ldrb r1, [r3]
  112. ldr r1, SDRAM_NORMAL_CMD_W
  113. str r1, [r0, #ESDCTL1_ROF]
  114. #endif /* CONFIG_NR_DRAM_BANKS > 1 */
  115. .endm /* sdram_init */
  116. .globl lowlevel_init
  117. lowlevel_init:
  118. mov r10, lr
  119. init_aipi
  120. init_clock
  121. sdram_init
  122. mov pc,r10