Blame view

kernel/linux-imx6_3.14.28/arch/powerpc/boot/gamecube-head.S 2.38 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
  /*
   * arch/powerpc/boot/gamecube-head.S
   *
   * Nintendo GameCube bootwrapper entry.
   * Copyright (C) 2004-2009 The GameCube Linux Team
   * Copyright (C) 2008,2009 Albert Herranz
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * as published by the Free Software Foundation; either version 2
   * of the License, or (at your option) any later version.
   *
   */
  
  #include "ppc_asm.h"
  
  /*
   * The entry code does no assumptions regarding:
   * - if the data and instruction caches are enabled or not
   * - if the MMU is enabled or not
   *
   * We enable the caches if not already enabled, enable the MMU with an
   * identity mapping scheme and jump to the start code.
   */
  
  	.text
  
  	.globl _zimage_start
  _zimage_start:
  
  	/* turn the MMU off */
  	mfmsr	9
  	rlwinm	9, 9, 0, ~((1<<4)|(1<<5)) /* MSR_DR|MSR_IR */
  	bcl	20, 31, 1f
  1:
  	mflr	8
  	clrlwi	8, 8, 3		/* convert to a real address */
  	addi	8, 8, _mmu_off - 1b
  	mtsrr0	8
  	mtsrr1	9
  	rfi
  _mmu_off:
  	/* MMU disabled */
  
  	/* setup BATs */
  	isync
  	li      8, 0
  	mtspr	0x210, 8	/* IBAT0U */
  	mtspr	0x212, 8	/* IBAT1U */
  	mtspr	0x214, 8	/* IBAT2U */
  	mtspr	0x216, 8	/* IBAT3U */
  	mtspr	0x218, 8	/* DBAT0U */
  	mtspr	0x21a, 8	/* DBAT1U */
  	mtspr	0x21c, 8	/* DBAT2U */
  	mtspr	0x21e, 8	/* DBAT3U */
  
  	li	8, 0x01ff	/* first 16MiB */
  	li	9, 0x0002	/* rw */
  	mtspr	0x211, 9	/* IBAT0L */
  	mtspr	0x210, 8	/* IBAT0U */
  	mtspr	0x219, 9	/* DBAT0L */
  	mtspr	0x218, 8	/* DBAT0U */
  
  	lis	8, 0x0c00	/* I/O mem */
  	ori	8, 8, 0x3ff	/* 32MiB */
  	lis	9, 0x0c00
  	ori	9, 9, 0x002a	/* uncached, guarded, rw */
  	mtspr	0x21b, 9	/* DBAT1L */
  	mtspr	0x21a, 8	/* DBAT1U */
  
  	lis	8, 0x0100	/* next 8MiB */
  	ori	8, 8, 0x00ff	/* 8MiB */
  	lis	9, 0x0100
  	ori	9, 9, 0x0002	/* rw */
  	mtspr	0x215, 9	/* IBAT2L */
  	mtspr	0x214, 8	/* IBAT2U */
  	mtspr	0x21d, 9	/* DBAT2L */
  	mtspr	0x21c, 8	/* DBAT2U */
  
  	/* enable and invalidate the caches if not already enabled */
  	mfspr	8, 0x3f0	/* HID0 */
  	andi.	0, 8, (1<<15)		/* HID0_ICE */
  	bne	1f
  	ori	8, 8, (1<<15)|(1<<11)	/* HID0_ICE|HID0_ICFI*/
  1:
  	andi.	0, 8, (1<<14)		/* HID0_DCE */
  	bne	1f
  	ori	8, 8, (1<<14)|(1<<10)	/* HID0_DCE|HID0_DCFI*/
  1:
  	mtspr	0x3f0, 8	/* HID0 */
  	isync
  
  	/* initialize arguments */
  	li	3, 0
  	li	4, 0
  	li	5, 0
  
  	/* turn the MMU on */
  	bcl	20, 31, 1f
  1:
  	mflr	8
  	addi	8, 8, _mmu_on - 1b
  	mfmsr	9
  	ori	9, 9, (1<<4)|(1<<5) /* MSR_DR|MSR_IR */
  	mtsrr0	8
  	mtsrr1	9
  	sync
  	rfi
  _mmu_on:
  	b _zimage_start_lib