Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 | /* $Id: p1275.c,v 1.22 2001/10/18 09:40:00 davem 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/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> 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); static inline unsigned long spitfire_get_primary_context(void) { unsigned long ctx; __asm__ __volatile__("ldxa [%1] %2, %0" : "=r" (ctx) : "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU)); return ctx; } /* * 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; BUG_ON((spitfire_get_primary_context() & CTX_NR_MASK) != 0); 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; } |