File: /usr/src/linux/arch/arm/boot/compressed/ofw-shark.c
1 /*
2 * linux/arch/arm/boot/compressed/ofw-shark.c
3 *
4 * by Alexander Schulz <aschulz@netwinder.org>
5 *
6 * This file is used to get some basic information
7 * about the memory layout of the shark we are running
8 * on. Memory is usually divided in blocks a 8 MB.
9 * And bootargs are copied from OpenFirmware.
10 */
11
12
13 #include <linux/kernel.h>
14 #include <linux/types.h>
15 #include <asm/setup.h>
16 #include <asm/page.h>
17
18
19 asmlinkage void
20 create_params (unsigned long *buffer)
21 {
22 /* Is there a better address? Also change in mach-shark/arch.c */
23 struct tag *tag = (struct tag *) 0x08003000;
24 int j,i,m,k,nr_banks,size;
25 unsigned char *c;
26
27 /* Head of the taglist */
28 tag->hdr.tag = ATAG_CORE;
29 tag->hdr.size = tag_size(tag_core);
30 tag->u.core.flags = FLAG_READONLY;
31 tag->u.core.pagesize = PAGE_SIZE;
32 tag->u.core.rootdev = 0;
33
34 /* Build up one tagged block for each memory region */
35 size=0;
36 nr_banks=(unsigned int) buffer[0];
37 for (j=0;j<nr_banks;j++){
38 /* search the lowest address and put it into the next entry */
39 /* not a fast sort algorithm, but there are at most 8 entries */
40 /* and this is used only once anyway */
41 m=0xffffffff;
42 for (i=0;i<(unsigned int) buffer[0];i++){
43 if (buffer[2*i+1]<m) {
44 m=buffer[2*i+1];
45 k=i;
46 }
47 }
48
49 tag = tag_next(tag);
50 tag->hdr.tag = ATAG_MEM;
51 tag->hdr.size = tag_size(tag_mem32);
52 tag->u.mem.size = buffer[2*k+2];
53 tag->u.mem.start = buffer[2*k+1];
54
55 size += buffer[2*k+2];
56
57 buffer[2*k+1]=0xffffffff; /* mark as copied */
58 }
59
60 /* The command line */
61 tag = tag_next(tag);
62 tag->hdr.tag = ATAG_CMDLINE;
63
64 c=(unsigned char *)(&buffer[34]);
65 j=0;
66 while (*c) tag->u.cmdline.cmdline[j++]=*c++;
67
68 tag->u.cmdline.cmdline[j]=0;
69 tag->hdr.size = (j + 7 + sizeof(struct tag_header)) >> 2;
70
71 /* Hardware revision */
72 tag = tag_next(tag);
73 tag->hdr.tag = ATAG_REVISION;
74 tag->hdr.size = tag_size(tag_revision);
75 tag->u.revision.rev = ((unsigned char) buffer[33])-'0';
76
77 /* End of the taglist */
78 tag = tag_next(tag);
79 tag->hdr.tag = 0;
80 tag->hdr.size = 0;
81 }
82
83
84 typedef int (*ofw_handle_t)(void *);
85
86 /* Everything below is called with a wrong MMU setting.
87 * This means: no string constants, no initialization of
88 * arrays, no global variables! This is ugly but I didn't
89 * want to write this in assembler :-)
90 */
91
92 int
93 of_decode_int(const unsigned char *p)
94 {
95 unsigned int i = *p++ << 8;
96 i = (i + *p++) << 8;
97 i = (i + *p++) << 8;
98 return (i + *p);
99 }
100
101 int
102 OF_finddevice(ofw_handle_t openfirmware, char *name)
103 {
104 unsigned int args[8];
105 char service[12];
106
107 service[0]='f';
108 service[1]='i';
109 service[2]='n';
110 service[3]='d';
111 service[4]='d';
112 service[5]='e';
113 service[6]='v';
114 service[7]='i';
115 service[8]='c';
116 service[9]='e';
117 service[10]='\0';
118
119 args[0]=(unsigned int)service;
120 args[1]=1;
121 args[2]=1;
122 args[3]=(unsigned int)name;
123
124 if (openfirmware(args) == -1)
125 return -1;
126 return args[4];
127 }
128
129 int
130 OF_getproplen(ofw_handle_t openfirmware, int handle, char *prop)
131 {
132 unsigned int args[8];
133 char service[12];
134
135 service[0]='g';
136 service[1]='e';
137 service[2]='t';
138 service[3]='p';
139 service[4]='r';
140 service[5]='o';
141 service[6]='p';
142 service[7]='l';
143 service[8]='e';
144 service[9]='n';
145 service[10]='\0';
146
147 args[0] = (unsigned int)service;
148 args[1] = 2;
149 args[2] = 1;
150 args[3] = (unsigned int)handle;
151 args[4] = (unsigned int)prop;
152
153 if (openfirmware(args) == -1)
154 return -1;
155 return args[5];
156 }
157
158 int
159 OF_getprop(ofw_handle_t openfirmware, int handle, char *prop, void *buf, unsigned int buflen)
160 {
161 unsigned int args[8];
162 char service[8];
163
164 service[0]='g';
165 service[1]='e';
166 service[2]='t';
167 service[3]='p';
168 service[4]='r';
169 service[5]='o';
170 service[6]='p';
171 service[7]='\0';
172
173 args[0] = (unsigned int)service;
174 args[1] = 4;
175 args[2] = 1;
176 args[3] = (unsigned int)handle;
177 args[4] = (unsigned int)prop;
178 args[5] = (unsigned int)buf;
179 args[6] = buflen;
180
181 if (openfirmware(args) == -1)
182 return -1;
183 return args[7];
184 }
185
186 asmlinkage void ofw_init(ofw_handle_t o, int *nomr, int *pointer)
187 {
188 int phandle,i,mem_len,buffer[32];
189 char temp[15];
190
191 temp[0]='/';
192 temp[1]='m';
193 temp[2]='e';
194 temp[3]='m';
195 temp[4]='o';
196 temp[5]='r';
197 temp[6]='y';
198 temp[7]='\0';
199
200 phandle=OF_finddevice(o,temp);
201
202 temp[0]='r';
203 temp[1]='e';
204 temp[2]='g';
205 temp[3]='\0';
206
207 mem_len = OF_getproplen(o,phandle, temp);
208 OF_getprop(o,phandle, temp, buffer, mem_len);
209 *nomr=mem_len >> 3;
210
211 for (i=0; i<=mem_len/4; i++) pointer[i]=of_decode_int((const unsigned char *)&buffer[i]);
212
213 temp[0]='/';
214 temp[1]='c';
215 temp[2]='h';
216 temp[3]='o';
217 temp[4]='s';
218 temp[5]='e';
219 temp[6]='n';
220 temp[7]='\0';
221
222 phandle=OF_finddevice(o,temp);
223
224 temp[0]='b';
225 temp[1]='o';
226 temp[2]='o';
227 temp[3]='t';
228 temp[4]='a';
229 temp[5]='r';
230 temp[6]='g';
231 temp[7]='s';
232 temp[8]='\0';
233
234 mem_len = OF_getproplen(o,phandle, temp);
235 OF_getprop(o,phandle, temp, buffer, mem_len);
236 if (mem_len > 128) mem_len=128;
237 for (i=0; i<=mem_len/4; i++) pointer[i+33]=buffer[i];
238 pointer[i+33]=0;
239
240 temp[0]='/';
241 temp[1]='\0';
242 phandle=OF_finddevice(o,temp);
243 temp[0]='b';
244 temp[1]='a';
245 temp[2]='n';
246 temp[3]='n';
247 temp[4]='e';
248 temp[5]='r';
249 temp[6]='-';
250 temp[7]='n';
251 temp[8]='a';
252 temp[9]='m';
253 temp[10]='e';
254 temp[11]='\0';
255 mem_len = OF_getproplen(o,phandle, temp);
256 OF_getprop(o,phandle, temp, buffer, mem_len);
257 (unsigned char) pointer[32] = ((unsigned char *) buffer)[mem_len-2];
258 }
259