1 /******************************************************************************
2 * Copyright (c) 2004, 2008 IBM Corporation
4 * This program and the accompanying materials
5 * are made available under the terms of the BSD License
6 * which accompanies this distribution, and is available at
7 * http://www.opensource.org/licenses/bsd-license.php
10 * IBM Corporation - initial implementation
11 *****************************************************************************/
18 C_ENTRY(copy_from_flash)
19 # size in GPR3 (multiple of 64), from GPR4, to GPR5
20 mflr 24 ; mtctr 3 ; addi 4,4,-64 ; addi 5,5,-64
22 ldu 16,64(4) ; ld 17,8(4) ; ld 18,16(4) ; ld 19,24(4)
23 ld 20,32(4) ; ld 21,40(4) ; ld 22,48(4) ; ld 23,56(4)
25 stdu 16,64(5) ; std 17,8(5) ; std 18,16(5) ; std 19,24(5)
26 std 20,32(5) ; std 21,40(5) ; std 22,48(5) ; std 23,56(5)
27 sync ; icbi 0,2 ; bdnz 0b ; sync ; isync ; mtlr 24 ; blr
29 /****************************************************************************
30 * prints one character to serial console
39 ****************************************************************************/
46 li 4,0x3f8 ; oris 4,4,0xf400
49 0: lbz 0,5(4) ; andi. 0,0,0x20 ; beq 0b ; stb 3,0(4) ; eieio
51 # also print char to serial2 if on a JS21
52 # read ID register: only if it is a PC87427 (JS21) also use serial2
54 li 5,0x20 ; stb 5,0x2e(4) ; lbz 5,0x2f(4) ; cmpdi 5,0xf2 ; bne 1f
57 0: lbz 0,5(4) ; andi. 0,0,0x20 ; beq 0b ; stb 3,0(4) ; eieio