patch-2.1.29 linux/arch/sparc64/prom/p1275.c

• Lines: 150
• Date: Wed Mar 5 17:04:31 1997
• Orig file: v2.1.28/linux/arch/sparc64/prom/p1275.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.1.28/linux/arch/sparc64/prom/p1275.c linux/arch/sparc64/prom/p1275.c
@@ -0,0 +1,149 @@
+/* $Id: p1275.c,v 1.4 1997/03/04 16:27:12 jj Exp $
+ * p1275.c: Sun IEEE 1275 PROM low level interface routines
+ *
+ * Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
+ */
+
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/string.h>
+
+#include <asm/openprom.h>
+#include <asm/oplib.h>
+#include <asm/spitfire.h>
+#include <asm/system.h>
+
+/* If you change layout of this structure, please change the prom_doit
+   function below as well. */
+typedef struct {
+	unsigned prom_doit_code [16];
+	void (*prom_cif_handler)(long *);
+	unsigned long prom_cif_stack;
+	unsigned long prom_args [23];
+	char prom_buffer [7928];
+} at0x8000;
+
+static void (*prom_do_it)(void);
+
+void prom_cif_interface (void) __attribute__ ((__section__ (".p1275")));
+
+/* At most 16 insns (including the retl; nop; afterwards) */
+void prom_cif_interface (void)
+{
+	__asm__ __volatile__ ("
+	sethi	%hi(0x8000), %o0
+	ldx	[%o0 + 0x048], %o1	! prom_cif_stack
+	save	%o1, -0xc0, %sp
+	ldx	[%i0 + 0x040], %l2	! prom_cif_handler
+	mov	%g4, %l0
+	mov	%g6, %l1
+	call	%l2
+	 or	%i0, 0x050, %o0		! prom_args
+	mov	%l0, %g4
+	mov	%l1, %g6
+	restore
+	");
+}
+
+long p1275_cmd (char *service, long fmt, ...)
+{
+	char *p, *q;
+	unsigned long flags;
+	int nargs, nrets, i;
+	va_list list;
+	long attrs, x;
+	long ctx = 0;
+	at0x8000 *low = (at0x8000 *)(0x8000);
+	
+	p = low->prom_buffer;
+	save_and_cli(flags);
+	ctx = spitfire_get_primary_context ();
+	if (ctx) {
+		flushw_user ();
+		spitfire_set_primary_context (0);
+	}
+	low->prom_args[0] = (unsigned long)p;			/* service */
+	strcpy (p, service);
+	p = strchr (p, 0) + 1;
+	low->prom_args[1] = nargs = (fmt & 0x0f);		/* nargs */
+	low->prom_args[2] = nrets = ((fmt & 0xf0) >> 4); 	/* nrets */
+	attrs = (fmt & (~0xff));
+	va_start(list, fmt);
+	for (i = 0; i < nargs; i++, attrs >>= 3) {
+		switch (attrs & 0x7) {
+		case P1275_ARG_NUMBER:
+			low->prom_args[i + 3] = va_arg(list, long); break;
+		case P1275_ARG_IN_STRING:
+			strcpy (p, va_arg(list, char *));
+			low->prom_args[i + 3] = (unsigned long)p;
+			p = strchr (p, 0) + 1;
+			break;
+		case P1275_ARG_OUT_BUF:
+			(void) va_arg(list, char *);
+			low->prom_args[i + 3] = (unsigned long)p;
+			x = va_arg(list, long);
+			i++; attrs >>= 3;
+			p += (int)x;
+			low->prom_args[i + 3] = x;
+			break;
+		case P1275_ARG_IN_BUF:
+			q = va_arg(list, char *);
+			low->prom_args[i + 3] = (unsigned long)p;
+			x = va_arg(list, long);
+			i++; attrs >>= 3;
+			p += (int)x;
+			memcpy (p, q, (int)x);
+			low->prom_args[i + 3] = x;
+			break;
+		case P1275_ARG_OUT_32B:
+			(void) va_arg(list, char *);
+			low->prom_args[i + 3] = (unsigned long)p;
+			p += 32;
+			break;
+		case P1275_ARG_IN_FUNCTION:
+			/* FIXME: This should make a function in our <4G
+			 * section, which will call the argument,
+			 * so that PROM can call it.
+			 */
+			low->prom_args[i + 3] = va_arg(list, long); break;
+		}
+	}
+	va_end(list);
+	(*prom_do_it)();
+	attrs = fmt & (~0xff);
+	va_start(list, fmt);
+	for (i = 0; i < nargs; i++, attrs >>= 3) {
+		switch (attrs & 0x7) {
+		case P1275_ARG_NUMBER:
+		case P1275_ARG_IN_STRING:
+		case P1275_ARG_IN_FUNCTION:
+		case P1275_ARG_IN_BUF:
+			break;
+		case P1275_ARG_OUT_BUF:
+			p = va_arg(list, char *);
+			x = va_arg(list, long);
+			memcpy (p, (char *)(low->prom_args[i + 3]), (int)x);
+			i++; attrs >>= 3;
+			break;
+		case P1275_ARG_OUT_32B:
+			p = va_arg(list, char *);
+			memcpy (p, (char *)(low->prom_args[i + 3]), 32);
+			break;
+		}
+	}
+	va_end(list);
+	x = low->prom_args [nargs + 3];
+	if (ctx)
+		spitfire_set_primary_context (ctx);
+	restore_flags(flags);
+	return x;
+}
+
+void prom_cif_init(void *cif_handler, void *cif_stack)
+{
+	at0x8000 *low = (at0x8000 *)(0x8000);
+	
+	low->prom_cif_handler = (void (*)(long *))cif_handler;
+	low->prom_cif_stack = (unsigned long)cif_stack;
+        prom_do_it = (void (*)(void))(0x8000);
+}