qemu/roms/SLOF/board-js2x/llfw/board_io.S

   1 /******************************************************************************
   2  * Copyright (c) 2004, 2008 IBM Corporation
   3  * All rights reserved.
   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
   8  *
   9  * Contributors:
  10  *     IBM Corporation - initial implementation
  11  *****************************************************************************/
  12
  13 #include <macros.h>
  14 #include <cpu.h>
  15
  16         .text
  17
  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
  21 0:      SETCI(r0)
  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)
  24         CLRCI(r0)
  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
  28
  29 /****************************************************************************
  30  * prints one character to serial console
  31  *
  32  * Input:
  33  * R3 - character
  34  *
  35  * Returns: -
  36  *
  37  * Modifies Registers:
  38  * R3, R4, R5, R6, R7
  39  ****************************************************************************/
  40 ENTRY(io_putchar)
  41         mflr    r7
  42
  43         SETCI(r0)
  44
  45         # always use serial1
  46         li 4,0x3f8 ; oris 4,4,0xf400
  47
  48         # print one char
  49 0:      lbz 0,5(4) ; andi. 0,0,0x20 ; beq 0b ; stb 3,0(4) ; eieio
  50
  51         # also print char to serial2 if on a JS21
  52         # read ID register: only if it is a PC87427 (JS21) also use serial2
  53         addi 4,4,-0x3f8
  54         li 5,0x20 ; stb 5,0x2e(4) ; lbz 5,0x2f(4) ; cmpdi 5,0xf2 ; bne 1f
  55
  56         addi 4,4,0x2f8
  57 0:      lbz 0,5(4) ; andi. 0,0,0x20 ; beq 0b ; stb 3,0(4) ; eieio
  58
  59 1:      CLRCI(r0)
  60
  61         mtlr    r7
  62         blr