linux 3.6 启动源码分析(一)

时间:2023-01-04 01:01:05

作为需要和硬件打交道的工程师来说,比较关注的是驱动和CPU初始化这一块。所以我沿着启动的路线,重点学习一下和硬件相关的代码。就从linux解压的入口说起。学习阶段,基本是参考大神文章http://blog.chinaunix.net/uid/20543672/cid-6411-list-7.html所写。

linux自解压完成后就跳转到了解压后的内核(也就是vmlinux的bin版本Image),具体的入口可以在arch/arm/kernel/vmlinux.lds.S(最终的链接脚本是通过这个文件产生的)中获得:

这个入口在arch/arm/kernel/head.S中,这个文件就是Linux内核真正启动的地方,是初始化部分的开始,用汇编写成。他必须为后面的C代码做好准备

1./*

2. * linux/arch/arm/kernel/head.S

3. *

4. * Copyright (C) 1994-2002 Russell King

5. * Copyright (c) 2003 ARM Limited

6. * All Rights Reserved

7. *

8. * This program is free software; you can redistribute it and/or modify

9. * it under the terms of the GNU General Public License version 2 as

10. * published by the Free Software Foundation.

11. *

12. * 所有32-bit CPU的内核启动代码

13. */

14. #include <linux/linkage.h>

15. #include <linux/init.h>

16.

17. #include <asm/assembler.h>

18. #include <asm/domain.h>

19. #include <asm/ptrace.h>

20. #include <asm/asm-offsets.h>

21. #include <asm/memory.h>

22. #include <asm/thread_info.h>

23. #include <asm/system.h>

24.

25. #ifdef CONFIG_DEBUG_LL

26. #include <mach/debug-macro.S>

27. #endif

28.

29. /*

30. * swapper_pg_dir 是初始页表的虚拟地址.

31. * 我们将页表放在KERNEL_RAM_VADDR以下16K的空间中. 因此我们必须保证

32. * KERNEL_RAM_VADDR已经被正常设置.当前, 我们期望的是

33. * 这个地址的最后16 bits为0x8000, 但我们或许可以放宽这项限制到

34. * KERNEL_RAM_VADDR >= PAGE_OFFSET + 0x4000.

35. */

36. #define KERNEL_RAM_VADDR (PAGE_OFFSET + TEXT_OFFSET)

37. #if (KERNEL_RAM_VADDR & 0xffff) != 0x8000

38. #error KERNEL_RAM_VADDR must start at 0xXXXX8000

39. #endif

40.

41. .globl swapper_pg_dir

42. .equ swapper_pg_dir, KERNEL_RAM_VADDR - 0x4000

43.

44. /*

45. * TEXT_OFFSET 是内核代码(解压后)相对于RAM起始的偏移.

46. * 而#TEXT_OFFSET - 0x4000就是页表相对于RAM起始的偏移.

47. * 这个宏的作用是将phys(RAM的启示地址)加上页表的偏移,

48. * 而得到页表的起始物理地址

49. */

50. .macro pgtbl, rd, phys

51. add \rd, \phys, #TEXT_OFFSET - 0x4000

52. .endm

53.

54. #ifdef CONFIG_XIP_KERNEL

55. #define KERNEL_START XIP_VIRT_ADDR(CONFIG_XIP_PHYS_ADDR)

56. #define KERNEL_END _edata_loc

57. #else

58. #define KERNEL_START KERNEL_RAM_VADDR

59. #define KERNEL_END _end

60. #endif

61.

62. /*

63. * 内核启动入口点.

64. * ---------------------------

65. *

66. * 这个入口正常情况下是在解压完成后被调用的.

67. * 调用条件: MMU = off, D-cache = off, I-cache = dont care, r0 = 0,

68. * r1 = machine nr, r2 = atags or dtb pointer.

69. * 这些条件在解压完成后会被逐一满足,然后才跳转过来。

70. *

71. * 这些代码大多数是位置无关的, 如果你的内核入口地址在连接时确定为

72. * 0xc0008000, 你调用此函数的物理地址就是 __pa(0xc0008000).

73. *

74. * 完整的machineID列表,请参见 linux/arch/arm/tools/mach-types

75. *

76. * 我们尽量让代码简洁; 不在此处添加任何设备特定的代码

77. * - 这些特定的初始化代码是boot loader的工作(或在极端情况下,

78. * 有充分理由的情况下, 可以由zImage完成)。

79. */

80. __HEAD

81. ENTRY(stext)

82. setmode PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9 @ CPU模式设置宏

83. @ (进入svc模式并且关闭中断)

84. mrc p15, 0, r9, c0, c0 @ 获取处理器id-->r9

85. bl __lookup_processor_type @ 返回r5=procinfo r9=cpuid

86. movs r10, r5 @ r10=r5,并可以检测r5=0?注意当前r10的值

87. THUMB( it eq ) @ force fixup-able long branch encoding

88. beq __error_p @ yes, error 'p'如果r5=0,则内核处理器不匹配,出错~死循环

89.

90. /*

91. * 获取RAM的起始物理地址,并保存于 r8 = phys_offset

92. * XIP内核与普通在RAM中运行的内核不同

93. * (1)CONFIG_XIP_KERNEL

94. * 通过运行时计算????

95. * (2)正常RAM中运行的内核

96. * 通过编译时确定(PLAT_PHYS_OFFSET 一般在arch/arm/mach-xxx/include/mach/memory.h定义)

97. *

98. */

99. #ifndef CONFIG_XIP_KERNEL

100. adr r3, 2f

101. ldmia r3, {r4, r8}

102. sub r4, r3, r4 @ (PHYS_OFFSET - PAGE_OFFSET)

103. add r8, r8, r4 @ PHYS_OFFSET

104. #else

105. ldr r8, =PLAT_PHYS_OFFSET

106. #endif

107.

108. /*

109. * r1 = machine no, r2 = atags or dtb,

110. * r8 = phys_offset, r9 = cpuid, r10 = procinfo

111. */

112. bl __vet_atags @ 判断r2(内核启动参数)指针的有效性

113. #ifdef CONFIG_SMP_ON_UP

114. bl __fixup_smp @ ???如果运行SMP内核在单处理器系统中启动,做适当调整

115. #endif

116. #ifdef CONFIG_ARM_PATCH_PHYS_VIRT

117. bl __fixup_pv_table @ ????根据内核在内存中的位置修正物理地址与虚拟地址的转换机制

118. #endif

119. bl __create_page_tables @ 初始化页表!

120.

121. /*

122. * 以下使用位置无关的方法调用的是CPU特定代码。

123. * 详情请见arch/arm/mm/proc-*.S

124. * r10 = xxx_proc_info 结构体的基地址(在上面__lookup_processor_type函数中选中的)

125. * 返回时, CPU 已经为 MMU 的启动做好了准备,

126. * 且 r0 保存着CPU控制寄存器的值.

127. */

128. ldr r13, =__mmap_switched @ 在MMU启动之后跳入的第一个虚拟地址

129. adr lr, BSYM(1f) @ 设置返回的地址(PIC)

130. mov r8, r4 @ 将swapper_pg_dir的物理地址放入r8,

131. @ 以备__enable_mmu中将其放入TTBR1

132. ARM( add pc, r10, #PROCINFO_INITFUNC ) @ 跳入构架相关的初始化处理器函数(例如A8的是__v7_setup)

133. THUMB( add r12, r10, #PROCINFO_INITFUNC ) @主要目的只配置CP15(包括缓存配置)

134. THUMB( mov pc, r12 )

135. 1: b __enable_mmu @ 启动MMU

136. ENDPROC(stext)

137. .ltorg

138. #ifndef CONFIG_XIP_KERNEL

139. 2: .long .

140. .long PAGE_OFFSET

141. #endif

142.

143. /*

144. * 创建初始化页表.我们只创建最基本的页表,

145. * 以满足内核运行的需要,

146. * 这通常意味着仅映射内核代码本身.

147. *

148. * r8 = phys_offset, r9 = cpuid, r10 = procinfo

149. *

150. * 返回:

151. *r0, r3, r5-r7 被篡改

152. *r4 = 页表物理地址

153. */

154. __create_page_tables:

155. pgtbl r4, r8 @ 现在r4 = 页表的起始物理地址

156.

157. /*

158. * 清零16K的一级初始页表区

159. * 这些页表在内核自解压时被设置过

160. * (此时MMU已关闭)

161. */

162. mov r0, r4

163. mov r3, #0

164. add r6, r0, #0x4000

165. 1: str r3, [r0], #4

166. str r3, [r0], #4

167. str r3, [r0], #4

168. str r3, [r0], #4

169. teq r0, r6

170. bne 1b

171.

172. /*

173. * 获取节描述符的默认配置(除节基址外的其他配置)

174. * 这个数据依构架而不同,数据是用汇编文件配置的:

175. * arch/arm/mm/proc-xxx.S

176. * (此时MMU已关闭)

177. */

178. ldr r7, [r10, #PROCINFO_MM_MMUFLAGS] @ 获取mm_mmuflags(节描述符默认配置),保存于r7

179.

180. /*

181. * 创建特定映射,以满足__enable_mmu的需求。

182. * 此特定映射将被paging_init()删除。

183. *

184. * 其实这个特定的映射就是仅映射__enable_mmu功能函数区的页表

185. * 以保证在启用mmu时代码的正确执行--1:1映射(物理地址=虚拟地址)

186. */

187. adr r0, __enable_mmu_loc

188. ldmia r0, {r3, r5, r6}

189. sub r0, r0, r3 @ 获取编译时确定的虚拟地址到当前物理地址的偏移

190. add r5, r5, r0 @ __enable_mmu的当前物理地址

191. add r6, r6, r0 @ __enable_mmu_end的当前物理地址

192. mov r5, r5, lsr #20 @ __enable_mmu的节基址

193. mov r6, r6, lsr #20 @ __enable_mmu_end的节基址

194.

195. 1: orr r3, r7, r5, lsl #20 @ 生成节描述符:flags + 节基址

196. str r3, [r4, r5, lsl #2] @ 设置节描述符,1:1映射(物理地址=虚拟地址)

197. teq r5, r6 @ 完成映射?(理论上一次就够了,这个函数应该不会大于1M吧~)

198. addne r5, r5, #1 @ r5 = 下一节的基址

199. bne 1b

200.

201. /*

202. * 现在创建内核的逻辑映射区页表(节映射)

203. * 创建范围:KERNEL_START---KERNEL_END

204. * KERNEL_START:内核最终运行的虚拟地址

205. * KERNEL_END:内核代码结束的虚拟地址(bss段之后,但XIP不是)

206. */

207. mov r3, pc @ 获取当前物理地址

208. mov r3, r3, lsr #20 @ r3 = 当前物理地址的节基址

209. orr r3, r7, r3, lsl #20 @ r3 为当前物理地址的节描述符

210. /*

211. * 下面是为了确定页表项的入口地址

212. * 其实页表入口项的偏移就反应了对应的虚拟地址的高位

213. *

214. * 由于ARM指令集的8bit位图问题,只能分两次得到

215. * KERNEL_START:内核最终运行的虚拟地址

216. *

217. */

218. add r0, r4, #(KERNEL_START & 0xff000000) >> 18

219. str r3, [r0, #(KERNEL_START & 0x00f00000) >> 18]!

220. ldr r6, =(KERNEL_END - 1)

221. add r0, r0, #4

222. add r6, r4, r6, lsr #18 @ r6 = 内核逻辑映射结束的节基址

223. 1: cmp r0, r6

224. add r3, r3, #1 << 20 @ 生成节描述符(只需做基址递增)

225. strls r3, [r0], #4 @ 设置节描述符

226. bls 1b

227.

228. #ifdef CONFIG_XIP_KERNEL

229. /*

230. * 如果是XIP技术的内核,上面的映射只能映射内核代码和只读数据部分

231. * 这里我们再映射一些RAM来作为 .data and .bss 空间.

232. */

233. add r3, r8, #TEXT_OFFSET

234. orr r3, r3, r7 @ 生成节描述符:flags + 节基址

235. add r0, r4, #(KERNEL_RAM_VADDR & 0xff000000) >> 18

236. str r3, [r0, #(KERNEL_RAM_VADDR & 0x00f00000) >> 18]!

237. ldr r6, =(_end - 1)

238. add r0, r0, #4

239. add r6, r4, r6, lsr #18

240. 1: cmp r0, r6

241. add r3, r3, #1 << 20

242. strls r3, [r0], #4

243. bls 1b

244. #endif

245.

246. /*

247. * 然后映射启动参数区(现在r2中的atags物理地址)

248. * 或者

249. * 如果启动参数区的虚拟地址没有确定(或者无效),则会映射RAM的头1MB.

250. */

251. mov r0, r2, lsr #20

252. movs r0, r0, lsl #20

253. moveq r0, r8 @ 如果atags指针无效,则r0 = r8(映射RAM的头1MB)

254. sub r3, r0, r8

255. add r3, r3, #PAGE_OFFSET @ 转换为虚拟地址

256. add r3, r4, r3, lsr #18 @ 确定页表项(节描述符)入口地址

257. orr r6, r7, r0 @ 生成节描述符

258. str r6, [r3] @ 设置节描述符

259.

260. /*

261. * 下面是调试信息的输出函数区

262. * 这里做了IO内存空间的节映射

263. */

264. #ifdef CONFIG_DEBUG_LL

265. #ifndef CONFIG_DEBUG_ICEDCC

266. /*

267. * 为串口调试映射IO内存空间(将串口IO内存之上的所有地址都映射了)

268. * 这允许调试信息(在paging_init之前)从串口控制台输出

269. *

270. */

271. addruart r7, r3 @ 宏代码,位于arch/arm/mach-xxx/include/mach/debug-macro.S

272. @ 作用是将串口控制寄存器的基址放入r7(物理地址)和r3(虚拟地址)

273. mov r3, r3, lsr #20

274. mov r3, r3, lsl #2

275.

276. add r0, r4, r3 @ r0为串口IO内存映射页表项的入口地址

277. rsb r3, r3, #0x4000 @ 16K(PTRS_PER_PGD*sizeof(long))-r3

278. cmp r3, #0x0800 @ limit to 512MB,入口地址有效性检查(只能在最后#0x0800内)

279. movhi r3, #0x0800 @ 也就是说虚拟地址被限制在3.5G以上

280. add r6, r0, r3 @ r6为页表结束地址

281. mov r3, r7, lsr #20

282. ldr r7, [r10, #PROCINFO_IO_MMUFLAGS] @ io_mmuflags

283. orr r3, r7, r3, lsl #20 @ 生成节描述符

284. 1: str r3, [r0], #4

285. add r3, r3, #1 << 20

286. teq r0, r6

287. bne 1b

288.

289. #else /* CONFIG_DEBUG_ICEDCC */

290. /* 我们无需任何串口调试映射 for ICEDCC */

291. ldr r7, [r10, #PROCINFO_IO_MMUFLAGS] @ io_mmuflags

292. #endif /* !CONFIG_DEBUG_ICEDCC */

293.

294. #if defined(CONFIG_ARCH_NETWINDER) || defined(CONFIG_ARCH_CATS)

295. /*

296. * 如果我们在使用 NetWinder 或 CATS,我们也需要为调试信息映射

297. * 16550-type 串口

298. */

299. add r0, r4, #0xff000000 >> 18

300. orr r3, r7, #0x7c000000

301. str r3, [r0]

302. #endif

303. #ifdef CONFIG_ARCH_RPC

304. /*

305. * Map in screen at 0x02000000 & SCREEN2_BASE

306. * Similar reasons here - for debug. This is

307. * only for Acorn RiscPC architectures.

308. */

309. add r0, r4, #0x02000000 >> 18

310. orr r3, r7, #0x02000000

311. str r3, [r0]

312. add r0, r4, #0xd8000000 >> 18

313. str r3, [r0]

314. #endif

315. #endif

316. mov pc, lr @页表创建结束,返回

317. ENDPROC(__create_page_tables)

318. .ltorg

319. .align

320. __enable_mmu_loc:

321. .long .

322. .long __enable_mmu

323. .long __enable_mmu_end

324.

325. #if defined(CONFIG_SMP)

326. __CPUINIT

327. ENTRY(secondary_startup)

328. /*

329. * Common entry point for secondary CPUs.

330. *

331. * Ensure that we're in SVC mode, and IRQs are disabled. Lookup

332. * the processor type - there is no need to check the machine type

333. * as it has already been validated by the primary processor.

334. */

335. setmode PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9

336. mrc p15, 0, r9, c0, c0 @ get processor id

337. bl __lookup_processor_type

338. movs r10, r5 @ invalid processor?

339. moveq r0, #'p' @ yes, error 'p'

340. THUMB( it eq ) @ force fixup-able long branch encoding

341. beq __error_p

342.

343. /*

344. * Use the page tables supplied from __cpu_up.

345. */

346. adr r4, __secondary_data

347. ldmia r4, {r5, r7, r12} @ address to jump to after

348. sub lr, r4, r5 @ mmu has been enabled

349. ldr r4, [r7, lr] @ get secondary_data.pgdir

350. add r7, r7, #4

351. ldr r8, [r7, lr] @ get secondary_data.swapper_pg_dir

352. adr lr, BSYM(__enable_mmu) @ return address

353. mov r13, r12 @ __secondary_switched address

354. ARM( add pc, r10, #PROCINFO_INITFUNC ) @ initialise processor

355. @ (return control reg)

356. THUMB( add r12, r10, #PROCINFO_INITFUNC )

357. THUMB( mov pc, r12 )

358. ENDPROC(secondary_startup)

359.

360. /*

361. * r6 = &secondary_data

362. */

363. ENTRY(__secondary_switched)

364. ldr sp, [r7, #4] @ get secondary_data.stack

365. mov fp, #0

366. b secondary_start_kernel

367. ENDPROC(__secondary_switched)

368.

369. .align

370.

371. .type __secondary_data, %object

372. __secondary_data:

373. .long .

374. .long secondary_data

375. .long __secondary_switched

376. #endif /* defined(CONFIG_SMP) */

377.

378.

379.

380. /*

381. * 在最后启动MMU前,设置一些常用位 Essentially

382. * 其实,这里只是加载了页表指针和域访问控制数据寄存器

383. *

384. *

385. *r0 = cp#15 control register

386. * r1 = machine ID

387. * r2 = atags or dtb pointer

388. * r4 = page table pointer

389. * r9 = processor ID

390. * r13 = 最后要跳入的虚拟地址

391. */

392. __enable_mmu:

393. #ifdef CONFIG_ALIGNMENT_TRAP

394. orr r0, r0, #CR_A

395. #else

396. bic r0, r0, #CR_A

397. #endif

398. #ifdef CONFIG_CPU_DCACHE_DISABLE

399. bic r0, r0, #CR_C

400. #endif

401. #ifdef CONFIG_CPU_BPREDICT_DISABLE

402. bic r0, r0, #CR_Z

403. #endif

404. #ifdef CONFIG_CPU_ICACHE_DISABLE

405. bic r0, r0, #CR_I

406. #endif

407. mov r5, #(domain_val(DOMAIN_USER, DOMAIN_MANAGER) | \

408. domain_val(DOMAIN_KERNEL, DOMAIN_MANAGER) | \

409. domain_val(DOMAIN_TABLE, DOMAIN_MANAGER) | \

410. domain_val(DOMAIN_IO, DOMAIN_CLIENT)) @设置域访问控制数据

411. mcr p15, 0, r5, c3, c0, 0 @ 载入域访问控制数据到DACR

412. mcr p15, 0, r4, c2, c0, 0 @ 载入页表基址到TTBR0

413. b __turn_mmu_on @ 开启MMU

414. ENDPROC(__enable_mmu)

415.

416. /*

417. * 使能 MMU.这完全改变了可见的内存地址空间结构。

418. * 您将无法通过这里跟踪执行。

419. * 如果你已对此进行探究, *请*在向邮件列表发送另一个新帖之前,

420. * 检查linux-arm-kernel的邮件列表归档

421. *

422. *r0 = cp#15 control register

423. * r1 = machine ID

424. * r2 = atags or dtb pointer

425. * r9 = processor ID

426. * r13 = 最后要跳入的*虚拟*地址

427. *

428. * 其他寄存器依赖上面的调用函数

429. */

430. .align 5

431. __turn_mmu_on:

432. mov r0, r0

433. mcr p15, 0, r0, c1, c0, 0 @ 设置cp#15控制寄存器(启用MMU)

434. mrc p15, 0, r3, c0, c0, 0 @ read id reg

435. mov r3, r3

436. mov r3, r13 @ r3中装入最后要跳入的*虚拟*地址

437. mov pc, r3 @ 跳转到__mmap_switched

438. __enable_mmu_end:

439. ENDPROC(__turn_mmu_on)

440.

441.

442. #ifdef CONFIG_SMP_ON_UP

443. __INIT

444. __fixup_smp:

445. and r3, r9, #0x000f0000 @ architecture version

446. teq r3, #0x000f0000 @ CPU ID supported?

447. bne __fixup_smp_on_up @ no, assume UP

448.

449. bic r3, r9, #0x00ff0000

450. bic r3, r3, #0x0000000f @ mask 0xff00fff0

451. mov r4, #0x41000000

452. orr r4, r4, #0x0000b000

453. orr r4, r4, #0x00000020 @ val 0x4100b020

454. teq r3, r4 @ ARM 11MPCore?

455. moveq pc, lr @ yes, assume SMP

456.

457. mrc p15, 0, r0, c0, c0, 5 @ read MPIDR

458. and r0, r0, #0xc0000000 @ multiprocessing extensions and

459. teq r0, #0x80000000 @ not part of a uniprocessor system?

460. moveq pc, lr @ yes, assume SMP

461.

462. __fixup_smp_on_up:

463. adr r0, 1f

464. ldmia r0, {r3 - r5}

465. sub r3, r0, r3

466. add r4, r4, r3

467. add r5, r5, r3

468. b __do_fixup_smp_on_up

469. ENDPROC(__fixup_smp)

470.

471. .align

472. 1: .word .

473. .word __smpalt_begin

474. .word __smpalt_end

475.

476. .pushsection .data

477. .globl smp_on_up

478. smp_on_up:

479. ALT_SMP(.long 1)

480. ALT_UP(.long 0)

481. .popsection

482. #endif

483.

484. .text

485. __do_fixup_smp_on_up:

486. cmp r4, r5

487. movhs pc, lr

488. ldmia {r0, r6}

489. ARM( str r6, [r0, r3] )

490. THUMB( add r0, r0, r3 )

491. #ifdef __ARMEB__

492. THUMB( mov r6, r6, ror #16 ) @ Convert word order for big-endian.

493. #endif

494. THUMB( strh r6, [r0], #2 ) @ For Thumb-2, store as two halfwords

495. THUMB( mov r6, r6, lsr #16 ) @ to be robust against misaligned r3.

496. THUMB( strh r6, [r0] )

497. b __do_fixup_smp_on_up

498. ENDPROC(__do_fixup_smp_on_up)

499.

500. ENTRY(fixup_smp)

501. stmfd {r4 - r6, lr}

502. mov r4, r0

503. add r5, r0, r1

504. mov r3, #0

505. bl __do_fixup_smp_on_up

506. ldmfd {r4 - r6, pc}

507. ENDPROC(fixup_smp)

508.

509. #ifdef CONFIG_ARM_PATCH_PHYS_VIRT

510.

511. /* __fixup_pv_table - patch the stub instructions with the delta between

512. * PHYS_OFFSET and PAGE_OFFSET, which is assumed to be 16MiB aligned and

513. * can be expressed by an immediate shifter operand. The stub instruction

514. * has a form of '(add|sub) rd, rn, #imm'.

515. */

516. __HEAD

517. __fixup_pv_table:

518. adr r0, 1f

519. ldmia r0, {r3-r5, r7}

520. sub r3, r0, r3 @ PHYS_OFFSET - PAGE_OFFSET

521. add r4, r4, r3 @ adjust table start address

522. add r5, r5, r3 @ adjust table end address

523. add r7, r7, r3 @ adjust __pv_phys_offset address

524. str r8, [r7] @ save computed PHYS_OFFSET to __pv_phys_offset

525. #ifndef CONFIG_ARM_PATCH_PHYS_VIRT_16BIT

526. mov r6, r3, lsr #24 @ constant for add/sub instructions

527. teq r3, r6, lsl #24 @ must be 16MiB aligned

528. #else

529. mov r6, r3, lsr #16 @ constant for add/sub instructions

530. teq r3, r6, lsl #16 @ must be 64kiB aligned

531. #endif

532. THUMB( it ne @ cross section branch )

533. bne __error

534. str r6, [r7, #4] @ save to __pv_offset

535. b __fixup_a_pv_table

536. ENDPROC(__fixup_pv_table)

537.

538. .align

539. 1: .long .

540. .long __pv_table_begin

541. .long __pv_table_end

542. 2: .long __pv_phys_offset

543.

544. .text

545. __fixup_a_pv_table:

546. #ifdef CONFIG_THUMB2_KERNEL

547. #ifdef CONFIG_ARM_PATCH_PHYS_VIRT_16BIT

548. lsls r0, r6, #24

549. lsr r6, #8

550. beq 1f

551. clz r7, r0

552. lsr r0, #24

553. lsl r0, r7

554. bic r0, 0x0080

555. lsrs r7, #1

556. orrcs r0, #0x0080

557. orr r0, r0, r7, lsl #12

558. #endif

559. 1: lsls r6, #24

560. beq 4f

561. clz r7, r6

562. lsr r6, #24

563. lsl r6, r7

564. bic r6, #0x0080

565. lsrs r7, #1

566. orrcs r6, #0x0080

567. orr r6, r6, r7, lsl #12

568. orr r6, #0x4000

569. b 4f

570. 2: @ at this point the C flag is always clear

571. add r7, r3

572. #ifdef CONFIG_ARM_PATCH_PHYS_VIRT_16BIT

573. ldrh ip, [r7]

574. tst ip, 0x0400 @ the i bit tells us LS or MS byte

575. beq 3f

576. cmp r0, #0 @ set C flag, and ...

577. biceq ip, 0x0400 @ immediate zero value has a special encoding

578. streqh ip, [r7] @ that requires the i bit cleared

579. #endif

580. 3: ldrh ip, [r7, #2]

581. and ip, 0x8f00

582. orrcc ip, r6 @ mask in offset bits 31-24

583. orrcs ip, r0 @ mask in offset bits 23-16

584. strh ip, [r7, #2]

585. 4: cmp r4, r5

586. ldrcc r7, [r4], #4 @ use branch for delay slot

587. bcc 2b

588. bx lr

589. #else

590. #ifdef CONFIG_ARM_PATCH_PHYS_VIRT_16BIT

591. and r0, r6, #255 @ offset bits 23-16

592. mov r6, r6, lsr #8 @ offset bits 31-24

593. #else

594. mov r0, #0 @ just in case...

595. #endif

596. b 3f

597. 2: ldr ip, [r7, r3]

598. bic ip, ip, #0x000000ff

599. tst ip, #0x400 @ rotate shift tells us LS or MS byte

600. orrne ip, ip, r6 @ mask in offset bits 31-24

601. orreq ip, ip, r0 @ mask in offset bits 23-16

602. str ip, [r7, r3]

603. 3: cmp r4, r5

604. ldrcc r7, [r4], #4 @ use branch for delay slot

605. bcc 2b

606. mov pc, lr

607. #endif

608. ENDPROC(__fixup_a_pv_table)

609.

610. ENTRY(fixup_pv_table)

611. stmfd {r4 - r7, lr}

612. ldr r2, 2f @ get address of __pv_phys_offset

613. mov r3, #0 @ no offset

614. mov r4, r0 @ r0 = table start

615. add r5, r0, r1 @ r1 = table size

616. ldr r6, [r2, #4] @ get __pv_offset

617. bl __fixup_a_pv_table

618. ldmfd {r4 - r7, pc}

619. ENDPROC(fixup_pv_table)

620.

621. .align

622. 2: .long __pv_phys_offset

623.

624. .data

625. .globl __pv_phys_offset

626. .type __pv_phys_offset, %object

627. __pv_phys_offset:

628. .long 0

629. .size __pv_phys_offset, . - __pv_phys_offset

630. __pv_offset:

631. .long 0

632. #endif

633.

634. #include "head-common.S"


arch/arm/kernel/head-common.S

1./*

2. * linux/arch/arm/kernel/head-common.S

3. *

4. * Copyright (C) 1994-2002 Russell King

5. * Copyright (c) 2003 ARM Limited

6. * All Rights Reserved

7. *

8. * This program is free software; you can redistribute it and/or modify

9. * it under the terms of the GNU General Public License version 2 as

10. * published by the Free Software Foundation.

11. *

12. */

13.

14. #define ATAG_CORE 0x54410001

15. #define ATAG_CORE_SIZE ((2*4 + 3*4) >> 2)

16. #define ATAG_CORE_SIZE_EMPTY ((2*4) >> 2)

17.

18. #ifdef CONFIG_CPU_BIG_ENDIAN

19. #define OF_DT_MAGIC 0xd00dfeed

20. #else

21. #define OF_DT_MAGIC 0xedfe0dd0 /* 0xd00dfeed in big-endian */

22. #endif

23.

24. /*

25. * 异常处理.一些我们无法处理的错误.

26. * 我们应当告诉用户(这些错误信息),但因为我们甚至无法保证是在正确的架构上运行,

27. * 所以我们什么都不做(死循环)。

28. *

29. * 如果 CONFIG_DEBUG_LL 被设置,我们试图打印出错误信息,

30. * 并希望这可以对我们有帮助 (例如这对bootloader没有提供适当的处理器ID

31. * 是有帮助的).

32. */

33. __HEAD

34.

35. /* 确定r2(内核启动参数)指针的有效性。 The heuristic 要求

36. * 是4Byte对齐的、在物理内存的头16K中,且以ATAG_CORE标记开头。

37. * 如果选择了CONFIG_OF_FLATTREE,dtb指针也是可以接受的.

38. *

39. * 在这个函数的未来版本中 可能会对物理地址的要求更为宽松,

40. * 且如果有必要的话,可能可以移动ATAGS数据块.

41. *

42. * 返回:

43. *r2 可能是有效的 atags 指针, 有效的 dtb 指针,或者0

44. * r5, r6 被篡改

45. */

46. __vet_atags:

47. tst r2, #0x3 @ 是否4Byte对齐?

48. bne 1f @ 不是则认为指针无效,返回

49.

50. ldr r5, [r2, #0] @获取r2指向的前4Byte,用于下面测试

51. #ifdef CONFIG_OF_FLATTREE

52. ldr r6, =OF_DT_MAGIC @ is it a DTB?

53. cmp r5, r6

54. beq 2f

55. #endif

56.

57. /* 内核启动参数块的规范是:

58. * (wait for updata)

59. */

60. cmp r5, #ATAG_CORE_SIZE @ 第一个tag是ATAG_CORE吗?测试的是tag_header中的size

61. @ 如果为ATAG_CORE,那么必为ATAG_CORE_SIZE

62. cmpne r5, #ATAG_CORE_SIZE_EMPTY @ 如果第一个tag的tag_header中的size为ATAG_CORE_SIZE_EMPTY

63. @ 说明此处也有atags

64. bne 1f

65. ldr r5, [r2, #4] @ 第一个tag_header的tag(魔数)

66. ldr r6, =ATAG_CORE @ 获取ATAG_CORE的魔数

67. cmp r5, r6 @ 判断第一个tag是否为ATAG_CORE

68. bne 1f @ 不是则认为指针无效,返回

69.

70. 2: mov pc, lr @ atag/dtb 指针有效

71.

72. 1: mov r2, #0

73. mov pc, lr

74. ENDPROC(__vet_atags)

75.

76. /*

77. * 以下的代码段是在MMU开启的状态下执行的,

78. * 而且使用的是绝对地址; 这不是位置无关代码.

79. *

80. *r0 = cp#15 控制寄存器值

81. *r1 = machine ID

82. * r2 = atags/dtb pointer

83. * r9 = processor ID

84. */

85. __INIT

86. __mmap_switched:

87. adr r3, __mmap_switched_data

88.

89. ldmia {r4, r5, r6, r7}

90. cmp r4, r5 @ 如果有必要,拷贝数据段。

91. @ 对比__data_loc和_sdata

92. @ __data_loc是数据段在内核代码映像中的存储位置

93. @ _sdata是数据段的链接位置(在内存中的位置)

94. @ 如果是XIP技术的内核,这两个数据肯定不同

95. 1: cmpne r5, r6 @ 检测数据是否拷贝完成

96. ldrne fp, [r4], #4

97. strne fp, [r5], #4

98. bne 1b

99.

100. mov fp, #0 @ 清零 BSS 段(and zero fp)

101. 1: cmp r6, r7 @ 检测是否完成

102. strcc fp, [r6],#4

103. bcc 1b

104.

105. /* 这里将需要的数据从寄存器中转移到全局变量中,

106. * 因为最后会跳入C代码,寄存器会被使用。

107. */

108. ARM( ldmia r3, {r4, r5, r6, r7, sp})

109. THUMB( ldmia r3, {r4, r5, r6, r7} )

110. THUMB( ldr sp, [r3, #16] )

111. str r9, [r4] @ 保存 processor ID到全局变量processor_id

112. str r1, [r5] @ 保存 machine type到全局变量__machine_arch_type

113. str r2, [r6] @ 保存 atags指针到全局变量__atags_pointer

114. bic r4, r0, #CR_A @ 清除cp15 控制寄存器值的 'A' bit(禁用对齐错误检查)

115. stmia r7, {r0, r4} @ 保存控制寄存器值到全局变量cr_alignment(在arch/arm/kernel/entry-armv.S)

116. b start_kernel @ 跳入C代码(init/main.c)

117. ENDPROC(__mmap_switched)

118.

119. .align 2

120. .type __mmap_switched_data, %object

121. __mmap_switched_data:

122. .long __data_loc @ r4

123. .long _sdata @ r5

124. .long __bss_start @ r6

125. .long _end @ r7

126. .long processor_id @ r4

127. .long __machine_arch_type @ r5

128. .long __atags_pointer @ r6

129. .long cr_alignment @ r7

130. .long init_thread_union + THREAD_START_SP @ sp

131. .size __mmap_switched_data, . - __mmap_switched_data

132.

133. /*

134. * 这里提供一个 C-API 版本的 __lookup_processor_type

135. */

136. ENTRY(lookup_processor_type)

137. stmfd {r4 - r6, r9, lr}

138. mov r9, r0

139. bl __lookup_processor_type

140. mov r0, r5

141. ldmfd {r4 - r6, r9, pc}

142. ENDPROC(lookup_processor_type)

143.

144. /*

145. * 读取处理器ID寄存器 (CP#15, CR0), 并且查找编译时确定的处理器

146. * 支持列表.注意:我们不能对__proc_info使用绝对地址,

147. * 因为我们还没有重新初始化页表(MMU已关闭,之前是解压时使用的1:1映射)。

148. * (我们不在正确的地址空间:内核是按虚拟地址(0xc00008000)编译的,

149. * 而现在我们运行在MMU关闭的情况下)。

150. * 我们必须计算偏移量。

151. *

152. * r9 = cpuid

153. * Returns:

154. * r3, r4, r6 被篡改

155. * r5 = proc_info 指针(物理地址空间)

156. * r9 = cpuid (保留)

157. */

158. __CPUINIT

159. __lookup_processor_type:

160. adr r3, __lookup_processor_type_data @获取运行时的地址数据

161. ldmia r3, {r4 - r6} @获取编译时确定的地址数据(虚拟地址)

162. sub r3, r3, r4 @ 获取地址偏移 virt&phys(r3)

163. add r5, r5, r3 @ 将虚拟地址空间转换为物理地址空间

164. add r6, r6, r3 @ r5=__proc_info_begin r6=__proc_info_end

165. 1: ldmia r5, {r3, r4} @ 获取proc_info_list结构体中的value, mask

166. and r4, r4, r9 @ 利用掩码处理从CP15获取的处理器ID

167. teq r3, r4 @ 对比编译时确定的处理器ID

168. beq 2f @ 若处理器ID匹配,返回

169. add r5, r5, #PROC_INFO_SZ @ 利用sizeof(proc_info_list)跳入下一个处理器ID的匹配

170. cmp r5, r6 @ 是否已经处理完proc_info_list数据

171. blo 1b @ 如果还有proc_info_list数据,再次检查匹配

172. mov r5, #0 @ 否则,编译的内核与此处理器不匹配,r5 = #0

173. 2: mov pc, lr

174. ENDPROC(__lookup_processor_type)

175.

176. /*

177. * 参见 <asm/procinfo.h> 中关于 __proc_info 结构体的信息.

178. */

179. .align 2

180. .type __lookup_processor_type_data, %object

181. __lookup_processor_type_data:

182. .long .

183. .long __proc_info_begin

184. .long __proc_info_end

185. .size __lookup_processor_type_data, . - __lookup_processor_type_data

186.

187. /*

188. * 处理器ID不匹配时的入口

189. * 如果启用了调试信息,会从consol打印提示信息

190. * 之后会进入__error的死循环

191. */

192. __error_p:

193. #ifdef CONFIG_DEBUG_LL

194. adr r0, str_p1

195. bl printascii

196. mov r0, r9

197. bl printhex8

198. adr r0, str_p2

199. bl printascii

200. b __error

201. str_p1: .asciz "\nError: unrecognized/unsupported processor variant (0x"

202. str_p2: .asciz ").\n"

203. .align

204. #endif

205. ENDPROC(__error_p)

206.

207. /*

208. * 出错时的死循环入口

209. */

210. __error:

211. #ifdef CONFIG_ARCH_RPC

212. /*

213. * 出错时屏幕变红 - RiscPC only.

214. */

215. mov r0, #0x02000000

216. mov r3, #0x11

217. orr r3, r3, r3, lsl #8

218. orr r3, r3, r3, lsl #16

219. str r3, [r0], #4

220. str r3, [r0], #4

221. str r3, [r0], #4

222. str r3, [r0], #4

223. #endif

224. 1: mov r0, r0

225. b 1b

226. ENDPROC(__error)