diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/sparc64/prom/p1275.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/sparc64/prom/p1275.c')
-rw-r--r-- | arch/sparc64/prom/p1275.c | 161 |
1 files changed, 161 insertions, 0 deletions
diff --git a/arch/sparc64/prom/p1275.c b/arch/sparc64/prom/p1275.c new file mode 100644 index 000000000000..59fe38bba39e --- /dev/null +++ b/arch/sparc64/prom/p1275.c | |||
@@ -0,0 +1,161 @@ | |||
1 | /* $Id: p1275.c,v 1.22 2001/10/18 09:40:00 davem Exp $ | ||
2 | * p1275.c: Sun IEEE 1275 PROM low level interface routines | ||
3 | * | ||
4 | * Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz) | ||
5 | */ | ||
6 | |||
7 | #include <linux/kernel.h> | ||
8 | #include <linux/init.h> | ||
9 | #include <linux/sched.h> | ||
10 | #include <linux/smp.h> | ||
11 | #include <linux/string.h> | ||
12 | #include <linux/spinlock.h> | ||
13 | |||
14 | #include <asm/openprom.h> | ||
15 | #include <asm/oplib.h> | ||
16 | #include <asm/system.h> | ||
17 | #include <asm/spitfire.h> | ||
18 | #include <asm/pstate.h> | ||
19 | |||
20 | struct { | ||
21 | long prom_callback; /* 0x00 */ | ||
22 | void (*prom_cif_handler)(long *); /* 0x08 */ | ||
23 | unsigned long prom_cif_stack; /* 0x10 */ | ||
24 | unsigned long prom_args [23]; /* 0x18 */ | ||
25 | char prom_buffer [3000]; | ||
26 | } p1275buf; | ||
27 | |||
28 | extern void prom_world(int); | ||
29 | |||
30 | extern void prom_cif_interface(void); | ||
31 | extern void prom_cif_callback(void); | ||
32 | |||
33 | static inline unsigned long spitfire_get_primary_context(void) | ||
34 | { | ||
35 | unsigned long ctx; | ||
36 | |||
37 | __asm__ __volatile__("ldxa [%1] %2, %0" | ||
38 | : "=r" (ctx) | ||
39 | : "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU)); | ||
40 | return ctx; | ||
41 | } | ||
42 | |||
43 | /* | ||
44 | * This provides SMP safety on the p1275buf. prom_callback() drops this lock | ||
45 | * to allow recursuve acquisition. | ||
46 | */ | ||
47 | DEFINE_SPINLOCK(prom_entry_lock); | ||
48 | |||
49 | long p1275_cmd (char *service, long fmt, ...) | ||
50 | { | ||
51 | char *p, *q; | ||
52 | unsigned long flags; | ||
53 | int nargs, nrets, i; | ||
54 | va_list list; | ||
55 | long attrs, x; | ||
56 | |||
57 | p = p1275buf.prom_buffer; | ||
58 | BUG_ON((spitfire_get_primary_context() & CTX_NR_MASK) != 0); | ||
59 | |||
60 | spin_lock_irqsave(&prom_entry_lock, flags); | ||
61 | |||
62 | p1275buf.prom_args[0] = (unsigned long)p; /* service */ | ||
63 | strcpy (p, service); | ||
64 | p = (char *)(((long)(strchr (p, 0) + 8)) & ~7); | ||
65 | p1275buf.prom_args[1] = nargs = (fmt & 0x0f); /* nargs */ | ||
66 | p1275buf.prom_args[2] = nrets = ((fmt & 0xf0) >> 4); /* nrets */ | ||
67 | attrs = fmt >> 8; | ||
68 | va_start(list, fmt); | ||
69 | for (i = 0; i < nargs; i++, attrs >>= 3) { | ||
70 | switch (attrs & 0x7) { | ||
71 | case P1275_ARG_NUMBER: | ||
72 | p1275buf.prom_args[i + 3] = | ||
73 | (unsigned)va_arg(list, long); | ||
74 | break; | ||
75 | case P1275_ARG_IN_64B: | ||
76 | p1275buf.prom_args[i + 3] = | ||
77 | va_arg(list, unsigned long); | ||
78 | break; | ||
79 | case P1275_ARG_IN_STRING: | ||
80 | strcpy (p, va_arg(list, char *)); | ||
81 | p1275buf.prom_args[i + 3] = (unsigned long)p; | ||
82 | p = (char *)(((long)(strchr (p, 0) + 8)) & ~7); | ||
83 | break; | ||
84 | case P1275_ARG_OUT_BUF: | ||
85 | (void) va_arg(list, char *); | ||
86 | p1275buf.prom_args[i + 3] = (unsigned long)p; | ||
87 | x = va_arg(list, long); | ||
88 | i++; attrs >>= 3; | ||
89 | p = (char *)(((long)(p + (int)x + 7)) & ~7); | ||
90 | p1275buf.prom_args[i + 3] = x; | ||
91 | break; | ||
92 | case P1275_ARG_IN_BUF: | ||
93 | q = va_arg(list, char *); | ||
94 | p1275buf.prom_args[i + 3] = (unsigned long)p; | ||
95 | x = va_arg(list, long); | ||
96 | i++; attrs >>= 3; | ||
97 | memcpy (p, q, (int)x); | ||
98 | p = (char *)(((long)(p + (int)x + 7)) & ~7); | ||
99 | p1275buf.prom_args[i + 3] = x; | ||
100 | break; | ||
101 | case P1275_ARG_OUT_32B: | ||
102 | (void) va_arg(list, char *); | ||
103 | p1275buf.prom_args[i + 3] = (unsigned long)p; | ||
104 | p += 32; | ||
105 | break; | ||
106 | case P1275_ARG_IN_FUNCTION: | ||
107 | p1275buf.prom_args[i + 3] = | ||
108 | (unsigned long)prom_cif_callback; | ||
109 | p1275buf.prom_callback = va_arg(list, long); | ||
110 | break; | ||
111 | } | ||
112 | } | ||
113 | va_end(list); | ||
114 | |||
115 | prom_world(1); | ||
116 | prom_cif_interface(); | ||
117 | prom_world(0); | ||
118 | |||
119 | attrs = fmt >> 8; | ||
120 | va_start(list, fmt); | ||
121 | for (i = 0; i < nargs; i++, attrs >>= 3) { | ||
122 | switch (attrs & 0x7) { | ||
123 | case P1275_ARG_NUMBER: | ||
124 | (void) va_arg(list, long); | ||
125 | break; | ||
126 | case P1275_ARG_IN_STRING: | ||
127 | (void) va_arg(list, char *); | ||
128 | break; | ||
129 | case P1275_ARG_IN_FUNCTION: | ||
130 | (void) va_arg(list, long); | ||
131 | break; | ||
132 | case P1275_ARG_IN_BUF: | ||
133 | (void) va_arg(list, char *); | ||
134 | (void) va_arg(list, long); | ||
135 | i++; attrs >>= 3; | ||
136 | break; | ||
137 | case P1275_ARG_OUT_BUF: | ||
138 | p = va_arg(list, char *); | ||
139 | x = va_arg(list, long); | ||
140 | memcpy (p, (char *)(p1275buf.prom_args[i + 3]), (int)x); | ||
141 | i++; attrs >>= 3; | ||
142 | break; | ||
143 | case P1275_ARG_OUT_32B: | ||
144 | p = va_arg(list, char *); | ||
145 | memcpy (p, (char *)(p1275buf.prom_args[i + 3]), 32); | ||
146 | break; | ||
147 | } | ||
148 | } | ||
149 | va_end(list); | ||
150 | x = p1275buf.prom_args [nargs + 3]; | ||
151 | |||
152 | spin_unlock_irqrestore(&prom_entry_lock, flags); | ||
153 | |||
154 | return x; | ||
155 | } | ||
156 | |||
157 | void prom_cif_init(void *cif_handler, void *cif_stack) | ||
158 | { | ||
159 | p1275buf.prom_cif_handler = (void (*)(long *))cif_handler; | ||
160 | p1275buf.prom_cif_stack = (unsigned long)cif_stack; | ||
161 | } | ||