Linux内核源码分析--内核启动之(1)zImage自解压过程(Linux-3.0 ARMv7)

研究内核源码和内核运行原理的时候,很总要的一点是要了解内核的初始情况,也就是要了解内核启动过程。我在研究内核的内存管理的时候,想知道内核启动后的页表的放置,页表的初始化等信息,这促使我这次仔细地研究内核的启动代码。

    CPU在bootloader的帮助下将内核载入到了内存中,并开始执行。当然,bootloader必须为zImage做好必要的准备:
 1. CPU 寄存器的设置: R0=0;
R1=Machine ID(即Machine Type Number,定义在linux/arch/arm/tools/mach-types);
R2=内核启动参数在 RAM 中起始基地址;
 2. CPU 模式: 必须禁止中断(IRQs和FIQs);
CPU 必须 SVC 模式;
 3. Cache 和 MMU 的设置: MMU 必须关闭;
指令 Cache 可以打开也可以关闭;
数据 Cache 必须关闭;
 载自: 一、Boot Loader的概念和功能

    知道内核zImage生成的朋友一定知道:真正的内核执行映像其实是在编译时生成arch/$(ARCH)/boot/文件夹中的Image文件(bin文件),而zImage其实是将这个可执行文件作为数据段包含在了自身中,而 zImage的代码功能就是将这个数据(Image)正确地解压到编译时确定的位置中去,并跳到Image中运行 。所以实现bootloader引导的压缩映像zImage的 入口是由arch/arm /boot/compressed/vmlinux.lds 决定的(这个文件是由vmlinux.lds.in生成的)。所以从vmlinux.lds.in中可以看出压缩映像的入口在哪:

  1. ......
  2. OUTPUT_ARCH(arm)
  3. ENTRY(_start)
  4. SECTIONS
  5. {
  6. /DISCARD/ : {
  7. *(.ARM.exidx*)
  8. *(.ARM.extab*)
  9. /*
  10. * Discard any r/w data - this produces a link error if we have any,
  11. * which is required for PIC decompression. Local data generates
  12. * GOTOFF relocations, which prevents it being relocated independently
  13. * of the text/got segments.
  14. */
  15. *(.data)
  16. }
  17. . = TEXT_START;
  18. _text = .;
  19. .text : {
  20. _start = .;
  21. *(.start)
  22. *(.text)
  23. ......
    我们可以在arch/arm/boot/compressed/head.S找到这个start入口,这样就可以从这里开始用代码分析的方法研究bootloader跳转到压缩内核映像后的自解压启动过程:
    再看到MMU设置的时候,我只研究了armv7的指令。看这些代码,必须对ARM的MMU有一定的了解, 建议参考ARMv7的构架手册和网上的一份PDF《ARM MMU中文详解》(就是ARM手册中MMU部分的翻译)

  1. /*
  2. * linux/arch/arm/boot/compressed/head.S
  3. *
  4. * Copyright (C) 1996-2002 Russell King
  5. * Copyright (C) 2004 Hyok S. Choi (MPU support)
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License version 2 as
  9. * published by the Free Software Foundation.
  10. */
  11. #include <linux/linkage.h>
  12. /*
  13. * 调试宏
  14. *
  15. * 注意:这些宏必须不包含那些非100%可重定位的代码
  16. * 任何试图这样做的结果是导致程序崩溃
  17. * 当打开调试时请选择以下一个使用
  18. */
  19. #ifdef DEBUG /* 调试宏-中间层 */
  20. #if defined(CONFIG_DEBUG_ICEDCC) /* 使用内部调试协处理器CP14 */
  21. #if defined(CONFIG_CPU_V6) || defined(CONFIG_CPU_V6K) || defined(CONFIG_CPU_V7)
  22. .macro loadsp, rb, tmp
  23. .endm
  24. .macro writeb, ch, rb
  25. mcr p14, 0, \ch, c0, c5, 0
  26. .endm
  27. #elif defined(CONFIG_CPU_XSCALE)
  28. .macro loadsp, rb, tmp
  29. .endm
  30. .macro writeb, ch, rb
  31. mcr p14, 0, \ch, c8, c0, 0
  32. .endm
  33. #else
  34. .macro loadsp, rb, tmp
  35. .endm
  36. .macro writeb, ch, rb
  37. mcr p14, 0, \ch, c1, c0, 0
  38. .endm
  39. #endif
  40. #else /* 使用串口作为调试通道 */
  41. #include <mach/debug-macro.S> /* 包含构架相关的的调试宏的汇编文件 调试宏-底层 */
  42. .macro writeb, ch, rb
  43. senduart \ch, \rb
  44. .endm
  45. #if defined(CONFIG_ARCH_SA1100)
  46. .macro loadsp, rb, tmp
  47. mov \rb, #0x80000000 @ physical base address
  48. #ifdef CONFIG_DEBUG_LL_SER3
  49. add \rb, \rb, #0x00050000 @ Ser3
  50. #else
  51. add \rb, \rb, #0x00010000 @ Ser1
  52. #endif
  53. .endm
  54. #elif defined(CONFIG_ARCH_S3C2410)
  55. .macro loadsp, rb, tmp
  56. mov \rb, #0x50000000
  57. add \rb, \rb, #0x4000 * CONFIG_S3C_LOWLEVEL_UART_PORT
  58. .endm
  59. #else
  60. .macro loadsp, rb, tmp
  61. addruart \rb, \tmp
  62. .endm
  63. #endif
  64. #endif
  65. #endif /* DEBUG */
  66. /* 调试宏-上层 */
  67. .macro kputc,val /* 打印字符 */
  68. mov r0, \val
  69. bl putc
  70. .endm
  71. .macro kphex,val,len /* 打印十六进制数 */
  72. mov r0, \val
  73. mov r1, #\len
  74. bl phex
  75. .endm
  76. .macro debug_reloc_start /* 重定位内核调试宏-开始 */
  77. #ifdef DEBUG
  78. kputc #'\n'
  79. kphex r6, 8 /* 处理器 id */
  80. kputc #':'
  81. kphex r7, 8 /* 构架 id */
  82. #ifdef CONFIG_CPU_CP15
  83. kputc #':'
  84. mrc p15, 0, r0, c1, c0
  85. kphex r0, 8 /* 控制寄存器 */
  86. #endif
  87. kputc #'\n'
  88. kphex r5, 8 /* 解压后的内核起始地址 */
  89. kputc #'-'
  90. kphex r9, 8 /* 解压后的内核结束地址 */
  91. kputc #'>'
  92. kphex r4, 8 /* 内核执行地址 */
  93. kputc #'\n'
  94. #endif
  95. .endm
  96. .macro debug_reloc_end /* 重定位内核调试宏-结束 */
  97. #ifdef DEBUG
  98. kphex r5, 8 /* 内核结束地址 */
  99. kputc #'\n'
  100. mov r0, r4
  101. bl memdump /* 打印内核起始处 256 字节 */
  102. #endif
  103. .endm
  104. .section ".start", #alloc, #execinstr
  105. /*
  106. * 清理不同的调用约定
  107. */
  108. .align
  109. .arm @ 启动总是进入ARM状态
  110. start:
  111. .type start,#function
  112. .rept 7
  113. mov r0, r0
  114. .endr
  115. ARM( mov r0, r0 )
  116. ARM( b 1f )
  117. THUMB( adr r12, BSYM(1f) )
  118. THUMB( bx r12 )
  119. .word 0x016f2818 @ 用于boot loader的魔数
  120. .word start @ 加载/运行zImage的绝对地址(编译时确定)
  121. .word _edata @ zImage结束地址
  122. THUMB( .thumb )
  1. 1: mov r7, r1 @ 保存构架ID到r7(此前由bootloader放入r1)
  2.    mov r8, r2 @ 保存内核启动参数地址到r8(此前由bootloader放入r2)
  3. #ifndef __ARM_ARCH_2__
  4. /*
  5. * 通过Angel调试器启动 - 必须进入 SVC模式且关闭FIQs/IRQs
  6. * (numeric definitions from angel arm.h source).
  7. * 如果进入时在user模式下,我们只需要做这些
  8. */
  9. mrs r2, cpsr @ 获取当前模式
  10. tst r2, #3 @ 判断是否是user模式
  11. bne not_angel
  12. mov r0, #0x17 @ angel_SWIreason_EnterSVC
  13. ARM( swi 0x123456 ) @ angel_SWI_ARM
  14. THUMB( svc 0xab ) @ angel_SWI_THUMB
  15. not_angel:
  16. mrs r2, cpsr @ 关闭中断
  17. orr r2, r2, #0xc0 @ 以保护调试器的运作
  18. msr cpsr_c, r2
  19. #else
  20. teqp pc, #0x0c000003 @ 关闭中断(此外bootloader已设置模式为SVC)
  21. #endif
  22. /*
  23. * 注意一些缓存的刷新和其他事务可能需要在这里完成
  24. * - is there an Angel SWI call for this?
  25. */
  26. /*
  27. * 一些构架的特定代码可以在这里被连接器插入,
  28. * 但是不应使用 r7(保存构架ID), r8(保存内核启动参数地址), and r9.
  29. */
  30. .text
  31. /*
  32. * 此处确定解压后的内核映像的绝对地址(物理地址),保存于r4
  33. * 由于配置的不同可能有的结果
  34. * (1)定义了CONFIG_AUTO_ZRELADDR
  35. *      ZRELADDR是已解压内核最终存放的物理地址
  36. *      如果AUTO_ZRELADDR被选择了, 这个地址将会在运行是确定:
  37. *      将当pc值和0xf8000000做与操作,
  38. *      并加上TEXT_OFFSET(内核最终存放的物理地址与内存起始的偏移)
  39. *      这里假定zImage被放在内存开始的128MB内
  40. * (2)没有定义CONFIG_AUTO_ZRELADDR
  41. *      直接使用zreladdr(此值位于arch/arm/mach-xxx/Makefile.boot文件确定)
  42. */
  43. #ifdef CONFIG_AUTO_ZRELADDR
  44. @ 确定内核映像地址
  45. mov r4, pc
  46. and r4, r4, #0xf8000000
  47. add r4, r4, #TEXT_OFFSET
  48. #else
  49. ldr r4, =zreladdr
  50. #endif
  51. bl cache_on /* 开启缓存(以及MMU) */
  52. restart: adr r0, LC0
  53. ldmia r0, {r1, r2, r3, r6, r10, r11, r12}
  54. ldr sp, [r0, #28]
  55. /*
  56. * 我们可能运行在一个与编译时定义的不同地址上,
  57. * 所以我们必须修正变量指针
  58. */
  59. sub r0, r0, r1 @ 计算偏移量
  60. add r6, r6, r0 @ 重新计算_edata
  61. add r10, r10, r0 @ 重新获得压缩后的内核大小数据位置
  62. /*
  63. 内核编译系统将解压后的内核大小数据
  64. 以小端格式
  65. 附加在压缩数据的后面(其实是“gzip -f -9”命令的结果)
  66. * 下面代码的作用是将解压后的内核大小数据正确地放入r9中(避免了大小端问题)
  67. */
  68. ldrb r9, [r10, #0]
  69. ldrb lr, [r10, #1]
  70. orr r9, r9, lr, lsl #8
  71. ldrb lr, [r10, #2]
  72. ldrb r10, [r10, #3]
  73. orr r9, r9, lr, lsl #16
  74. orr r9, r9, r10, lsl #24
  75. /*
  76. * 下面代码的作用是将正确的当前执行映像的结束地址放入r10
  77. */
  78. #ifndef CONFIG_ZBOOT_ROM
  79. /* malloc 获取的内存空间位于重定向的栈指针之上 (64k max) */
  80. add sp, sp, r0
  81. add r10, sp, #0x10000
  82. #else
  83. /*
  84. * 如果定义了 ZBOOT_ROM, bss/stack 是非可重定位的,
  85. * 但有些人依然可以将其放在RAM中运行,
  86. * 这时我们可以参考 _edata.
  87. */
  88. mov r10, r6
  89. #endif
  90. /*
  91. * 检测我们是否会发生自我覆盖的问题
  92. * r4 = 解压后的内核起始地址(最终执行位置)
  93. * r9 = 解压后内核的大小
  94. * r10 = 当前执行映像的结束地址, 包含了 bss/stack/malloc 空间(假设是非XIP执行的)
  95. * 我们的基本需求是:
  96. * (若最终执行位置r4在当前映像之后)r4 - 16k 页目录 >= r10 -> OK
  97. * (若最终执行位置r4在当前映像之前)r4 + 解压后的内核大小 <= 当前位置 (pc) -> OK
  98. * 如果上面的条件不满足,就会自我覆盖,必须先搬运当前映像
  99. */
  100. add r10, r10, #16384
  101. cmp r4, r10         @ 假设最终执行位置r4在当前映像之后
  102. bhs wont_overwrite
  103. add r10, r4, r9     @ 假设最终执行位置r4在当前映像之前
  104. ARM( cmp r10, pc )  @ r10 = 解压后的内核结束地址
  105. THUMB( mov lr, pc )
  106. THUMB( cmp r10, lr )
  107. bls wont_overwrite
  108. /*
  109. 将当前的映像重定向到解压后的内核之后(会发生自我覆盖时才执行,否则就被跳过)
  110. * r6 = _edata(已校正)
  111. * r10 = 解压后的内核结束地址
  112. * 因为我们要把当前映像向后移动, 所以我们必须由后往前复制代码,
  113. 以防原数据和目标数据的重叠
  114. */
  115. /*
  116. * 将解压后的内核结束地址r10扩展(reloc_code_end - restart),
  117. * 并对齐到下一个256B边界。
  118. * 这样避免了当搬运的偏移较小时的自我覆盖
  119. */
  120. add r10, r10, #((reloc_code_end - restart + 256) & ~255)
  121. bic r10, r10, #255
  122. /* 获取需要搬运的当前映像的起始位置r5,并向下做32B对齐. */
  123. adr r5, restart
  124. bic r5, r5, #31
  125. sub r9, r6, r5 @ _edata - restart(已向下对齐)= 需要搬运的大小
  126. add r9, r9, #31
  127. bic r9, r9, #31 @ 做32B对齐 ,r9 = 需要搬运的大小
  128. add r6, r9, r5 @ r6 = 当前映像需要搬运的结束地址
  129. add r9, r9, r10 @ r9 = 当前映像搬运的目的地的结束地址
  130. /* 搬运当前执行映像,不包含 bss/stack/malloc 空间*/
  131. 1: ldmdb r6!, {r0 - r3, r10 - r12, lr}
  132. cmp r6, r5
  133. stmdb r9!, {r0 - r3, r10 - r12, lr}
  134. bhi 1b
  135. /* 保存偏移量,用来修改sp和实现代码跳转 */
  136. sub r6, r9, r6
  137. #ifndef CONFIG_ZBOOT_ROM
  138. /* cache_clean_flush 可能会使用栈,所以重定向sp指针 */
  139. add sp, sp, r6
  140. #endif
  141. bl cache_clean_flush @ 刷新缓存
  142. /* 通过搬运的偏移和当前的实际 restart 地址来实现代码跳转*/
  143. adr r0, BSYM(restart)
  144. add r0, r0, r6
  145. mov pc, r0
  146. /* 在上面的跳转之后,程序又从restart开始。
  147. * 但这次在检查自我覆盖的时候,新的执行位置必然满足
  148. * 最终执行位置r4在当前映像之前,r4 + 压缩后的内核大小 <= 当前位置 (pc)
  149. * 所以必然直接跳到了下面的wont_overwrite执行
  150. */
  151. wont_overwrite:
  152. /*
  153. * 如果delta(当前映像地址与编译时的地址偏移)为0, 我们运行的地址就是编译时确定的地址.
  154. * r0 = delta
  155. * r2 = BSS start(编译值)
  156. * r3 = BSS end(编译值)
  157. * r4 = 内核最终运行的物理地址
  158. * r7 = 构架ID(bootlodaer传递值)
  159. * r8 = 内核启动参数指针(bootlodaer传递值)
  160. * r11 = GOT start(编译值)
  161. * r12 = GOT end(编译值)
  162. * sp = stack pointer(修正值)
  163. */
  164. teq r0, #0 @测试delta值
  165. beq not_relocated @如果delta为0,无须对GOT表项和BSS进行重定位
  166. add r11, r11, r0 @重定位GOT start
  167. add r12, r12, r0 @重定位GOT end
  168. #ifndef CONFIG_ZBOOT_ROM
  169. /*
  170. * 如果内核配置 CONFIG_ZBOOT_ROM = n,
  171. * 我们必须修正BSS段的指针
  172. * 注意:sp已经被修正
  173. */
  174. add r2, r2, r0 @重定位BSS start
  175. add r3, r3, r0 @重定位BSS end
  176. /*
  177. * 重定位所有GOT表的入口项
  178. */
  179. 1: ldr r1, [r11, #0] @ 重定位GOT表的入口项
  180. add r1, r1, r0 @ 这个修正了 C 引用
  181. str r1, [r11], #4
  182. cmp r11, r12
  183. blo 1b
  184. #else
  185. /*
  186. * 重定位所有GOT表的入口项.
  187. * 我们只重定向在(已重定向后)BSS段外的入口
  188. */
  189. 1: ldr r1, [r11, #0] @ 重定位GOT表的入口项
  190. cmp r1, r2 @ entry < bss_start ||
  191. cmphs r3, r1 @ _end < entry table
  192. addlo r1, r1, r0 @ 这个修正了 C 引用
  193. str r1, [r11], #4
  194. cmp r11, r12
  195. blo 1b
  196. #endif
  197. /*
  198. * 至此当前映像的搬运和调整已经完成
  199. * 可以开始真正的工作的
  200. */
  201. not_relocated: mov r0, #0
  202. 1: str r0, [r2], #4 @ 清零 bss(初始化BSS段)
  203. str r0, [r2], #4
  204. str r0, [r2], #4
  205. str r0, [r2], #4
  206. cmp r2, r3
  207. blo 1b
  208. /*
  209. C运行时环境已经充分建立.
  210. 设置一些指针就可以解压内核了.
  211. * r4 = 内核最终运行的物理地址
  212. * r7 = 构架ID
  213. * r8 = 内核启动参数指针
  214. *
  215. * 下面对r0~r3的配置是decompress_kernel函数对应参数
  216. * r0 = 解压后的输出位置首地址
  217. * r1 = 可用RAM空间首地址
  218. * r2 = 可用RAM空间结束地址
  219. * r3 = 构架ID
  220. 就是这个decompress_kernel(C函数)输出了"Uncompressing Linux..."
  221. 以及" done, booting the kernel.\n"
  222. */
  223. mov r0, r4
  224. mov r1, sp @ malloc 获取的内存空间位于栈指针之上
  225. add r2, sp, #0x10000 @ 64k max
  226. mov r3, r7
  227. bl decompress_kernel
  228. /*
  229. * decompress_kernel(misc.c)--调用-->
  230. * do_decompress(decompress.c)--调用-->
  231. * decompress(../../../../lib/decompress_xxxx.c根据压缩方式的配置而不同)
  232. */
  233. /*
  234. * 以下是为跳入解压后的内核,再次做准备(恢复解压前的状态)
  235. */
  236. bl cache_clean_flush
  237. bl cache_off@ 数据缓存必须关闭(内核的要求)
  238. mov r0, #0 @ r0必须为0
  239. mov r1, r7@ 恢复构架ID到r1
  240. mov r2, r8 @ 恢复内核启动参数指针到r2
  241. mov pc, r4 @ 跳入解压后的内核映像(Image)入口(arch/arm/kernel/head.S)
  242. /*
  243. * 以下是为了确定当前运行时的地址和编译时确定的地址偏差,
  244. * 而将编译时确定的映像数据保存如下,用于检测对比
  245. */
  246. .align 2
  247. .type LC0, #object
  248. LC0: .word LC0 @ r1
  249. .word __bss_start @ r2
  250. .word _end @ r3
  251. .word _edata @ r6
  252. .word input_data_end - 4 @ r10 (inflated size location)
  253. .word _got_start @ r11
  254. .word _got_end @ ip
  255. .word .L_user_stack_end @ sp
  256. .size LC0, . - LC0
  257. #ifdef CONFIG_ARCH_RPC
  258. .globl params
  259. params: ldr r0, =0x10000100 @ params_phys for RPC
  260. mov pc, lr
  261. .ltorg
  262. .align
  263. #endif
  264. /*
  265. * 开启缓存.
  266. 我们必须创建页表(并开启MMU)才可以开启数据和指令缓存。
  267. 我们把页表(节描述符)放在内核执行地址前16k(0x4000)的空间中,
  268. 且我们希望没人会去用这段地址空间.
  269. 如果我们使用了,可能会出问题的!
  270. *
  271. * 进入时,
  272. * r4 = 内核最终运行的物理地址
  273. * r7 = 构架ID
  274. * r8 = 内核启动参数指针
  275. * 退出时,
  276. * r0, r1, r2, r3, r9, r10, r12 被修改
  277. * 此例程必须保护:
  278. * r4, r7, r8
  279. */
  280. .align 5
  281. cache_on: mov r3, #8 @ 调用cache_on 函数
  282. b call_cache_fn
  283. /*
  284. * Initialize the highest priority protection region, PR7
  285. * to cover all 32bit address and cacheable and bufferable.
  286. */
  287. __armv4_mpu_cache_on:
  288. mov r0, #0x3f @ 4G, the whole
  289. mcr p15, 0, r0, c6, c7, 0 @ PR7 Area Setting
  290. mcr p15, 0, r0, c6, c7, 1
  291. mov r0, #0x80 @ PR7
  292. mcr p15, 0, r0, c2, c0, 0 @ D-cache on
  293. mcr p15, 0, r0, c2, c0, 1 @ I-cache on
  294. mcr p15, 0, r0, c3, c0, 0 @ write-buffer on
  295. mov r0, #0xc000
  296. mcr p15, 0, r0, c5, c0, 1 @ I-access permission
  297. mcr p15, 0, r0, c5, c0, 0 @ D-access permission
  298. mov r0, #0
  299. mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
  300. mcr p15, 0, r0, c7, c5, 0 @ flush(inval) I-Cache
  301. mcr p15, 0, r0, c7, c6, 0 @ flush(inval) D-Cache
  302. mrc p15, 0, r0, c1, c0, 0 @ read control reg
  303. @ ...I .... ..D. WC.M
  304. orr r0, r0, #0x002d @ .... .... ..1. 11.1
  305. orr r0, r0, #0x1000 @ ...1 .... .... ....
  306. mcr p15, 0, r0, c1, c0, 0 @ write control reg
  307. mov r0, #0
  308. mcr p15, 0, r0, c7, c5, 0 @ flush(inval) I-Cache
  309. mcr p15, 0, r0, c7, c6, 0 @ flush(inval) D-Cache
  310. mov pc, lr
  311. __armv3_mpu_cache_on:
  312. mov r0, #0x3f @ 4G, the whole
  313. mcr p15, 0, r0, c6, c7, 0 @ PR7 Area Setting
  314. mov r0, #0x80 @ PR7
  315. mcr p15, 0, r0, c2, c0, 0 @ cache on
  316. mcr p15, 0, r0, c3, c0, 0 @ write-buffer on
  317. mov r0, #0xc000
  318. mcr p15, 0, r0, c5, c0, 0 @ access permission
  319. mov r0, #0
  320. mcr p15, 0, r0, c7, c0, 0 @ invalidate whole cache v3
  321. /*
  322. * ?? ARMv3 MMU does not allow reading the control register,
  323. * does this really work on ARMv3 MPU?
  324. */
  325. mrc p15, 0, r0, c1, c0, 0 @ read control reg
  326. @ .... .... .... WC.M
  327. orr r0, r0, #0x000d @ .... .... .... 11.1
  328. /* ?? this overwrites the value constructed above? */
  329. mov r0, #0
  330. mcr p15, 0, r0, c1, c0, 0 @ write control reg
  331. /* ?? invalidate for the second time? */
  332. mcr p15, 0, r0, c7, c0, 0 @ invalidate whole cache v3
  333. mov pc, lr
  334. /*
  335. * 初始化MMU页表
  336. * 内核最终运行的物理地址向下16K的空间
  337. * 存放可以寻址4G空间节描述符
  338. * (16KB/4B=4K个描述符,每个描述符映射1MB空间,4K*1MB = 4GB)
  339. * 进入时,
  340. * r4 = 内核最终运行的物理地址
  341. * r7 = 构架ID
  342. * r8 = 内核启动参数指针
  343. * 退出时,
  344. * r0, r1, r2, r3, r9, r10 被修改
  345. * 此例程必须保护:
  346. * r4, r7, r8
  347. */
  348. __setup_mmu: sub r3, r4, #16384 @ 页目录大小为16K
  349. bic r3, r3, #0xff @ 页目录指针向下对齐
  350. bic r3, r3, #0x3f00 @ 对齐方式-16KB
  351. /*
  352. * 对于这个对齐,是MMU硬件的要求
  353. * 转换表基址寄存器(CP15的寄存器2)保存着第一级转换表基址的物理地址。
  354. * 只有bits[31:14]有效,bits[13:0]应该是零(SBZ)。
  355. * 所以第一级表必须16KB对齐。
  356. */
  357. /*
  358. * 初始化页表, 仅针对RAM(最大到256MB)开启
  359. * 缓存(cacheable)和缓冲(bufferable)位
  360. * r3 = 页目录基址(内核最终运行的物理地址向下16K的位置)
  361. */
  362. mov r0, r3 @ 页目录指针给r0
  363. mov r9, r0, lsr #18
  364. mov r9, r9, lsl #18 @ 通过移位清零低18bit,得到RAM基地址(推测值,r9)
  365. add r10, r9, #0x10000000 @ 加一个合理的RAM大小(猜测值) = RAM结束地址(猜测值,r10)
  366. mov r1, #0x12
  367. orr r1, r1, #3 << 10 @ 初始化节描述符r1 = 0b110000010010(完全访问:0域:XN:节)
  368. add r2, r3, #16384 @ r2 = 内核最终运行的物理地址(可能)
  369. 1: cmp r1, r9 @ if virt > start of RAM(针对RAM开启缓存和缓冲)
  370. #ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
  371. orrhs r1, r1, #0x08 @ 设置 cacheable
  372. #else
  373. orrhs r1, r1, #0x0c @ 设置 cacheable, bufferable
  374. #endif
  375. cmp r1, r10 @ if virt > end of RAM
  376. bichs r1, r1, #0x0c @ 清除 cacheable, bufferable
  377. str r1, [r0], #4 @ 设置节描述符-1:1 映射(虚拟地址 == 物理地址)
  378. add r1, r1, #1048576 @ r1 + 1MB(每节管理的地址长度)下一个节描述符
  379. teq r0, r2
  380. bne 1b
  381. /*
  382. * 如果我们在flash中运行, 那么我们一定要为我们当前的代码开启缓存。
  383. * 我们映射2MB的代码,
  384. * 所以对于多达1MB压缩的内核没有映射重叠的问题??
  385. * 如果我们在RAM中运行, 那么我们只需要完成上面的工作即可,下面重复了.
  386. */
  387. mov r1, #0x1e
  388. orr r1, r1, #3 << 10 @ 初始化节描述符r1 = 0b110000011110(完全访问:0域:XN:cacheable:bufferable:节)
  389. mov r2, pc
  390. mov r2, r2, lsr #20 @ 当前执行地址的节基址
  391. orr r1, r1, r2, lsl #20 @ 生成节描述符
  392. add r0, r3, r2, lsl #2 @ 获得页目录中相应的入口
  393. str r1, [r0], #4 @ 设置节描述符-1:1 映射(虚拟地址 == 物理地址)
  394. add r1, r1, #1048576 @ r1 + 1MB(每节管理的地址长度)下一个节描述符
  395. str r1, [r0] @ 设置节描述符(只做2MB映射)
  396. mov pc, lr
  397. ENDPROC(__setup_mmu)
  398. __arm926ejs_mmu_cache_on:
  399. #ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
  400. mov r0, #4 @ put dcache in WT mode
  401. mcr p15, 7, r0, c15, c0, 0
  402. #endif
  403. __armv4_mmu_cache_on:
  404. mov r12, lr
  405. #ifdef CONFIG_MMU
  406. bl __setup_mmu
  407. mov r0, #0
  408. mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
  409. mcr p15, 0, r0, c8, c7, 0 @ flush I,D TLBs
  410. mrc p15, 0, r0, c1, c0, 0 @ read control reg
  411. orr r0, r0, #0x5000 @ I-cache enable, RR cache replacement
  412. orr r0, r0, #0x0030
  413. #ifdef CONFIG_CPU_ENDIAN_BE8
  414. orr r0, r0, #1 << 25 @ big-endian page tables
  415. #endif
  416. bl __common_mmu_cache_on
  417. mov r0, #0
  418. mcr p15, 0, r0, c8, c7, 0 @ flush I,D TLBs
  419. #endif
  420. mov pc, r12
  421. __armv7_mmu_cache_on:
  422. mov r12, lr @保存lr到r12
  423. #ifdef CONFIG_MMU
  424. mrc p15, 0, r11, c0, c1, 4 @ 读取CP15的ID_MMFR0(内存模块特性)寄存器
  425. tst r11, #0xf @ 测试VMSA(虚拟内存系统构架)A8 = 0x3
  426. blne __setup_mmu @ 如果VMSA不是0xf,就进入mmu页表初始化(节模式)
  427. mov r0, #0
  428. mcr p15, 0, r0, c7, c10, 4 @ 数据内存屏障(保证上面的写操作完成才继续)
  429. tst r11, #0xf @ 测试VMSA(虚拟内存系统构架)A8 = 0x3
  430. mcrne p15, 0, r0, c8, c7, 0 @ flush I,D TLBs缓存
  431. #endif
  432. mrc p15, 0, r0, c1, c0, 0 @ 读系统控制寄存器
  433. orr r0, r0, #0x5000 @ I-cache 使能, RR cache replacement
  434. orr r0, r0, #0x003c @ write buffer
  435. #ifdef CONFIG_MMU
  436. #ifdef CONFIG_CPU_ENDIAN_BE8
  437. orr r0, r0, #1 << 25 @ 大端模式页表
  438. #endif
  439. orrne r0, r0, #1 @ 设置MMU 开启位
  440. movne r1, #-1
  441. mcrne p15, 0, r3, c2, c0, 0 @ 载入页表基址到TTBR0
  442. mcrne p15, 0, r1, c3, c0, 0 @ 载入域访问控制数据到DACR(所有域都是Manager,所以XN会被忽略)
  443. #endif
  444. mcr p15, 0, r0, c1, c0, 0 @ 写系统控制寄存器
  445. mrc p15, 0, r0, c1, c0, 0 @ 回读系统控制寄存器
  446. mov r0, #0
  447. mcr p15, 0, r0, c7, c5, 4 @ 指令同步屏障(确保上面指令完成才返回)
  448. mov pc, r12 @ 此处返回(此时MMU已启用,RAM缓存已开启)
  449. __fa526_cache_on:
  450. mov r12, lr
  451. bl __setup_mmu
  452. mov r0, #0
  453. mcr p15, 0, r0, c7, c7, 0 @ Invalidate whole cache
  454. mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
  455. mcr p15, 0, r0, c8, c7, 0 @ flush UTLB
  456. mrc p15, 0, r0, c1, c0, 0 @ read control reg
  457. orr r0, r0, #0x1000 @ I-cache enable
  458. bl __common_mmu_cache_on
  459. mov r0, #0
  460. mcr p15, 0, r0, c8, c7, 0 @ flush UTLB
  461. mov pc, r12
  462. __arm6_mmu_cache_on:
  463. mov r12, lr
  464. bl __setup_mmu
  465. mov r0, #0
  466. mcr p15, 0, r0, c7, c0, 0 @ invalidate whole cache v3
  467. mcr p15, 0, r0, c5, c0, 0 @ invalidate whole TLB v3
  468. mov r0, #0x30
  469. bl __common_mmu_cache_on
  470. mov r0, #0
  471. mcr p15, 0, r0, c5, c0, 0 @ invalidate whole TLB v3
  472. mov pc, r12
  473. __common_mmu_cache_on:
  474. #ifndef CONFIG_THUMB2_KERNEL
  475. #ifndef DEBUG
  476. orr r0, r0, #0x000d @ Write buffer, mmu
  477. #endif
  478. mov r1, #-1
  479. mcr p15, 0, r3, c2, c0, 0 @ load page table pointer
  480. mcr p15, 0, r1, c3, c0, 0 @ load domain access control
  481. b 1f
  482. .align 5 @ cache line aligned
  483. 1: mcr p15, 0, r0, c1, c0, 0 @ load control register
  484. mrc p15, 0, r0, c1, c0, 0 @ and read it back to
  485. sub pc, lr, r0, lsr #32 @ properly flush pipeline
  486. #endif
  487. #define PROC_ENTRY_SIZE (4*5)
  488. /*
  489. * 这里是为不同的处理器提供遵循可重定向缓存支持的函数
  490. * 这是一个通用的为 定位入口 和 跳入一个(从块起始处到)特定偏移的指令 的钩子函数。
  491. * 请注意这是一个位置无关代码。
  492. *
  493. * r1 = 被修改
  494. * r2 = 被修改
  495. * r3 = 相对每个入口的功能函数位置偏移(on:#08|off:#12|flush:#16)
  496. * r9 = 被修改
  497. * r12 = 被修改
  498. */
  499. call_cache_fn: adr r12, proc_types
  500. #ifdef CONFIG_CPU_CP15
  501. mrc p15, 0, r9, c0, c0 @ 动态获取处理器ID
  502. #else
  503. ldr r9, =CONFIG_PROCESSOR_ID @ 使用预编译的处理器ID
  504. #endif
  505. 1: ldr r1, [r12, #0] @ 获取ID值
  506. ldr r2, [r12, #4] @ 获取对应的掩码
  507. eor r1, r1, r9 @ (real ^ match) 检测是否匹配
  508. tst r1, r2 @ & mask 将检测结果做掩码
  509. ARM( addeq pc, r12, r3 ) @ 如果匹配就调用缓存函数
  510. THUMB( addeq r12, r3 )
  511. THUMB( moveq pc, r12 ) @ call cache function
  512. add r12, r12, #PROC_ENTRY_SIZE @ 如果不匹配就跳过这个入口,进入下个测试
  513. b 1b
  514. /*
  515. * 缓存操作表. 这些是最基本的:
  516. * - CPU ID 匹配
  517. * - CPU ID 掩码
  518. * - 'cache on' 方法代码
  519. * - 'cache off' 方法代码
  520. * - 'cache flush' 方法代码
  521. *
  522. * 我们通过这个公式匹配入口: ((real_id ^ match) & mask) == 0
  523. *
  524. * 写通式缓存一般只需要 'on' 和 'off' 方法
  525. * 回写式缓存必须有 flush 方法定义
  526. *
  527. */
  528. .align 2
  529. .type proc_types,#object
  530. proc_types:
  531. .word 0x41560600 @ ARM6/610
  532. .word 0xffffffe0
  533. W(b) __arm6_mmu_cache_off @ 可以使用但是较慢
  534. W(b) __arm6_mmu_cache_off
  535. mov pc, lr
  536. THUMB( nop )
  537. @ b __arm6_mmu_cache_on @ 未测试
  538. @ b __arm6_mmu_cache_off
  539. @ b __armv3_mmu_cache_flush
  540. .word 0x00000000 @ old ARM ID
  541. .word 0x0000f000
  542. mov pc, lr
  543. THUMB( nop )
  544. mov pc, lr
  545. THUMB( nop )
  546. mov pc, lr
  547. THUMB( nop )
  548. .word 0x41007000 @ ARM7/710
  549. .word 0xfff8fe00
  550. W(b) __arm7_mmu_cache_off
  551. W(b) __arm7_mmu_cache_off
  552. mov pc, lr
  553. THUMB( nop )
  554. .word 0x41807200 @ ARM720T (写通式)
  555. .word 0xffffff00
  556. W(b) __armv4_mmu_cache_on
  557. W(b) __armv4_mmu_cache_off
  558. mov pc, lr
  559. THUMB( nop )
  560. .word 0x41007400 @ ARM74x
  561. .word 0xff00ff00
  562. W(b) __armv3_mpu_cache_on
  563. W(b) __armv3_mpu_cache_off
  564. W(b) __armv3_mpu_cache_flush
  565. .word 0x41009400 @ ARM94x
  566. .word 0xff00ff00
  567. W(b) __armv4_mpu_cache_on
  568. W(b) __armv4_mpu_cache_off
  569. W(b) __armv4_mpu_cache_flush
  570. .word 0x41069260 @ ARM926EJ-S (v5TEJ)
  571. .word 0xff0ffff0
  572. W(b) __arm926ejs_mmu_cache_on
  573. W(b) __armv4_mmu_cache_off
  574. W(b) __armv5tej_mmu_cache_flush
  575. .word 0x00007000 @ ARM7 IDs
  576. .word 0x0000f000
  577. mov pc, lr
  578. THUMB( nop )
  579. mov pc, lr
  580. THUMB( nop )
  581. mov pc, lr
  582. THUMB( nop )
  583. @ 以下使用新的 ID 系统.
  584. .word 0x4401a100 @ sa110 / sa1100
  585. .word 0xffffffe0
  586. W(b) __armv4_mmu_cache_on
  587. W(b) __armv4_mmu_cache_off
  588. W(b) __armv4_mmu_cache_flush
  589. .word 0x6901b110 @ sa1110
  590. .word 0xfffffff0
  591. W(b) __armv4_mmu_cache_on
  592. W(b) __armv4_mmu_cache_off
  593. W(b) __armv4_mmu_cache_flush
  594. .word 0x56056900
  595. .word 0xffffff00 @ PXA9xx
  596. W(b) __armv4_mmu_cache_on
  597. W(b) __armv4_mmu_cache_off
  598. W(b) __armv4_mmu_cache_flush
  599. .word 0x56158000 @ PXA168
  600. .word 0xfffff000
  601. W(b) __armv4_mmu_cache_on
  602. W(b) __armv4_mmu_cache_off
  603. W(b) __armv5tej_mmu_cache_flush
  604. .word 0x56050000 @ Feroceon
  605. .word 0xff0f0000
  606. W(b) __armv4_mmu_cache_on
  607. W(b) __armv4_mmu_cache_off
  608. W(b) __armv5tej_mmu_cache_flush
  609. #ifdef CONFIG_CPU_FEROCEON_OLD_ID
  610. /* this conflicts with the standard ARMv5TE entry */
  611. .long 0x41009260 @ Old Feroceon
  612. .long 0xff00fff0
  613. b __armv4_mmu_cache_on
  614. b __armv4_mmu_cache_off
  615. b __armv5tej_mmu_cache_flush
  616. #endif
  617. .word 0x66015261 @ FA526
  618. .word 0xff01fff1
  619. W(b) __fa526_cache_on
  620. W(b) __armv4_mmu_cache_off
  621. W(b) __fa526_cache_flush
  622. @ 这些匹配构架ID
  623. .word 0x00020000 @ ARMv4T
  624. .word 0x000f0000
  625. W(b) __armv4_mmu_cache_on
  626. W(b) __armv4_mmu_cache_off
  627. W(b) __armv4_mmu_cache_flush
  628. .word 0x00050000 @ ARMv5TE
  629. .word 0x000f0000
  630. W(b) __armv4_mmu_cache_on
  631. W(b) __armv4_mmu_cache_off
  632. W(b) __armv4_mmu_cache_flush
  633. .word 0x00060000 @ ARMv5TEJ
  634. .word 0x000f0000
  635. W(b) __armv4_mmu_cache_on
  636. W(b) __armv4_mmu_cache_off
  637. W(b) __armv5tej_mmu_cache_flush
  638. .word 0x0007b000 @ ARMv6
  639. .word 0x000ff000
  640. W(b) __armv4_mmu_cache_on
  641. W(b) __armv4_mmu_cache_off
  642. W(b) __armv6_mmu_cache_flush
  643. .word 0x000f0000 @ new CPU Id
  644. .word 0x000f0000
  645. W(b) __armv7_mmu_cache_on
  646. W(b) __armv7_mmu_cache_off
  647. W(b) __armv7_mmu_cache_flush
  648. .word 0 @ 未识别类型
  649. .word 0
  650. mov pc, lr
  651. THUMB( nop )
  652. mov pc, lr
  653. THUMB( nop )
  654. mov pc, lr
  655. THUMB( nop )
  656. .size proc_types, . - proc_types
  657. /*
  658. * 如果你获得了一个 "非常量的表达式".如果汇编器从这行返回" 申明"错误
  659. * 请检查下你是否偶尔在应该使用“W(b)”的地方写了"b"指令
  660. * 这是一个缓存方法跳转表的对齐检查机制
  661. * 在写汇编的时候可以借鉴
  662. */
  663. .if (. - proc_types) % PROC_ENTRY_SIZE != 0
  664. .error "The size of one or more proc_types entries is wrong."
  665. .endif
  666. /*
  667. * 关闭缓存和MMU. ARMv3不支持控制寄存器的读取,
  668. * 但ARMv4支持.
  669. *
  670. * 在退出时,
  671. * r0, r1, r2, r3, r9, r12 被篡改
  672. * 这个例程必须保护:
  673. * r4, r7, r8
  674. */
  675. .align 5
  676. cache_off: mov r3, #12 @ 缓存关闭函数
  677. b call_cache_fn
  678. __armv4_mpu_cache_off:
  679. mrc p15, 0, r0, c1, c0
  680. bic r0, r0, #0x000d
  681. mcr p15, 0, r0, c1, c0 @ turn MPU and cache off
  682. mov r0, #0
  683. mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
  684. mcr p15, 0, r0, c7, c6, 0 @ flush D-Cache
  685. mcr p15, 0, r0, c7, c5, 0 @ flush I-Cache
  686. mov pc, lr
  687. __armv3_mpu_cache_off:
  688. mrc p15, 0, r0, c1, c0
  689. bic r0, r0, #0x000d
  690. mcr p15, 0, r0, c1, c0, 0 @ turn MPU and cache off
  691. mov r0, #0
  692. mcr p15, 0, r0, c7, c0, 0 @ invalidate whole cache v3
  693. mov pc, lr
  694. __armv4_mmu_cache_off:
  695. #ifdef CONFIG_MMU
  696. mrc p15, 0, r0, c1, c0
  697. bic r0, r0, #0x000d
  698. mcr p15, 0, r0, c1, c0 @ turn MMU and cache off
  699. mov r0, #0
  700. mcr p15, 0, r0, c7, c7 @ invalidate whole cache v4
  701. mcr p15, 0, r0, c8, c7 @ invalidate whole TLB v4
  702. #endif
  703. mov pc, lr
  704. __armv7_mmu_cache_off:
  705. mrc p15, 0, r0, c1, c0 @ 读取系统控制寄存器SCTLR
  706. #ifdef CONFIG_MMU
  707. bic r0, r0, #0x000d @ 清零MMU和cache使能位
  708. #else
  709. bic r0, r0, #0x000c @ 清零cache使能位
  710. #endif
  711. mcr p15, 0, r0, c1, c0 @ 关闭MMU和cache
  712. mov r12, lr @ 保存lr到r12
  713. bl __armv7_mmu_cache_flush
  714. mov r0, #0
  715. #ifdef CONFIG_MMU
  716. mcr p15, 0, r0, c8, c7, 0 @ 废止整个TLB
  717. #endif
  718. mcr p15, 0, r0, c7, c5, 6 @ 废止BTC
  719. mcr p15, 0, r0, c7, c10, 4 @ 数据同步屏障
  720. mcr p15, 0, r0, c7, c5, 4 @ 指令同步屏障(确保上面指令完成才返回)
  721. mov pc, r12
  722. __arm6_mmu_cache_off:
  723. mov r0, #0x00000030 @ ARM6 control reg.
  724. b __armv3_mmu_cache_off
  725. __arm7_mmu_cache_off:
  726. mov r0, #0x00000070 @ ARM7 control reg.
  727. b __armv3_mmu_cache_off
  728. __armv3_mmu_cache_off:
  729. mcr p15, 0, r0, c1, c0, 0 @ turn MMU and cache off
  730. mov r0, #0
  731. mcr p15, 0, r0, c7, c0, 0 @ invalidate whole cache v3
  732. mcr p15, 0, r0, c5, c0, 0 @ invalidate whole TLB v3
  733. mov pc, lr
  734. /*
  735. * 清空和flush缓存以保持一致性
  736. *
  737. * 退出时,
  738. * r1, r2, r3, r9, r10, r11, r12 被篡改
  739. * 这个例程必须保护:
  740. * r4, r6, r7, r8
  741. */
  742. .align 5
  743. cache_clean_flush:
  744. mov r3, #16
  745. b call_cache_fn
  746. __armv4_mpu_cache_flush:
  747. mov r2, #1
  748. mov r3, #0
  749. mcr p15, 0, ip, c7, c6, 0 @ invalidate D cache
  750. mov r1, #7 << 5 @ 8 segments
  751. 1: orr r3, r1, #63 << 26 @ 64 entries
  752. 2: mcr p15, 0, r3, c7, c14, 2 @ clean & invalidate D index
  753. subs r3, r3, #1 << 26
  754. bcs 2b @ entries 63 to 0
  755. subs r1, r1, #1 << 5
  756. bcs 1b @ segments 7 to 0
  757. teq r2, #0
  758. mcrne p15, 0, ip, c7, c5, 0 @ invalidate I cache
  759. mcr p15, 0, ip, c7, c10, 4 @ drain WB
  760. mov pc, lr
  761. __fa526_cache_flush:
  762. mov r1, #0
  763. mcr p15, 0, r1, c7, c14, 0 @ clean and invalidate D cache
  764. mcr p15, 0, r1, c7, c5, 0 @ flush I cache
  765. mcr p15, 0, r1, c7, c10, 4 @ drain WB
  766. mov pc, lr
  767. __armv6_mmu_cache_flush:
  768. mov r1, #0
  769. mcr p15, 0, r1, c7, c14, 0 @ clean+invalidate D
  770. mcr p15, 0, r1, c7, c5, 0 @ invalidate I+BTB
  771. mcr p15, 0, r1, c7, c15, 0 @ clean+invalidate unified
  772. mcr p15, 0, r1, c7, c10, 4 @ drain WB
  773. mov pc, lr
  774. __armv7_mmu_cache_flush:
  775. mrc p15, 0, r10, c0, c1, 5 @ read ID_MMFR1
  776. tst r10, #0xf << 16 @ hierarchical cache (ARMv7)
  777. mov r10, #0
  778. beq hierarchical
  779. mcr p15, 0, r10, c7, c14, 0 @ clean+invalidate D
  780. b iflush
  781. hierarchical:
  782. mcr p15, 0, r10, c7, c10, 5 @ DMB
  783. stmfd sp!, {r0-r7, r9-r11}
  784. mrc p15, 1, r0, c0, c0, 1 @ read clidr
  785. ands r3, r0, #0x7000000 @ extract loc from clidr
  786. mov r3, r3, lsr #23 @ left align loc bit field
  787. beq finished @ if loc is 0, then no need to clean
  788. mov r10, #0 @ start clean at cache level 0
  789. loop1:
  790. add r2, r10, r10, lsr #1 @ work out 3x current cache level
  791. mov r1, r0, lsr r2 @ extract cache type bits from clidr
  792. and r1, r1, #7 @ mask of the bits for current cache only
  793. cmp r1, #2 @ see what cache we have at this level
  794. blt skip @ skip if no cache, or just i-cache
  795. mcr p15, 2, r10, c0, c0, 0 @ select current cache level in cssr
  796. mcr p15, 0, r10, c7, c5, 4 @ isb to sych the new cssr&csidr
  797. mrc p15, 1, r1, c0, c0, 0 @ read the new csidr
  798. and r2, r1, #7 @ extract the length of the cache lines
  799. add r2, r2, #4 @ add 4 (line length offset)
  800. ldr r4, =0x3ff
  801. ands r4, r4, r1, lsr #3 @ find maximum number on the way size
  802. clz r5, r4 @ find bit position of way size increment
  803. ldr r7, =0x7fff
  804. ands r7, r7, r1, lsr #13 @ extract max number of the index size
  805. loop2:
  806. mov r9, r4 @ create working copy of max way size
  807. loop3:
  808. ARM( orr r11, r10, r9, lsl r5 ) @ factor way and cache number into r11
  809. ARM( orr r11, r11, r7, lsl r2 ) @ factor index number into r11
  810. THUMB( lsl r6, r9, r5 )
  811. THUMB( orr r11, r10, r6 ) @ factor way and cache number into r11
  812. THUMB( lsl r6, r7, r2 )
  813. THUMB( orr r11, r11, r6 ) @ factor index number into r11
  814. mcr p15, 0, r11, c7, c14, 2 @ clean & invalidate by set/way
  815. subs r9, r9, #1 @ decrement the way
  816. bge loop3
  817. subs r7, r7, #1 @ decrement the index
  818. bge loop2
  819. skip:
  820. add r10, r10, #2 @ increment cache number
  821. cmp r3, r10
  822. bgt loop1
  823. finished:
  824. ldmfd sp!, {r0-r7, r9-r11}
  825. mov r10, #0 @ swith back to cache level 0
  826. mcr p15, 2, r10, c0, c0, 0 @ select current cache level in cssr
  827. iflush:
  828. mcr p15, 0, r10, c7, c10, 4 @ DSB
  829. mcr p15, 0, r10, c7, c5, 0 @ invalidate I+BTB
  830. mcr p15, 0, r10, c7, c10, 4 @ DSB
  831. mcr p15, 0, r10, c7, c5, 4 @ ISB
  832. mov pc, lr
  833. __armv5tej_mmu_cache_flush:
  834. 1: mrc p15, 0, r15, c7, c14, 3 @ test,clean,invalidate D cache
  835. bne 1b
  836. mcr p15, 0, r0, c7, c5, 0 @ flush I cache
  837. mcr p15, 0, r0, c7, c10, 4 @ drain WB
  838. mov pc, lr
  839. __armv4_mmu_cache_flush:
  840. mov r2, #64*1024 @ default: 32K dcache size (*2)
  841. mov r11, #32 @ default: 32 byte line size
  842. mrc p15, 0, r3, c0, c0, 1 @ read cache type
  843. teq r3, r9 @ cache ID register present?
  844. beq no_cache_id
  845. mov r1, r3, lsr #18
  846. and r1, r1, #7
  847. mov r2, #1024
  848. mov r2, r2, lsl r1 @ base dcache size *2
  849. tst r3, #1 << 14 @ test M bit
  850. addne r2, r2, r2, lsr #1 @ +1/2 size if M == 1
  851. mov r3, r3, lsr #12
  852. and r3, r3, #3
  853. mov r11, #8
  854. mov r11, r11, lsl r3 @ cache line size in bytes
  855. no_cache_id:
  856. mov r1, pc
  857. bic r1, r1, #63 @ align to longest cache line
  858. add r2, r1, r2
  859. 1:
  860. ARM( ldr r3, [r1], r11 ) @ s/w flush D cache
  861. THUMB( ldr r3, [r1] ) @ s/w flush D cache
  862. THUMB( add r1, r1, r11 )
  863. teq r1, r2
  864. bne 1b
  865. mcr p15, 0, r1, c7, c5, 0 @ flush I cache
  866. mcr p15, 0, r1, c7, c6, 0 @ flush D cache
  867. mcr p15, 0, r1, c7, c10, 4 @ drain WB
  868. mov pc, lr
  869. __armv3_mmu_cache_flush:
  870. __armv3_mpu_cache_flush:
  871. mov r1, #0
  872. mcr p15, 0, r1, c7, c0, 0 @ invalidate whole cache v3
  873. mov pc, lr
  874. /*
  875. * Various debugging routines for printing hex characters and
  876. * memory, which again must be relocatable.
  877. */
  878. #ifdef DEBUG
  879. .align 2
  880. .type phexbuf,#object
  881. phexbuf: .space 12
  882. .size phexbuf, . - phexbuf
  883. @ phex corrupts {r0, r1, r2, r3}
  884. phex: adr r3, phexbuf
  885. mov r2, #0
  886. strb r2, [r3, r1]
  887. 1: subs r1, r1, #1
  888. movmi r0, r3
  889. bmi puts
  890. and r2, r0, #15
  891. mov r0, r0, lsr #4
  892. cmp r2, #10
  893. addge r2, r2, #7
  894. add r2, r2, #'0'
  895. strb r2, [r3, r1]
  896. b 1b
  897. @ puts corrupts {r0, r1, r2, r3}
  898. puts: loadsp r3, r1
  899. 1: ldrb r2, [r0], #1
  900. teq r2, #0
  901. moveq pc, lr
  902. 2: writeb r2, r3
  903. mov r1, #0x00020000
  904. 3: subs r1, r1, #1
  905. bne 3b
  906. teq r2, #'\n'
  907. moveq r2, #'\r'
  908. beq 2b
  909. teq r0, #0
  910. bne 1b
  911. mov pc, lr
  912. @ putc corrupts {r0, r1, r2, r3}
  913. putc:
  914. mov r2, r0
  915. mov r0, #0
  916. loadsp r3, r1
  917. b 2b
  918. @ memdump corrupts {r0, r1, r2, r3, r10, r11, r12, lr}
  919. memdump: mov r12, r0
  920. mov r10, lr
  921. mov r11, #0
  922. 2: mov r0, r11, lsl #2
  923. add r0, r0, r12
  924. mov r1, #8
  925. bl phex
  926. mov r0, #':'
  927. bl putc
  928. 1: mov r0, #' '
  929. bl putc
  930. ldr r0, [r12, r11, lsl #2]
  931. mov r1, #8
  932. bl phex
  933. and r0, r11, #7
  934. teq r0, #3
  935. moveq r0, #' '
  936. bleq putc
  937. and r0, r11, #7
  938. add r11, r11, #1
  939. teq r0, #7
  940. bne 1b
  941. mov r0, #'\n'
  942. bl putc
  943. cmp r11, #64
  944. blt 2b
  945. mov pc, r10
  946. #endif
  947. .ltorg
  948. reloc_code_end:
  949. .align
  950. .section ".stack", "aw", %nobits
  951. .L_user_stack: .space 4096
  952. .L_user_stack_end:

     看了上面的源码,可能就算是分析过了也是比较模糊的,通过下面的一个代码流程图,大家就可以清楚的了解内核自解压的全过程了:



你可能感兴趣的:(Linux内核源码分析--内核启动之(1)zImage自解压过程(Linux-3.0 ARMv7))