![Sam Ravnborg](/assets/img/avatar_default.png)
- all files with identical names copied and renamed to *_64.c - the remaning files copied as is - added sparc64 specific files to sparc/prom/Makefile - teach sparc64 Makefile to look into sparc/prom/ - delete unused Makefile from sparc64/prom/ linking order was not kept for sparc64 with this change. It was not possible to keep linking order for both sparc and sparc64 and as sparc64 see more testing than sparc it was natural to break linking order on sparc64. Should it have any effect it would be detected sooner this way. printf_32.c and printf_64.c are obvious candidates to be merged but they are not 100% equal so that was left for later Signed-off-by: Sam Ravnborg <sam@ravnborg.org> Signed-off-by: David S. Miller <davem@davemloft.net>
152 lines
3.7 KiB
C
152 lines
3.7 KiB
C
/*
|
|
* 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/sched.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/string.h>
|
|
#include <linux/spinlock.h>
|
|
|
|
#include <asm/openprom.h>
|
|
#include <asm/oplib.h>
|
|
#include <asm/system.h>
|
|
#include <asm/spitfire.h>
|
|
#include <asm/pstate.h>
|
|
#include <asm/ldc.h>
|
|
|
|
struct {
|
|
long prom_callback; /* 0x00 */
|
|
void (*prom_cif_handler)(long *); /* 0x08 */
|
|
unsigned long prom_cif_stack; /* 0x10 */
|
|
unsigned long prom_args [23]; /* 0x18 */
|
|
char prom_buffer [3000];
|
|
} p1275buf;
|
|
|
|
extern void prom_world(int);
|
|
|
|
extern void prom_cif_interface(void);
|
|
extern void prom_cif_callback(void);
|
|
|
|
/*
|
|
* This provides SMP safety on the p1275buf. prom_callback() drops this lock
|
|
* to allow recursuve acquisition.
|
|
*/
|
|
DEFINE_SPINLOCK(prom_entry_lock);
|
|
|
|
long p1275_cmd(const char *service, long fmt, ...)
|
|
{
|
|
char *p, *q;
|
|
unsigned long flags;
|
|
int nargs, nrets, i;
|
|
va_list list;
|
|
long attrs, x;
|
|
|
|
p = p1275buf.prom_buffer;
|
|
|
|
spin_lock_irqsave(&prom_entry_lock, flags);
|
|
|
|
p1275buf.prom_args[0] = (unsigned long)p; /* service */
|
|
strcpy (p, service);
|
|
p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
|
|
p1275buf.prom_args[1] = nargs = (fmt & 0x0f); /* nargs */
|
|
p1275buf.prom_args[2] = nrets = ((fmt & 0xf0) >> 4); /* nrets */
|
|
attrs = fmt >> 8;
|
|
va_start(list, fmt);
|
|
for (i = 0; i < nargs; i++, attrs >>= 3) {
|
|
switch (attrs & 0x7) {
|
|
case P1275_ARG_NUMBER:
|
|
p1275buf.prom_args[i + 3] =
|
|
(unsigned)va_arg(list, long);
|
|
break;
|
|
case P1275_ARG_IN_64B:
|
|
p1275buf.prom_args[i + 3] =
|
|
va_arg(list, unsigned long);
|
|
break;
|
|
case P1275_ARG_IN_STRING:
|
|
strcpy (p, va_arg(list, char *));
|
|
p1275buf.prom_args[i + 3] = (unsigned long)p;
|
|
p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
|
|
break;
|
|
case P1275_ARG_OUT_BUF:
|
|
(void) va_arg(list, char *);
|
|
p1275buf.prom_args[i + 3] = (unsigned long)p;
|
|
x = va_arg(list, long);
|
|
i++; attrs >>= 3;
|
|
p = (char *)(((long)(p + (int)x + 7)) & ~7);
|
|
p1275buf.prom_args[i + 3] = x;
|
|
break;
|
|
case P1275_ARG_IN_BUF:
|
|
q = va_arg(list, char *);
|
|
p1275buf.prom_args[i + 3] = (unsigned long)p;
|
|
x = va_arg(list, long);
|
|
i++; attrs >>= 3;
|
|
memcpy (p, q, (int)x);
|
|
p = (char *)(((long)(p + (int)x + 7)) & ~7);
|
|
p1275buf.prom_args[i + 3] = x;
|
|
break;
|
|
case P1275_ARG_OUT_32B:
|
|
(void) va_arg(list, char *);
|
|
p1275buf.prom_args[i + 3] = (unsigned long)p;
|
|
p += 32;
|
|
break;
|
|
case P1275_ARG_IN_FUNCTION:
|
|
p1275buf.prom_args[i + 3] =
|
|
(unsigned long)prom_cif_callback;
|
|
p1275buf.prom_callback = va_arg(list, long);
|
|
break;
|
|
}
|
|
}
|
|
va_end(list);
|
|
|
|
prom_world(1);
|
|
prom_cif_interface();
|
|
prom_world(0);
|
|
|
|
attrs = fmt >> 8;
|
|
va_start(list, fmt);
|
|
for (i = 0; i < nargs; i++, attrs >>= 3) {
|
|
switch (attrs & 0x7) {
|
|
case P1275_ARG_NUMBER:
|
|
(void) va_arg(list, long);
|
|
break;
|
|
case P1275_ARG_IN_STRING:
|
|
(void) va_arg(list, char *);
|
|
break;
|
|
case P1275_ARG_IN_FUNCTION:
|
|
(void) va_arg(list, long);
|
|
break;
|
|
case P1275_ARG_IN_BUF:
|
|
(void) va_arg(list, char *);
|
|
(void) va_arg(list, long);
|
|
i++; attrs >>= 3;
|
|
break;
|
|
case P1275_ARG_OUT_BUF:
|
|
p = va_arg(list, char *);
|
|
x = va_arg(list, long);
|
|
memcpy (p, (char *)(p1275buf.prom_args[i + 3]), (int)x);
|
|
i++; attrs >>= 3;
|
|
break;
|
|
case P1275_ARG_OUT_32B:
|
|
p = va_arg(list, char *);
|
|
memcpy (p, (char *)(p1275buf.prom_args[i + 3]), 32);
|
|
break;
|
|
}
|
|
}
|
|
va_end(list);
|
|
x = p1275buf.prom_args [nargs + 3];
|
|
|
|
spin_unlock_irqrestore(&prom_entry_lock, flags);
|
|
|
|
return x;
|
|
}
|
|
|
|
void prom_cif_init(void *cif_handler, void *cif_stack)
|
|
{
|
|
p1275buf.prom_cif_handler = (void (*)(long *))cif_handler;
|
|
p1275buf.prom_cif_stack = (unsigned long)cif_stack;
|
|
}
|