1 files changed, 129 insertions, 0 deletions
diff --git a/src/roms/SLOF/llfw/io_generic/io_generic.S b/src/roms/SLOF/llfw/io_generic/io_generic.S
new file mode 100644
index 0000000..9c1db41
--- /dev/null
+++ b/src/roms/SLOF/llfw/io_generic/io_generic.S
@@ -0,0 +1,129 @@
+/******************************************************************************
+ * Copyright (c) 2004, 2008 IBM Corporation
+ * All rights reserved.
+ * This program and the accompanying materials
+ * are made available under the terms of the BSD License
+ * which accompanies this distribution, and is available at
+ * http://www.opensource.org/licenses/bsd-license.php
+ *
+ * Contributors:
+ *     IBM Corporation - initial implementation
+ *****************************************************************************/
+#include "macros.h"
+#include "calculatecrc.h"
+#include "calculatecrc.h"
+
+	.text
+
+/****************************************************************************
+ * prints a 0-terminated string to serial console
+ *
+ * Input:
+ * R3 - pointer to string in memory
+ *
+ * Returns: -
+ *
+ * Modifies Registers:
+ * R3, R4, R5, R6, R7, R8, R9
+ ****************************************************************************/
+ASM_ENTRY(io_print)
+	mflr	r8
+	mr	r9, r3
+
+0:
+	lbz	r3, 0(r9)
+	cmpwi	r3, 0
+	beq	1f
+	bl	io_putchar
+	addi	r9, r9, 1
+	b		0b
+1:
+	mtlr	r8
+	blr
+
+/****************************************************************************
+ * prints Hex integer to the UART and the NVRAM (using board io_putchar)
+ *
+ * Input:
+ * R3 - integer to print
+ *
+ * Returns: -
+ *
+ * Modifies Registers:
+ * R3, R4, R5, R6, R7, R8, R9
+ ****************************************************************************/
+#define _io_gen_print_nib(reg, src, shift)	\
+	srdi	reg, src, shift;		\
+	andi.	reg, reg, 0x0F;			\
+	cmpwi	reg, 0x0A;			\
+	blt	0f;				\
+	addi	reg, reg, ('A'-'0'-10);		\
+0:;						\
+	addi	reg, reg, '0';			\
+	bl	io_putchar
+
+ASM_ENTRY(io_printhex64)
+	mflr	r8
+	mr	r9, r3
+
+_io_printhex64:
+	_io_gen_print_nib(r3, r9, 60)
+	_io_gen_print_nib(r3, r9, 56)
+	_io_gen_print_nib(r3, r9, 52)
+	_io_gen_print_nib(r3, r9, 48)
+	_io_gen_print_nib(r3, r9, 44)
+	_io_gen_print_nib(r3, r9, 40)
+	_io_gen_print_nib(r3, r9, 36)
+	_io_gen_print_nib(r3, r9, 32)
+_io_printhex32:
+	_io_gen_print_nib(r3, r9, 28)
+	_io_gen_print_nib(r3, r9, 24)
+	_io_gen_print_nib(r3, r9, 20)
+	_io_gen_print_nib(r3, r9, 16)
+_io_printhex16:
+	_io_gen_print_nib(r3, r9, 12)
+	_io_gen_print_nib(r3, r9,  8)
+_io_printhex8:
+	_io_gen_print_nib(r3, r9,  4)
+	_io_gen_print_nib(r3, r9,  0)
+
+	mtlr	r8
+	blr
+
+ASM_ENTRY(io_printhex32)
+	mflr	r8
+	mr	r9, r3
+	b       _io_printhex32
+
+ASM_ENTRY(io_printhex16)
+	mflr	r8
+	mr	r9, r3
+	b       _io_printhex16
+
+ASM_ENTRY(io_printhex8)
+	mflr	r8
+	mr	r9, r3
+	b       _io_printhex8
+
+
+/****************************************************************************
+ * print the address and its contents as 64-bit hex values
+ *
+ * Input:
+ * R3 - Address to read from
+ *
+ * Returns: -
+ *
+ * Modifies Registers:
+ * R3, R4, R5, R6, R7, R8, R9, R10
+ ****************************************************************************/
+#if 0   /* currently unused */
+ASM_ENTRY(io_dump)
+        mflr    r10
+        bl      io_printhex64
+        li      r3,':'
+        bl      io_putchar
+        ld      r9,0(r9)
+        mr      r8,r10
+        b       _io_printhex64
+#endif