avoid endless loops in lib/swiotlb.c
[wrt350n-kernel.git] / arch / arm / boot / compressed / head-shark.S
blob089c560e07f13947ed68ab446edcc9de40c30604
1 /* The head-file for the Shark
2  * by Alexander Schulz
3  *
4  * Does the following:
5  * - get the memory layout from firmware. This can only be done as long as the mmu
6  *   is still on.
7  * - switch the mmu off, so we have physical addresses
8  * - copy the kernel to 0x08508000. This is done to have a fixed address where the
9  *   C-parts (misc.c) are executed. This address must be known at compile-time,
10  *   but the load-address of the kernel depends on how much memory is installed.
11  * - Jump to this location.
12  * - Set r8 with 0, r7 with the architecture ID for head.S
13  */
15 #include <linux/linkage.h>
17 #include <asm/assembler.h>
18         
19                 .section        ".start", "ax"
21                 b       __beginning
22         
23 __ofw_data:     .long   0                               @ the number of memory blocks
24                 .space  128                             @ (startaddr,size) ...
25                 .space  128                             @ bootargs
26                 .align
28 __beginning:    mov     r4, r0                          @ save the entry to the firmware
30                 mov     r0, #0xC0                       @ disable irq and fiq
31                 mov     r1, r0
32                 mrs     r3, cpsr
33                 bic     r2, r3, r0
34                 eor     r2, r2, r1
35                 msr     cpsr_c, r2
37                 mov     r0, r4                          @ get the Memory layout from firmware
38                 adr     r1, __ofw_data
39                 add     r2, r1, #4
40                 mov     lr, pc
41                 b       ofw_init
42                 mov     r1, #0
44                 adr     r2, __mmu_off                   @ calculate physical address
45                 sub     r2, r2, #0xf0000000             @ openprom maps us at f000 virt, 0e50 phys
46                 adr     r0, __ofw_data
47                 ldr     r0, [r0, #4]
48                 add     r2, r2, r0
49                 add     r2, r2, #0x00500000
51                 mrc     p15, 0, r3, c1, c0
52                 bic     r3, r3, #0xC                    @ Write Buffer and DCache
53                 bic     r3, r3, #0x1000                 @ ICache
54                 mcr     p15, 0, r3, c1, c0              @ disabled
56                 mov     r0, #0
57                 mcr     p15, 0, r0, c7, c7              @ flush I,D caches on v4
58                 mcr     p15, 0, r0, c7, c10, 4          @ drain write buffer on v4
59                 mcr     p15, 0, r0, c8, c7              @ flush I,D TLBs on v4
61                 bic     r3, r3, #0x1                    @ MMU
62                 mcr     p15, 0, r3, c1, c0              @ disabled
64                 mov     pc, r2
66 __copy_target:  .long   0x08507FFC
67 __copy_end:     .long   0x08607FFC
68                 
69                 .word   _start
70                 .word   __bss_start
72                 .align
73 __temp_stack:   .space 128
75 __mmu_off:
76                 adr     r0, __ofw_data                  @ read the 1. entry of the memory map
77                 ldr     r0, [r0, #4]
78                 orr     r0, r0, #0x00600000
79                 sub     r0, r0, #4
80         
81                 ldr     r1, __copy_end
82                 ldr     r3, __copy_target
84 /* r0 = 0x0e600000 (current end of kernelcode)
85  * r3 = 0x08508000 (where it should begin)
86  * r1 = 0x08608000 (end of copying area, 1MB)
87  * The kernel is compressed, so 1 MB should be enough.
88  * copy the kernel to the beginning of physical memory
89  * We start from the highest address, so we can copy
90  * from 0x08500000 to 0x08508000 if we have only 8MB
91  */
93 /* As we get more 2.6-kernels it gets more and more
94  * uncomfortable to be bound to kernel images of 1MB only.
95  * So we add a loop here, to be able to copy some more.
96  * Alexander Schulz 2005-07-17
97  */
99                 mov     r4, #3                          @ How many megabytes to copy
102 __MoveCode:     sub     r4, r4, #1
103         
104 __Copy:         ldr     r2, [r0], #-4
105                 str     r2, [r1], #-4
106                 teq     r1, r3
107                 bne     __Copy
109                 /* The firmware maps us in blocks of 1 MB, the next block is
110                    _below_ the last one. So our decrementing source pointer
111                    ist right here, but the destination pointer must be increased
112                    by 2 MB */
113                 add     r1, r1, #0x00200000
114                 add     r3, r3, #0x00100000
116                 teq     r4, #0
117                 bne     __MoveCode
120                 /* and jump to it */
121                 adr     r2, __go_on                     @ where we want to jump
122                 adr     r0, __ofw_data                  @ read the 1. entry of the memory map
123                 ldr     r0, [r0, #4]
124                 sub     r2, r2, r0                      @ we are mapped add 0e50 now, sub that (-0e00)
125                 sub     r2, r2, #0x00500000             @ -0050
126                 ldr     r0, __copy_target               @ and add 0850 8000 instead
127                 add     r0, r0, #4
128                 add     r2, r2, r0
129                 mov     pc, r2                          @ and jump there
131 __go_on:
132                 adr     sp, __temp_stack
133                 add     sp, sp, #128
134                 adr     r0, __ofw_data
135                 mov     lr, pc
136                 b       create_params
137         
138                 mov     r8, #0
139                 mov     r7, #15