lowlevel_init.S 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444
  1. /* SPDX-License-Identifier: GPL-2.0+ */
  2. /*
  3. * Memory Setup stuff - taken from blob memsetup.S
  4. *
  5. * Copyright (C) 2009 Samsung Electronics
  6. * Kyungmin Park <kyungmin.park@samsung.com>
  7. */
  8. #include <config.h>
  9. #include <asm/arch/cpu.h>
  10. #include <asm/arch/clock.h>
  11. #include <asm/arch/power.h>
  12. /*
  13. * Register usages:
  14. *
  15. * r5 has zero always
  16. * r7 has S5PC100 GPIO base, 0xE0300000
  17. * r8 has real GPIO base, 0xE0300000, 0xE0200000 at S5PC100, S5PC110 repectively
  18. * r9 has Mobile DDR size, 1 means 1GiB, 2 means 2GiB and so on
  19. */
  20. .globl lowlevel_init
  21. lowlevel_init:
  22. mov r11, lr
  23. /* r5 has always zero */
  24. mov r5, #0
  25. ldr r7, =S5PC100_GPIO_BASE
  26. ldr r8, =S5PC100_GPIO_BASE
  27. /* Read CPU ID */
  28. ldr r2, =S5PC110_PRO_ID
  29. ldr r0, [r2]
  30. mov r1, #0x00010000
  31. and r0, r0, r1
  32. cmp r0, r5
  33. beq 100f
  34. ldr r8, =S5PC110_GPIO_BASE
  35. 100:
  36. /* Turn on KEY_LED_ON [GPJ4(1)] XMSMWEN */
  37. cmp r7, r8
  38. beq skip_check_didle @ Support C110 only
  39. ldr r0, =S5PC110_RST_STAT
  40. ldr r1, [r0]
  41. and r1, r1, #0x000D0000
  42. cmp r1, #(0x1 << 19) @ DEEPIDLE_WAKEUP
  43. beq didle_wakeup
  44. cmp r7, r8
  45. skip_check_didle:
  46. addeq r0, r8, #0x280 @ S5PC100_GPIO_J4
  47. addne r0, r8, #0x2C0 @ S5PC110_GPIO_J4
  48. ldr r1, [r0, #0x0] @ GPIO_CON_OFFSET
  49. bic r1, r1, #(0xf << 4) @ 1 * 4-bit
  50. orr r1, r1, #(0x1 << 4)
  51. str r1, [r0, #0x0] @ GPIO_CON_OFFSET
  52. ldr r1, [r0, #0x4] @ GPIO_DAT_OFFSET
  53. bic r1, r1, #(1 << 1)
  54. str r1, [r0, #0x4] @ GPIO_DAT_OFFSET
  55. /* Don't setup at s5pc100 */
  56. beq 100f
  57. /*
  58. * Initialize Async Register Setting for EVT1
  59. * Because we are setting EVT1 as the default value of EVT0,
  60. * setting EVT0 as well does not make things worse.
  61. * Thus, for the simplicity, we set for EVT0, too
  62. *
  63. * The "Async Registers" are:
  64. * 0xE0F0_0000
  65. * 0xE1F0_0000
  66. * 0xF180_0000
  67. * 0xF190_0000
  68. * 0xF1A0_0000
  69. * 0xF1B0_0000
  70. * 0xF1C0_0000
  71. * 0xF1D0_0000
  72. * 0xF1E0_0000
  73. * 0xF1F0_0000
  74. * 0xFAF0_0000
  75. */
  76. ldr r0, =0xe0f00000
  77. ldr r1, [r0]
  78. bic r1, r1, #0x1
  79. str r1, [r0]
  80. ldr r0, =0xe1f00000
  81. ldr r1, [r0]
  82. bic r1, r1, #0x1
  83. str r1, [r0]
  84. ldr r0, =0xf1800000
  85. ldr r1, [r0]
  86. bic r1, r1, #0x1
  87. str r1, [r0]
  88. ldr r0, =0xf1900000
  89. ldr r1, [r0]
  90. bic r1, r1, #0x1
  91. str r1, [r0]
  92. ldr r0, =0xf1a00000
  93. ldr r1, [r0]
  94. bic r1, r1, #0x1
  95. str r1, [r0]
  96. ldr r0, =0xf1b00000
  97. ldr r1, [r0]
  98. bic r1, r1, #0x1
  99. str r1, [r0]
  100. ldr r0, =0xf1c00000
  101. ldr r1, [r0]
  102. bic r1, r1, #0x1
  103. str r1, [r0]
  104. ldr r0, =0xf1d00000
  105. ldr r1, [r0]
  106. bic r1, r1, #0x1
  107. str r1, [r0]
  108. ldr r0, =0xf1e00000
  109. ldr r1, [r0]
  110. bic r1, r1, #0x1
  111. str r1, [r0]
  112. ldr r0, =0xf1f00000
  113. ldr r1, [r0]
  114. bic r1, r1, #0x1
  115. str r1, [r0]
  116. ldr r0, =0xfaf00000
  117. ldr r1, [r0]
  118. bic r1, r1, #0x1
  119. str r1, [r0]
  120. /*
  121. * Diable ABB block to reduce sleep current at low temperature
  122. * Note that it's hidden register setup don't modify it
  123. */
  124. ldr r0, =0xE010C300
  125. ldr r1, =0x00800000
  126. str r1, [r0]
  127. 100:
  128. /* IO retension release */
  129. ldreq r0, =S5PC100_OTHERS @ 0xE0108200
  130. ldrne r0, =S5PC110_OTHERS @ 0xE010E000
  131. ldr r1, [r0]
  132. ldreq r2, =(1 << 31) @ IO_RET_REL
  133. ldrne r2, =((1 << 31) | (1 << 30) | (1 << 29) | (1 << 28))
  134. orr r1, r1, r2
  135. /* Do not release retention here for S5PC110 */
  136. streq r1, [r0]
  137. /* Disable Watchdog */
  138. ldreq r0, =S5PC100_WATCHDOG_BASE @ 0xEA200000
  139. ldrne r0, =S5PC110_WATCHDOG_BASE @ 0xE2700000
  140. str r5, [r0]
  141. /* setting SRAM */
  142. ldreq r0, =S5PC100_SROMC_BASE
  143. ldrne r0, =S5PC110_SROMC_BASE
  144. ldr r1, =0x9
  145. str r1, [r0]
  146. /* S5PC100 has 3 groups of interrupt sources */
  147. ldreq r0, =S5PC100_VIC0_BASE @ 0xE4000000
  148. ldrne r0, =S5PC110_VIC0_BASE @ 0xF2000000
  149. add r1, r0, #0x00100000
  150. add r2, r0, #0x00200000
  151. /* Disable all interrupts (VIC0, VIC1 and VIC2) */
  152. mvn r3, #0x0
  153. str r3, [r0, #0x14] @ INTENCLEAR
  154. str r3, [r1, #0x14] @ INTENCLEAR
  155. str r3, [r2, #0x14] @ INTENCLEAR
  156. /* Set all interrupts as IRQ */
  157. str r5, [r0, #0xc] @ INTSELECT
  158. str r5, [r1, #0xc] @ INTSELECT
  159. str r5, [r2, #0xc] @ INTSELECT
  160. /* Pending Interrupt Clear */
  161. str r5, [r0, #0xf00] @ INTADDRESS
  162. str r5, [r1, #0xf00] @ INTADDRESS
  163. str r5, [r2, #0xf00] @ INTADDRESS
  164. /* for UART */
  165. bl uart_asm_init
  166. bl internal_ram_init
  167. cmp r7, r8
  168. /* Clear wakeup status register */
  169. ldreq r0, =S5PC100_WAKEUP_STAT
  170. ldrne r0, =S5PC110_WAKEUP_STAT
  171. ldr r1, [r0]
  172. str r1, [r0]
  173. /* IO retension release */
  174. ldreq r0, =S5PC100_OTHERS @ 0xE0108200
  175. ldrne r0, =S5PC110_OTHERS @ 0xE010E000
  176. ldr r1, [r0]
  177. ldreq r2, =(1 << 31) @ IO_RET_REL
  178. ldrne r2, =((1 << 31) | (1 << 30) | (1 << 29) | (1 << 28))
  179. orr r1, r1, r2
  180. str r1, [r0]
  181. b 1f
  182. didle_wakeup:
  183. /* Wait when APLL is locked */
  184. ldr r0, =0xE0100100 @ S5PC110_APLL_CON
  185. lockloop:
  186. ldr r1, [r0]
  187. and r1, r1, #(1 << 29)
  188. cmp r1, #(1 << 29)
  189. bne lockloop
  190. ldr r0, =S5PC110_INFORM0
  191. ldr r1, [r0]
  192. mov pc, r1
  193. nop
  194. nop
  195. nop
  196. nop
  197. nop
  198. 1:
  199. mov lr, r11
  200. mov pc, lr
  201. /*
  202. * system_clock_init: Initialize core clock and bus clock.
  203. * void system_clock_init(void)
  204. */
  205. system_clock_init:
  206. ldr r0, =S5PC110_CLOCK_BASE @ 0xE0100000
  207. /* Check S5PC100 */
  208. cmp r7, r8
  209. bne 110f
  210. 100:
  211. /* Set Lock Time */
  212. ldr r1, =0xe10 @ Locktime : 0xe10 = 3600
  213. str r1, [r0, #0x000] @ S5PC100_APLL_LOCK
  214. str r1, [r0, #0x004] @ S5PC100_MPLL_LOCK
  215. str r1, [r0, #0x008] @ S5PC100_EPLL_LOCK
  216. str r1, [r0, #0x00C] @ S5PC100_HPLL_LOCK
  217. /* S5P_APLL_CON */
  218. ldr r1, =0x81bc0400 @ SDIV 0, PDIV 4, MDIV 444 (1333MHz)
  219. str r1, [r0, #0x100]
  220. /* S5P_MPLL_CON */
  221. ldr r1, =0x80590201 @ SDIV 1, PDIV 2, MDIV 89 (267MHz)
  222. str r1, [r0, #0x104]
  223. /* S5P_EPLL_CON */
  224. ldr r1, =0x80870303 @ SDIV 3, PDIV 3, MDIV 135 (67.5MHz)
  225. str r1, [r0, #0x108]
  226. /* S5P_HPLL_CON */
  227. ldr r1, =0x80600603 @ SDIV 3, PDIV 6, MDIV 96
  228. str r1, [r0, #0x10C]
  229. ldr r1, [r0, #0x300]
  230. ldr r2, =0x00003fff
  231. bic r1, r1, r2
  232. ldr r2, =0x00011301
  233. orr r1, r1, r2
  234. str r1, [r0, #0x300]
  235. ldr r1, [r0, #0x304]
  236. ldr r2, =0x00011110
  237. orr r1, r1, r2
  238. str r1, [r0, #0x304]
  239. ldr r1, =0x00000001
  240. str r1, [r0, #0x308]
  241. /* Set Source Clock */
  242. ldr r1, =0x00001111 @ A, M, E, HPLL Muxing
  243. str r1, [r0, #0x200] @ S5PC1XX_CLK_SRC0
  244. b 200f
  245. 110:
  246. ldr r0, =0xE010C000 @ S5PC110_PWR_CFG
  247. /* Set OSC_FREQ value */
  248. ldr r1, =0xf
  249. str r1, [r0, #0x100] @ S5PC110_OSC_FREQ
  250. /* Set MTC_STABLE value */
  251. ldr r1, =0xffffffff
  252. str r1, [r0, #0x110] @ S5PC110_MTC_STABLE
  253. /* Set CLAMP_STABLE value */
  254. ldr r1, =0x3ff03ff
  255. str r1, [r0, #0x114] @ S5PC110_CLAMP_STABLE
  256. ldr r0, =S5PC110_CLOCK_BASE @ 0xE0100000
  257. /* Set Clock divider */
  258. ldr r1, =0x14131330 @ 1:1:4:4, 1:4:5
  259. str r1, [r0, #0x300]
  260. ldr r1, =0x11110111 @ UART[3210]: MMC[3210]
  261. str r1, [r0, #0x310]
  262. /* Set Lock Time */
  263. ldr r1, =0x2cf @ Locktime : 30us
  264. str r1, [r0, #0x000] @ S5PC110_APLL_LOCK
  265. ldr r1, =0xe10 @ Locktime : 0xe10 = 3600
  266. str r1, [r0, #0x008] @ S5PC110_MPLL_LOCK
  267. str r1, [r0, #0x010] @ S5PC110_EPLL_LOCK
  268. str r1, [r0, #0x020] @ S5PC110_VPLL_LOCK
  269. /* S5PC110_APLL_CON */
  270. ldr r1, =0x80C80601 @ 800MHz
  271. str r1, [r0, #0x100]
  272. /* S5PC110_MPLL_CON */
  273. ldr r1, =0x829B0C01 @ 667MHz
  274. str r1, [r0, #0x108]
  275. /* S5PC110_EPLL_CON */
  276. ldr r1, =0x80600602 @ 96MHz VSEL 0 P 6 M 96 S 2
  277. str r1, [r0, #0x110]
  278. /* S5PC110_VPLL_CON */
  279. ldr r1, =0x806C0603 @ 54MHz
  280. str r1, [r0, #0x120]
  281. /* Set Source Clock */
  282. ldr r1, =0x10001111 @ A, M, E, VPLL Muxing
  283. str r1, [r0, #0x200] @ S5PC1XX_CLK_SRC0
  284. /* OneDRAM(DMC0) clock setting */
  285. ldr r1, =0x01000000 @ ONEDRAM_SEL[25:24] 1 SCLKMPLL
  286. str r1, [r0, #0x218] @ S5PC110_CLK_SRC6
  287. ldr r1, =0x30000000 @ ONEDRAM_RATIO[31:28] 3 + 1
  288. str r1, [r0, #0x318] @ S5PC110_CLK_DIV6
  289. /* XCLKOUT = XUSBXTI 24MHz */
  290. add r2, r0, #0xE000 @ S5PC110_OTHERS
  291. ldr r1, [r2]
  292. orr r1, r1, #(0x3 << 8) @ CLKOUT[9:8] 3 XUSBXTI
  293. str r1, [r2]
  294. /* CLK_IP0 */
  295. ldr r1, =0x8fefeeb @ DMC[1:0] PDMA0[3] IMEM[5]
  296. str r1, [r0, #0x460] @ S5PC110_CLK_IP0
  297. /* CLK_IP1 */
  298. ldr r1, =0xe9fdf0f9 @ FIMD[0] USBOTG[16]
  299. @ NANDXL[24]
  300. str r1, [r0, #0x464] @ S5PC110_CLK_IP1
  301. /* CLK_IP2 */
  302. ldr r1, =0xf75f7fc @ CORESIGHT[8] MODEM[9]
  303. @ HOSTIF[10] HSMMC0[16]
  304. @ HSMMC2[18] VIC[27:24]
  305. str r1, [r0, #0x468] @ S5PC110_CLK_IP2
  306. /* CLK_IP3 */
  307. ldr r1, =0x8eff038c @ I2C[8:6]
  308. @ SYSTIMER[16] UART0[17]
  309. @ UART1[18] UART2[19]
  310. @ UART3[20] WDT[22]
  311. @ PWM[23] GPIO[26] SYSCON[27]
  312. str r1, [r0, #0x46c] @ S5PC110_CLK_IP3
  313. /* CLK_IP4 */
  314. ldr r1, =0xfffffff1 @ CHIP_ID[0] TZPC[8:5]
  315. str r1, [r0, #0x470] @ S5PC110_CLK_IP3
  316. 200:
  317. /* wait at least 200us to stablize all clock */
  318. mov r2, #0x10000
  319. 1: subs r2, r2, #1
  320. bne 1b
  321. mov pc, lr
  322. internal_ram_init:
  323. ldreq r0, =0xE3800000
  324. ldrne r0, =0xF1500000
  325. ldr r1, =0x0
  326. str r1, [r0]
  327. mov pc, lr
  328. /*
  329. * uart_asm_init: Initialize UART's pins
  330. */
  331. uart_asm_init:
  332. /* set GPIO to enable UART0-UART4 */
  333. mov r0, r8
  334. ldr r1, =0x22222222
  335. str r1, [r0, #0x0] @ S5PC100_GPIO_A0_OFFSET
  336. ldr r1, =0x00002222
  337. str r1, [r0, #0x20] @ S5PC100_GPIO_A1_OFFSET
  338. /* Check S5PC100 */
  339. cmp r7, r8
  340. bne 110f
  341. /* UART_SEL GPK0[5] at S5PC100 */
  342. add r0, r8, #0x2A0 @ S5PC100_GPIO_K0_OFFSET
  343. ldr r1, [r0, #0x0] @ S5PC1XX_GPIO_CON_OFFSET
  344. bic r1, r1, #(0xf << 20) @ 20 = 5 * 4-bit
  345. orr r1, r1, #(0x1 << 20) @ Output
  346. str r1, [r0, #0x0] @ S5PC1XX_GPIO_CON_OFFSET
  347. ldr r1, [r0, #0x8] @ S5PC1XX_GPIO_PULL_OFFSET
  348. bic r1, r1, #(0x3 << 10) @ 10 = 5 * 2-bit
  349. orr r1, r1, #(0x2 << 10) @ Pull-up enabled
  350. str r1, [r0, #0x8] @ S5PC1XX_GPIO_PULL_OFFSET
  351. ldr r1, [r0, #0x4] @ S5PC1XX_GPIO_DAT_OFFSET
  352. orr r1, r1, #(1 << 5) @ 5 = 5 * 1-bit
  353. str r1, [r0, #0x4] @ S5PC1XX_GPIO_DAT_OFFSET
  354. b 200f
  355. 110:
  356. /*
  357. * Note that the following address
  358. * 0xE020'0360 is reserved address at S5PC100
  359. */
  360. /* UART_SEL MP0_5[7] at S5PC110 */
  361. add r0, r8, #0x360 @ S5PC110_GPIO_MP0_5_OFFSET
  362. ldr r1, [r0, #0x0] @ S5PC1XX_GPIO_CON_OFFSET
  363. bic r1, r1, #(0xf << 28) @ 28 = 7 * 4-bit
  364. orr r1, r1, #(0x1 << 28) @ Output
  365. str r1, [r0, #0x0] @ S5PC1XX_GPIO_CON_OFFSET
  366. ldr r1, [r0, #0x8] @ S5PC1XX_GPIO_PULL_OFFSET
  367. bic r1, r1, #(0x3 << 14) @ 14 = 7 * 2-bit
  368. orr r1, r1, #(0x2 << 14) @ Pull-up enabled
  369. str r1, [r0, #0x8] @ S5PC1XX_GPIO_PULL_OFFSET
  370. ldr r1, [r0, #0x4] @ S5PC1XX_GPIO_DAT_OFFSET
  371. orr r1, r1, #(1 << 7) @ 7 = 7 * 1-bit
  372. str r1, [r0, #0x4] @ S5PC1XX_GPIO_DAT_OFFSET
  373. 200:
  374. mov pc, lr