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
162
163
164
165
166
167
|
/* $Id: init.c,v 1.9 1996/12/18 06:46:55 tridge Exp $
* init.c: Initialize internal variables used by the PROM
* library functions.
*
* Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
* Copyright (C) 1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
*/
#include "promlib.h"
struct linux_romvec *romvec;
enum prom_major_version prom_vers;
unsigned int prom_rev, prom_prev;
void (*prom_cif_handler)(long long *);
void (*prom_cif_h32)(long *);
void *prom_cif_stack;
/* The root node of the prom device tree. */
int prom_root_node;
int prom_stdin, prom_stdout;
int prom_chosen;
/* Pointer to the device tree operations structure. */
struct linux_nodeops *prom_nodeops;
/* You must call prom_init() before you attempt to use any of the
* routines in the prom library. It returns 0 on success, 1 on
* failure. It gets passed the pointer to the PROM vector.
*/
static long long p1275_args[23];
int p1275_cmd (char *service, int args, ...)
{
va_list list;
int i;
int longlong = 0;
if (prom_cif_handler == 0) {
long *p1275_args32 = (long *)p1275_args;
p1275_args32[0] = (long)service;
p1275_args32[1] = args;
p1275_args32[2] = 1;
va_start (list, args);
for (i = 0; i < args; i++)
p1275_args32[i + 3] = (long) va_arg (list, char *);
va_end (list);
(*prom_cif_h32)(p1275_args32);
return p1275_args32[3 + args];
}
p1275_args[0] = (unsigned long long)(unsigned long)service;
if (args < 0) {
args = -args;
longlong = 1;
}
p1275_args[1] = args;
p1275_args[2] = 1;
va_start (list, args);
if (longlong)
for (i = 0; i < args; i++)
p1275_args[i + 3] = va_arg (list, unsigned long long);
else
for (i = 0; i < args; i++)
p1275_args[i + 3] = (unsigned long long)(unsigned long) va_arg (list, char *);
va_end (list);
__asm__ __volatile__ ("
mov %1, %%g1
mov %2, %%g2
save %0, -0xc0, %%sp
rdpr %%pstate, %%l1
andn %%l1, 8, %%l1
wrpr %%l1, 0, %%pstate
call %%g1
mov %%g2, %%o0
wrpr %%l1, 8, %%pstate
restore
" : : "r" (prom_cif_stack), "r" (prom_cif_handler), "r" (p1275_args) :
"o0", "o1", "o2", "o3", "o4", "o5", "o7", "g1", "g2", "g3", "g4",
"g5", "g6", "g7");
return (int) p1275_args [3 + args];
}
void prom_init(struct linux_romvec *rp, void *cifh, void *cifsp)
{
if (cifh || ((int)rp & 1) != 0) {
prom_cif_handler = cifh;
prom_cif_h32 = (void *)((unsigned long)rp & ~1);
prom_cif_stack = cifsp;
prom_vers = PROM_P1275;
prom_chosen = p1275_cmd ("finddevice", 1, "/chosen");
if (prom_chosen == -1) prom_halt ();
prom_stdin = prom_getint (prom_chosen, "stdin");
prom_stdout = prom_getint (prom_chosen, "stdout");
} else {
romvec = rp;
switch(romvec->pv_romvers) {
case 0:
prom_vers = PROM_V0;
break;
case 2:
prom_vers = PROM_V2;
break;
case 3:
prom_vers = PROM_V3;
break;
}
prom_rev = romvec->pv_plugin_revision;
prom_prev = romvec->pv_printrev;
prom_nodeops = romvec->pv_nodeops;
if (prom_vers != PROM_V0) {
prom_stdin = *romvec->pv_v2bootargs.fd_stdin;
prom_stdout = *romvec->pv_v2bootargs.fd_stdout;
}
if((((unsigned long) prom_nodeops) == 0) ||
(((unsigned long) prom_nodeops) == -1))
prom_halt();
}
prom_root_node = prom_getsibling(0);
if((prom_root_node == 0) || (prom_root_node == -1))
prom_halt();
/* Initialization successful. */
return;
}
void
prom_chain(unsigned long addr, int size, unsigned long entry, char *args, int len)
{
p1275_cmd ("chain", 5, addr, size, entry, args, len);
}
void
prom_reboot(char *bcommand)
{
p1275_cmd ("boot", 1, bcommand);
}
/* Drop into the prom, with the chance to continue with the 'go'
* prom command.
*/
void
prom_cmdline(void)
{
if (prom_vers != PROM_P1275)
(*(romvec->pv_abort))();
else
p1275_cmd ("enter", 0);
}
/* Drop into the prom, but completely terminate the program.
* No chance of continuing.
*/
void
prom_halt(void)
{
if (prom_vers != PROM_P1275)
(*(romvec->pv_halt))();
else
p1275_cmd ("exit", 0);
/* Not reached */
}
|
