Rev 2927 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 2927 | Rev 4341 | ||
|---|---|---|---|
| Line 26... | Line 26... | ||
| 26 | # THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | # THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 27 | # |
27 | # |
| 28 | 28 | ||
| 29 | #include "asm.h" |
29 | #include "asm.h" |
| 30 | #include "regname.h" |
30 | #include "regname.h" |
| - | 31 | ||
| - | 32 | .macro SMC_COHERENCY addr |
|
| - | 33 | dcbst 0, \addr |
|
| - | 34 | sync |
|
| - | 35 | icbi 0, \addr |
|
| - | 36 | sync |
|
| - | 37 | isync |
|
| - | 38 | .endm |
|
| - | 39 | ||
| - | 40 | .macro FLUSH_DCACHE addr |
|
| - | 41 | dcbst 0, \addr |
|
| - | 42 | sync |
|
| - | 43 | isync |
|
| - | 44 | .endm |
|
| - | 45 | ||
| - | 46 | .macro TLB_FLUSH reg |
|
| 31 | #include "debug.inc" |
47 | tlbie \reg |
| - | 48 | addi \reg, \reg, 0x1000 |
|
| - | 49 | .endm |
|
| 32 | 50 | ||
| 33 | .text |
51 | .text |
| 34 | 52 | ||
| 35 | .global halt |
53 | .global halt |
| 36 | .global memcpy |
54 | .global memcpy |
| Line 138... | Line 156... | ||
| 138 | .align PAGE_WIDTH |
156 | .align PAGE_WIDTH |
| 139 | .global real_mode |
157 | .global real_mode |
| 140 | 158 | ||
| 141 | real_mode: |
159 | real_mode: |
| 142 | 160 | ||
| 143 | DEBUG_INIT |
- | |
| 144 | DEBUG_real_mode |
- | |
| 145 | - | ||
| 146 | # copy kernel to proper location |
161 | # copy kernel to proper location |
| 147 | # |
162 | # |
| 148 | # r5 = trans (pa) |
163 | # r5 = trans (pa) |
| 149 | # r6 = bytes to copy |
164 | # r6 = bytes to copy |
| 150 | # r8 = framebuffer (pa) |
165 | # r8 = framebuffer (pa) |
| Line 161... | Line 176... | ||
| 161 | # copy page |
176 | # copy page |
| 162 | 177 | ||
| 163 | mtctr r31 |
178 | mtctr r31 |
| 164 | lwz r29, 0(r5) |
179 | lwz r29, 0(r5) |
| 165 | 180 | ||
| 166 | DEBUG_INIT |
- | |
| 167 | DEBUG_copy_loop |
- | |
| 168 | - | ||
| 169 | copy_loop: |
181 | copy_loop: |
| 170 | 182 | ||
| 171 | lwz r28, 0(r29) |
183 | lwz r28, 0(r29) |
| 172 | stw r28, 0(r30) |
184 | stw r28, 0(r30) |
| 173 | 185 | ||
| - | 186 | SMC_COHERENCY r30 |
|
| - | 187 | ||
| 174 | addi r29, r29, 4 |
188 | addi r29, r29, 4 |
| 175 | addi r30, r30, 4 |
189 | addi r30, r30, 4 |
| 176 | subi r6, r6, 4 |
190 | subi r6, r6, 4 |
| 177 | 191 | ||
| 178 | cmpwi r6, 0 |
192 | cmpwi r6, 0 |
| 179 | beq copy_end |
193 | beq copy_end |
| 180 | 194 | ||
| 181 | bdnz copy_loop |
195 | bdnz copy_loop |
| 182 | 196 | ||
| 183 | DEBUG_end_copy_loop |
- | |
| 184 | - | ||
| 185 | addi r5, r5, 4 |
197 | addi r5, r5, 4 |
| 186 | b page_copy |
198 | b page_copy |
| 187 | 199 | ||
| 188 | copy_end: |
200 | copy_end: |
| 189 | 201 | ||
| 190 | DEBUG_segments |
- | |
| 191 | - | ||
| 192 | # initially fill segment registers |
202 | # initially fill segment registers |
| 193 | 203 | ||
| 194 | li r31, 0 |
204 | li r31, 0 |
| 195 | 205 | ||
| 196 | li r29, 8 |
206 | li r29, 8 |
| 197 | mtctr r29 |
207 | mtctr r29 |
| 198 | li r30, 0 # ASID 0 (VSIDs 0 .. 7) |
208 | li r30, 0 # ASID 0 (VSIDs 0 .. 7) |
| 199 | 209 | ||
| 200 | seg_fill_uspace: |
210 | seg_fill_uspace: |
| 201 | 211 | ||
| 202 | mtsrin r30, r31 |
212 | mtsrin r30, r31 |
| 203 | addi r30, r30, 1 |
213 | addi r30, r30, 1 |
| 204 | addis r31, r31, 0x1000 # move to next SR |
214 | addis r31, r31, 0x1000 # move to next SR |
| Line 218... | Line 228... | ||
| 218 | 228 | ||
| 219 | bdnz seg_fill_kernel |
229 | bdnz seg_fill_kernel |
| 220 | 230 | ||
| 221 | # invalidate block address translation registers |
231 | # invalidate block address translation registers |
| 222 | 232 | ||
| 223 | DEBUG_bat |
- | |
| 224 | - | ||
| 225 | li r30, 0 |
233 | li r30, 0 |
| 226 | 234 | ||
| 227 | mtspr ibat0u, r30 |
235 | mtspr ibat0u, r30 |
| 228 | mtspr ibat0l, r30 |
236 | mtspr ibat0l, r30 |
| 229 | 237 | ||
| Line 249... | Line 257... | ||
| 249 | mtspr dbat3l, r30 |
257 | mtspr dbat3l, r30 |
| 250 | 258 | ||
| 251 | # create empty Page Hash Table |
259 | # create empty Page Hash Table |
| 252 | # on top of memory, size 64 KB |
260 | # on top of memory, size 64 KB |
| 253 | 261 | ||
| 254 | DEBUG_pht |
- | |
| 255 | - | ||
| 256 | lwz r31, 0(r3) # r31 = memory size |
262 | lwz r31, 0(r3) # r31 = memory size |
| 257 | 263 | ||
| 258 | lis r30, 65536@h |
264 | lis r30, 65536@h |
| 259 | ori r30, r30, 65536@l # r30 = 65536 |
265 | ori r30, r30, 65536@l # r30 = 65536 |
| 260 | 266 | ||
| Line 272... | Line 278... | ||
| 272 | pht_clear: |
278 | pht_clear: |
| 273 | 279 | ||
| 274 | # write zeroes |
280 | # write zeroes |
| 275 | 281 | ||
| 276 | stw r29, 0(r31) |
282 | stw r29, 0(r31) |
| - | 283 | FLUSH_DCACHE r31 |
|
| 277 | 284 | ||
| 278 | addi r31, r31, 4 |
285 | addi r31, r31, 4 |
| 279 | subi r30, r30, 4 |
286 | subi r30, r30, 4 |
| 280 | 287 | ||
| 281 | cmpwi r30, 0 |
288 | cmpwi r30, 0 |
| 282 | beq clear_end |
289 | beq clear_end |
| 283 | 290 | ||
| 284 | bdnz pht_clear |
291 | bdnz pht_clear |
| 285 | - | ||
| 286 | DEBUG_end_pht_clear |
- | |
| 287 | 292 | ||
| 288 | clear_end: |
293 | clear_end: |
| 289 | 294 | ||
| 290 | #ifdef CONFIG_BAT |
295 | #ifdef CONFIG_BAT |
| 291 | 296 | ||
| 292 | # create BAT identity mapping |
297 | # create BAT identity mapping |
| 293 | 298 | ||
| 294 | DEBUG_mapping |
- | |
| 295 | - | ||
| 296 | lwz r31, 0(r3) # r31 = memory size |
299 | lwz r31, 0(r3) # r31 = memory size |
| 297 | 300 | ||
| 298 | lis r29, 0x0002 |
301 | lis r29, 0x0002 |
| 299 | cmpw r31, r29 |
302 | cmpw r31, r29 |
| 300 | blt no_bat # less than 128 KB -> no BAT |
303 | blt no_bat # less than 128 KB -> no BAT |
| Line 313... | Line 316... | ||
| 313 | srw r30, r31, r29 # r30 = mask >> 1 |
316 | srw r30, r31, r29 # r30 = mask >> 1 |
| 314 | or r31, r31, r30 # mask = mask | r30 |
317 | or r31, r31, r30 # mask = mask | r30 |
| 315 | 318 | ||
| 316 | bdnz bat_mask |
319 | bdnz bat_mask |
| 317 | 320 | ||
| 318 | DEBUG_bat_mask |
- | |
| 319 | - | ||
| 320 | andi. r31, r31, 0x07ff # mask = mask & 0x07ff (BAT can map up to 256 MB) |
321 | andi. r31, r31, 0x07ff # mask = mask & 0x07ff (BAT can map up to 256 MB) |
| 321 | 322 | ||
| 322 | li r29, 2 |
323 | li r29, 2 |
| 323 | slw r31, r31, r29 # mask = mask << 2 |
324 | slw r31, r31, r29 # mask = mask << 2 |
| 324 | ori r31, r31, 0x0002 # mask = mask | 0x0002 (priviledged access only) |
325 | ori r31, r31, 0x0002 # mask = mask | 0x0002 (priviledged access only) |
| Line 334... | Line 335... | ||
| 334 | 335 | ||
| 335 | mtspr dbat0u, r29 |
336 | mtspr dbat0u, r29 |
| 336 | mtspr dbat0l, r30 |
337 | mtspr dbat0l, r30 |
| 337 | 338 | ||
| 338 | no_bat: |
339 | no_bat: |
| 339 | 340 | ||
| 340 | #endif |
341 | #endif |
| 341 | 342 | ||
| 342 | DEBUG_tlb |
343 | # flush TLB |
| 343 | 344 | ||
| 344 | tlbia |
345 | li r31, 0 |
| 345 | tlbsync |
346 | sync |
| 346 | 347 | ||
| - | 348 | TLB_FLUSH r31 |
|
| - | 349 | TLB_FLUSH r31 |
|
| - | 350 | TLB_FLUSH r31 |
|
| - | 351 | TLB_FLUSH r31 |
|
| - | 352 | TLB_FLUSH r31 |
|
| - | 353 | TLB_FLUSH r31 |
|
| - | 354 | TLB_FLUSH r31 |
|
| - | 355 | TLB_FLUSH r31 |
|
| - | 356 | ||
| - | 357 | TLB_FLUSH r31 |
|
| - | 358 | TLB_FLUSH r31 |
|
| - | 359 | TLB_FLUSH r31 |
|
| - | 360 | TLB_FLUSH r31 |
|
| - | 361 | TLB_FLUSH r31 |
|
| - | 362 | TLB_FLUSH r31 |
|
| - | 363 | TLB_FLUSH r31 |
|
| - | 364 | TLB_FLUSH r31 |
|
| - | 365 | ||
| - | 366 | TLB_FLUSH r31 |
|
| - | 367 | TLB_FLUSH r31 |
|
| - | 368 | TLB_FLUSH r31 |
|
| - | 369 | TLB_FLUSH r31 |
|
| - | 370 | TLB_FLUSH r31 |
|
| - | 371 | TLB_FLUSH r31 |
|
| - | 372 | TLB_FLUSH r31 |
|
| - | 373 | TLB_FLUSH r31 |
|
| - | 374 | ||
| - | 375 | TLB_FLUSH r31 |
|
| - | 376 | TLB_FLUSH r31 |
|
| - | 377 | TLB_FLUSH r31 |
|
| - | 378 | TLB_FLUSH r31 |
|
| - | 379 | TLB_FLUSH r31 |
|
| - | 380 | TLB_FLUSH r31 |
|
| - | 381 | TLB_FLUSH r31 |
|
| - | 382 | TLB_FLUSH r31 |
|
| - | 383 | ||
| - | 384 | TLB_FLUSH r31 |
|
| - | 385 | TLB_FLUSH r31 |
|
| - | 386 | TLB_FLUSH r31 |
|
| - | 387 | TLB_FLUSH r31 |
|
| - | 388 | TLB_FLUSH r31 |
|
| - | 389 | TLB_FLUSH r31 |
|
| - | 390 | TLB_FLUSH r31 |
|
| - | 391 | TLB_FLUSH r31 |
|
| - | 392 | ||
| - | 393 | TLB_FLUSH r31 |
|
| - | 394 | TLB_FLUSH r31 |
|
| - | 395 | TLB_FLUSH r31 |
|
| - | 396 | TLB_FLUSH r31 |
|
| - | 397 | TLB_FLUSH r31 |
|
| - | 398 | TLB_FLUSH r31 |
|
| - | 399 | TLB_FLUSH r31 |
|
| - | 400 | TLB_FLUSH r31 |
|
| - | 401 | ||
| - | 402 | TLB_FLUSH r31 |
|
| - | 403 | TLB_FLUSH r31 |
|
| - | 404 | TLB_FLUSH r31 |
|
| - | 405 | TLB_FLUSH r31 |
|
| - | 406 | TLB_FLUSH r31 |
|
| - | 407 | TLB_FLUSH r31 |
|
| - | 408 | TLB_FLUSH r31 |
|
| - | 409 | TLB_FLUSH r31 |
|
| - | 410 | ||
| - | 411 | TLB_FLUSH r31 |
|
| - | 412 | TLB_FLUSH r31 |
|
| - | 413 | TLB_FLUSH r31 |
|
| - | 414 | TLB_FLUSH r31 |
|
| - | 415 | TLB_FLUSH r31 |
|
| - | 416 | TLB_FLUSH r31 |
|
| - | 417 | TLB_FLUSH r31 |
|
| 347 | DEBUG_prepare |
418 | TLB_FLUSH r31 |
| - | 419 | ||
| - | 420 | eieio |
|
| - | 421 | tlbsync |
|
| - | 422 | sync |
|
| 348 | 423 | ||
| 349 | # start the kernel |
424 | # start the kernel |
| 350 | # |
425 | # |
| 351 | # pc = KERNEL_START_ADDR |
426 | # pc = KERNEL_START_ADDR |
| 352 | # r3 = bootinfo (pa) |
427 | # r3 = bootinfo (pa) |
| Line 371... | Line 446... | ||
| 371 | ori r31, r31, (msr_ir | msr_dr)@l |
446 | ori r31, r31, (msr_ir | msr_dr)@l |
| 372 | mtspr srr1, r31 |
447 | mtspr srr1, r31 |
| 373 | 448 | ||
| 374 | sync |
449 | sync |
| 375 | isync |
450 | isync |
| 376 | - | ||
| 377 | DEBUG_rfi |
- | |
| 378 | rfi |
451 | rfi |
| 379 | 452 | ||
| 380 | .align PAGE_WIDTH |
453 | .align PAGE_WIDTH |
| 381 | .global trans |
454 | .global trans |
| 382 | trans: |
455 | trans: |