new file mode 100644
@@ -0,0 +1,37 @@
+#ifndef _ASMPOWERPC_HCALL_H_
+#define _ASMPOWERPC_HCALL_H_
+/*
+ * Copyright (C) 2016, Red Hat Inc, Andrew Jones <drjones@redhat.com>
+ *
+ * This work is licensed under the terms of the GNU LGPL, version 2.
+ */
+
+#define SC1 0x44000022
+#define SC1_REPLACEMENT 0x7c000268
+
+#define H_SUCCESS 0
+#define H_HARDWARE -1
+#define H_FUNCTION -2
+#define H_PRIVILEGE -3
+#define H_PARAMETER -4
+
+#define H_SET_DABR 0x28
+#define H_PUT_TERM_CHAR 0x58
+
+#ifndef __ASSEMBLY__
+/*
+ * hcall_have_broken_sc1 checks if we're on a host with a broken sc1.
+ * Returns 0 if we're not.
+ */
+extern int hcall_have_broken_sc1(void);
+
+/*
+ * hcall is the hypercall wrapper function. unittests may do what
+ * they like, but the framework should make all hypercalls through
+ * here to ensure they use a working sc1 instruction. @nr is the
+ * hypercall number.
+ */
+extern unsigned long hcall(unsigned long nr, ...);
+
+#endif /* !__ASSEMBLY__ */
+#endif /* _ASMPOWERPC_HCALL_H_ */
new file mode 100644
@@ -0,0 +1,33 @@
+/*
+ * Hypercall helpers
+ *
+ * broken_sc1 probing/patching inspired by SLOF, see
+ * SLOF:lib/libhvcall/brokensc1.c
+ *
+ * Copyright (C) 2016, Red Hat Inc, Andrew Jones <drjones@redhat.com>
+ *
+ * This work is licensed under the terms of the GNU LGPL, version 2.
+ */
+#include <asm/hcall.h>
+
+int hcall_have_broken_sc1(void)
+{
+ register unsigned long r3 asm("r3") = H_SET_DABR;
+ register unsigned long r4 asm("r4") = 0;
+
+ asm volatile("sc 1"
+ : "=r" (r3)
+ : "r" (r3), "r" (r4)
+ : "r5", "r6", "r7", "r8", "r9", "r10", "r11", "r12");
+
+ return r3 == (unsigned long)H_PRIVILEGE;
+}
+
+void putchar(int c)
+{
+ unsigned long vty = 0; /* 0 == default */
+ unsigned long nr_chars = 1;
+ unsigned long chars = (unsigned long)c << 56;
+
+ hcall(H_PUT_TERM_CHAR, vty, nr_chars, chars);
+}
@@ -6,15 +6,26 @@
* This work is licensed under the terms of the GNU LGPL, version 2.
*/
#include <libcflat.h>
+#include <asm/spinlock.h>
+
+extern void halt(int code);
+extern void putchar(int c);
+
+static struct spinlock print_lock;
void io_init(void)
{
}
-void puts(const char *s __unused)
+void puts(const char *s)
{
+ spin_lock(&print_lock);
+ while (*s)
+ putchar(*s++);
+ spin_unlock(&print_lock);
}
-void exit(int code __unused)
+void exit(int code)
{
+ halt(code);
}
new file mode 100644
@@ -0,0 +1 @@
+#include "../../powerpc/asm/hcall.h"
@@ -16,6 +16,7 @@ CFLAGS += -ffreestanding
CFLAGS += -Wextra
CFLAGS += -O2
CFLAGS += -I lib -I lib/libfdt
+CFLAGS += -Wa,-mregnames
asm-offsets = lib/$(ARCH)/asm-offsets.h
include scripts/asm-offsets.mak
@@ -24,6 +25,7 @@ cflatobjs += lib/util.o
cflatobjs += lib/alloc.o
cflatobjs += lib/devicetree.o
cflatobjs += lib/powerpc/io.o
+cflatobjs += lib/powerpc/hcall.o
libgcc := $(shell $(CC) $(machine) --print-libgcc-file-name)
@@ -6,14 +6,44 @@
* This work is licensed under the terms of the GNU LGPL, version 2.
*/
#define __ASSEMBLY__
+#include <asm/hcall.h>
+
+#define LOAD_REG_IMMEDIATE(reg,expr) \
+ lis reg,(expr)@highest; \
+ ori reg,reg,(expr)@higher; \
+ rldicr reg,reg,32,31; \
+ oris reg,reg,(expr)@h; \
+ ori reg,reg,(expr)@l;
+
+#define LOAD_REG_ADDR(reg,name) \
+ ld reg,name@got(r2)
.section .init
.globl start
start:
+ LOAD_REG_IMMEDIATE(r1, stackptr)
+ LOAD_REG_IMMEDIATE(r2, tocptr)
+
+ /* patch sc1 if needed */
+ bl hcall_have_broken_sc1
+ cmpwi r3, 0
+ beq 1f
+ LOAD_REG_ADDR(r3, hcall)
+ LOAD_REG_IMMEDIATE(r4, SC1_REPLACEMENT)
+ stw r4, 0(r3)
+
+1: bl main
+ bl exit
b halt
.text
+.align 3
+
+.globl hcall
+hcall:
+ sc 1
+ blr
.globl halt
halt: