nubus.c revision 1.43 1 1.43 scottr /* $NetBSD: nubus.c,v 1.43 1998/01/13 19:24:56 scottr Exp $ */
2 1.8 cgd
3 1.11 briggs /*
4 1.29 scottr * Copyright (c) 1995, 1996 Allen Briggs. All rights reserved.
5 1.1 briggs *
6 1.1 briggs * Redistribution and use in source and binary forms, with or without
7 1.1 briggs * modification, are permitted provided that the following conditions
8 1.1 briggs * are met:
9 1.1 briggs * 1. Redistributions of source code must retain the above copyright
10 1.1 briggs * notice, this list of conditions and the following disclaimer.
11 1.1 briggs * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 briggs * notice, this list of conditions and the following disclaimer in the
13 1.1 briggs * documentation and/or other materials provided with the distribution.
14 1.1 briggs * 3. All advertising materials mentioning features or use of this software
15 1.1 briggs * must display the following acknowledgement:
16 1.11 briggs * This product includes software developed by Allen Briggs.
17 1.11 briggs * 4. The name of the author may not be used to endorse or promote products
18 1.11 briggs * derived from this software without specific prior written permission.
19 1.1 briggs *
20 1.11 briggs * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.1 briggs * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.1 briggs * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.11 briggs * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.1 briggs * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.1 briggs * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.1 briggs * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.1 briggs * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.11 briggs * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.11 briggs * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.1 briggs */
31 1.1 briggs
32 1.4 briggs #include <sys/param.h>
33 1.4 briggs #include <sys/systm.h>
34 1.10 briggs #include <sys/device.h>
35 1.29 scottr #include <sys/buf.h>
36 1.29 scottr #include <sys/conf.h>
37 1.29 scottr #include <sys/dmap.h>
38 1.29 scottr
39 1.29 scottr #include <vm/vm.h>
40 1.29 scottr #include <vm/vm_kern.h>
41 1.29 scottr #include <vm/vm_map.h>
42 1.10 briggs
43 1.19 briggs #include <machine/autoconf.h>
44 1.30 scottr #include <machine/bus.h>
45 1.29 scottr #include <machine/vmparam.h>
46 1.29 scottr #include <machine/param.h>
47 1.4 briggs #include <machine/cpu.h>
48 1.29 scottr #include <machine/pte.h>
49 1.33 scottr #include <machine/viareg.h>
50 1.1 briggs
51 1.12 briggs #include <vm/vm.h>
52 1.12 briggs
53 1.41 scottr #include <mac68k/dev/nubus.h>
54 1.1 briggs
55 1.23 scottr #ifdef DEBUG
56 1.12 briggs #define NDB_PROBE 0x1
57 1.12 briggs #define NDB_FOLLOW 0x2
58 1.12 briggs #define NDB_ARITH 0x4
59 1.37 scottr static int nubus_debug = 0 /* | NDB_PROBE */;
60 1.12 briggs #endif
61 1.12 briggs
62 1.28 scottr static int nubus_print __P((void *, const char *));
63 1.28 scottr static int nubus_match __P((struct device *, struct cfdata *, void *));
64 1.28 scottr static void nubus_attach __P((struct device *, struct device *, void *));
65 1.37 scottr static int nubus_video_resource __P((int));
66 1.11 briggs
67 1.37 scottr static int nubus_probe_slot __P((bus_space_tag_t, bus_space_handle_t,
68 1.37 scottr int, nubus_slot *));
69 1.37 scottr static u_int32_t nubus_calc_CRC __P((bus_space_tag_t, bus_space_handle_t,
70 1.37 scottr nubus_slot *));
71 1.37 scottr
72 1.37 scottr static u_long nubus_adjust_ptr __P((u_int8_t, u_long, long));
73 1.37 scottr static u_int8_t nubus_read_1 __P((bus_space_tag_t, bus_space_handle_t,
74 1.37 scottr u_int8_t, u_long));
75 1.17 briggs #ifdef notyet
76 1.37 scottr static u_int16_t nubus_read_2 __P((bus_space_tag_t, bus_space_handle_t,
77 1.37 scottr u_int8_t, u_long));
78 1.17 briggs #endif
79 1.37 scottr static u_int32_t nubus_read_4 __P((bus_space_tag_t, bus_space_handle_t,
80 1.37 scottr u_int8_t, u_long));
81 1.29 scottr
82 1.16 thorpej struct cfattach nubus_ca = {
83 1.28 scottr sizeof(struct nubus_softc), nubus_match, nubus_attach
84 1.11 briggs };
85 1.1 briggs
86 1.19 briggs static int
87 1.28 scottr nubus_match(parent, cf, aux)
88 1.19 briggs struct device *parent;
89 1.28 scottr struct cfdata *cf;
90 1.28 scottr void *aux;
91 1.19 briggs {
92 1.29 scottr static int nubus_matched = 0;
93 1.19 briggs
94 1.29 scottr /* Allow only one instance. */
95 1.29 scottr if (nubus_matched)
96 1.29 scottr return (0);
97 1.29 scottr
98 1.29 scottr nubus_matched = 1;
99 1.29 scottr return (1);
100 1.19 briggs }
101 1.19 briggs
102 1.11 briggs static void
103 1.28 scottr nubus_attach(parent, self, aux)
104 1.28 scottr struct device *parent, *self;
105 1.28 scottr void *aux;
106 1.11 briggs {
107 1.28 scottr struct nubus_attach_args na_args;
108 1.37 scottr bus_space_tag_t bst;
109 1.37 scottr bus_space_handle_t bsh;
110 1.28 scottr nubus_slot fmtblock;
111 1.28 scottr nubus_dir dir;
112 1.28 scottr nubus_dirent dirent;
113 1.28 scottr nubus_type slottype;
114 1.34 briggs u_long entry;
115 1.28 scottr int i, rsrcid;
116 1.37 scottr u_int8_t lanes;
117 1.1 briggs
118 1.26 christos printf("\n");
119 1.1 briggs
120 1.19 briggs for (i = NUBUS_MIN_SLOT; i <= NUBUS_MAX_SLOT; i++) {
121 1.37 scottr na_args.slot = i;
122 1.37 scottr na_args.na_tag = bst = MAC68K_BUS_SPACE_MEM;
123 1.37 scottr
124 1.37 scottr if (bus_space_map(bst,
125 1.37 scottr NUBUS_SLOT2PA(na_args.slot), NBMEMSIZE, 0, &bsh)) {
126 1.37 scottr #ifdef DIAGNOSTIC
127 1.39 scottr printf("%s: failed to map slot %x, address %p\n",
128 1.37 scottr self->dv_xname, i, (void *)NUBUS_SLOT2PA(i));
129 1.37 scottr #endif
130 1.28 scottr continue;
131 1.37 scottr }
132 1.28 scottr
133 1.37 scottr if (nubus_probe_slot(bst, bsh, i, &fmtblock) <= 0) {
134 1.37 scottr notfound:
135 1.37 scottr bus_space_unmap(bst, bsh, NBMEMSIZE);
136 1.37 scottr continue;
137 1.37 scottr }
138 1.37 scottr
139 1.34 briggs rsrcid = 0x80;
140 1.37 scottr lanes = fmtblock.bytelanes;
141 1.28 scottr
142 1.28 scottr nubus_get_main_dir(&fmtblock, &dir);
143 1.28 scottr
144 1.34 briggs /*
145 1.34 briggs * Get the resource for the first function on the card.
146 1.34 briggs * This is assumed to be at resource ID 0x80. If we can
147 1.34 briggs * not find this entry (as we can not on some video cards),
148 1.34 briggs * check to see if we can get a different ID from the list
149 1.34 briggs * of video resources given to us by the booter. If that
150 1.34 briggs * doesn't work either, take the first resource following
151 1.34 briggs * the board resource.
152 1.34 briggs */
153 1.37 scottr if (nubus_find_rsrc(bst, bsh,
154 1.37 scottr &fmtblock, &dir, rsrcid, &dirent) <= 0) {
155 1.34 briggs if ((rsrcid = nubus_video_resource(i)) == -1) {
156 1.34 briggs /*
157 1.34 briggs * Since nubus_find_rsrc failed, the directory
158 1.34 briggs * is back at its base.
159 1.34 briggs */
160 1.34 briggs entry = dir.curr_ent;
161 1.34 briggs
162 1.34 briggs /*
163 1.34 briggs * All nubus cards should have a board
164 1.34 briggs * resource, but be sure that's what it
165 1.34 briggs * is before we skip it.
166 1.34 briggs */
167 1.37 scottr rsrcid = nubus_read_1(bst, bsh,
168 1.37 scottr lanes, entry);
169 1.34 briggs if (rsrcid == 0x1)
170 1.37 scottr entry = nubus_adjust_ptr(lanes,
171 1.37 scottr dir.curr_ent, 4);
172 1.34 briggs
173 1.37 scottr rsrcid = nubus_read_1(bst, bsh, lanes, entry);
174 1.34 briggs #ifdef DEBUG
175 1.34 briggs if (nubus_debug & NDB_FOLLOW)
176 1.34 briggs printf("\tUsing rsrc 0x%x.\n", rsrcid);
177 1.34 briggs #endif
178 1.37 scottr if (rsrcid == 0xff) /* end of chain */
179 1.37 scottr goto notfound;
180 1.34 briggs }
181 1.34 briggs /*
182 1.34 briggs * Try to find the resource passed by the booter
183 1.34 briggs * or the one we just tracked down.
184 1.34 briggs */
185 1.37 scottr if (nubus_find_rsrc(bst, bsh,
186 1.37 scottr &fmtblock, &dir, rsrcid, &dirent) <= 0)
187 1.37 scottr goto notfound;
188 1.34 briggs }
189 1.28 scottr
190 1.28 scottr nubus_get_dir_from_rsrc(&fmtblock, &dirent, &dir);
191 1.28 scottr
192 1.37 scottr if (nubus_find_rsrc(bst, bsh,
193 1.37 scottr &fmtblock, &dir, NUBUS_RSRC_TYPE, &dirent) <= 0)
194 1.37 scottr goto notfound;
195 1.37 scottr
196 1.37 scottr if (nubus_get_ind_data(bst, bsh, &fmtblock, &dirent,
197 1.37 scottr (caddr_t)&slottype, sizeof(nubus_type)) <= 0)
198 1.37 scottr goto notfound;
199 1.34 briggs
200 1.34 briggs /*
201 1.34 briggs * If this is a display card, try to pull out the correct
202 1.34 briggs * display mode as passed by the booter.
203 1.34 briggs */
204 1.34 briggs if (slottype.category == NUBUS_CATEGORY_DISPLAY) {
205 1.37 scottr int r;
206 1.34 briggs
207 1.34 briggs if ((r = nubus_video_resource(i)) != -1) {
208 1.34 briggs
209 1.34 briggs nubus_get_main_dir(&fmtblock, &dir);
210 1.34 briggs
211 1.37 scottr if (nubus_find_rsrc(bst, bsh,
212 1.37 scottr &fmtblock, &dir, r, &dirent) <= 0)
213 1.37 scottr goto notfound;
214 1.34 briggs
215 1.34 briggs nubus_get_dir_from_rsrc(&fmtblock,
216 1.37 scottr &dirent, &dir);
217 1.34 briggs
218 1.37 scottr if (nubus_find_rsrc(bst, bsh, &fmtblock, &dir,
219 1.37 scottr NUBUS_RSRC_TYPE, &dirent) <= 0)
220 1.37 scottr goto notfound;
221 1.37 scottr
222 1.37 scottr if (nubus_get_ind_data(bst, bsh,
223 1.37 scottr &fmtblock, &dirent, (caddr_t)&slottype,
224 1.37 scottr sizeof(nubus_type)) <= 0)
225 1.37 scottr goto notfound;
226 1.36 briggs
227 1.36 briggs rsrcid = r;
228 1.34 briggs }
229 1.34 briggs }
230 1.28 scottr
231 1.28 scottr na_args.slot = i;
232 1.28 scottr na_args.rsrcid = rsrcid;
233 1.28 scottr na_args.category = slottype.category;
234 1.28 scottr na_args.type = slottype.type;
235 1.28 scottr na_args.drsw = slottype.drsw;
236 1.28 scottr na_args.drhw = slottype.drhw;
237 1.28 scottr na_args.fmt = &fmtblock;
238 1.28 scottr
239 1.37 scottr bus_space_unmap(bst, bsh, NBMEMSIZE);
240 1.37 scottr
241 1.28 scottr config_found(self, &na_args, nubus_print);
242 1.12 briggs }
243 1.33 scottr
244 1.33 scottr enable_nubus_intr();
245 1.1 briggs }
246 1.1 briggs
247 1.10 briggs static int
248 1.40 scottr nubus_print(aux, pnp)
249 1.28 scottr void *aux;
250 1.40 scottr const char *pnp;
251 1.11 briggs {
252 1.37 scottr struct nubus_attach_args *na = (struct nubus_attach_args *)aux;
253 1.37 scottr bus_space_tag_t bst = na->na_tag;
254 1.37 scottr bus_space_handle_t bsh;
255 1.1 briggs
256 1.40 scottr if (pnp) {
257 1.40 scottr printf("%s slot %x", pnp, na->slot);
258 1.37 scottr if (bus_space_map(bst,
259 1.40 scottr NUBUS_SLOT2PA(na->slot), NBMEMSIZE, 0, &bsh) == 0) {
260 1.40 scottr printf(": %s", nubus_get_card_name(bst, bsh, na->fmt));
261 1.37 scottr printf(" (Vendor: %s,", nubus_get_vendor(bst, bsh,
262 1.37 scottr na->fmt, NUBUS_RSRC_VEND_ID));
263 1.40 scottr printf(" Part: %s)", nubus_get_vendor(bst, bsh,
264 1.37 scottr na->fmt, NUBUS_RSRC_VEND_PART));
265 1.40 scottr bus_space_unmap(bst, bsh, NBMEMSIZE);
266 1.40 scottr }
267 1.35 scottr #ifdef DIAGNOSTIC
268 1.40 scottr else
269 1.40 scottr printf(":");
270 1.40 scottr printf(" Type: %04x %04x %04x %04x",
271 1.40 scottr na->category, na->type, na->drsw, na->drhw);
272 1.35 scottr #endif
273 1.40 scottr } else {
274 1.40 scottr printf(" slot %x", na->slot);
275 1.1 briggs }
276 1.11 briggs return (UNCONF);
277 1.28 scottr }
278 1.28 scottr
279 1.37 scottr static int
280 1.28 scottr nubus_video_resource(slot)
281 1.28 scottr int slot;
282 1.28 scottr {
283 1.28 scottr extern u_int16_t mac68k_vrsrc_vec[];
284 1.28 scottr int i;
285 1.28 scottr
286 1.28 scottr for (i = 0 ; i < 6 ; i++)
287 1.28 scottr if ((mac68k_vrsrc_vec[i] & 0xff) == slot)
288 1.28 scottr return ((mac68k_vrsrc_vec[i] >> 8) & 0xff);
289 1.28 scottr return (-1);
290 1.1 briggs }
291 1.1 briggs
292 1.11 briggs /*
293 1.11 briggs * Probe a given nubus slot. If a card is there and we can get the
294 1.11 briggs * format block from it's clutching decl. ROMs, fill the format block
295 1.11 briggs * and return non-zero. If we can't find a card there with a valid
296 1.11 briggs * decl. ROM, return 0.
297 1.11 briggs *
298 1.11 briggs * First, we check to see if we can access the memory at the tail
299 1.11 briggs * end of the slot. If so, then we check for a bytelanes byte. We
300 1.11 briggs * could probably just return a failure status if we bus error on
301 1.11 briggs * the first try, but there really is little reason not to go ahead
302 1.11 briggs * and check the other three locations in case there's a wierd card
303 1.11 briggs * out there.
304 1.11 briggs *
305 1.11 briggs * Checking for a card involves locating the "bytelanes" byte which
306 1.11 briggs * tells us how to interpret the declaration ROM's data. The format
307 1.11 briggs * block is at the top of the card's standard memory space and the
308 1.11 briggs * bytelanes byte is at the end of that block.
309 1.11 briggs *
310 1.11 briggs * After some inspection of the bytelanes byte, it appears that it
311 1.11 briggs * takes the form 0xXY where Y is a bitmask of the bytelanes in use
312 1.11 briggs * and X is a bitmask of the lanes to ignore. Hence, (X ^ Y) == 0
313 1.11 briggs * and (less obviously), Y will have the upper N bits clear if it is
314 1.11 briggs * found N bytes from the last possible location. Both that and
315 1.11 briggs * the exclusive-or check are made.
316 1.11 briggs *
317 1.11 briggs * If a valid
318 1.11 briggs */
319 1.37 scottr static u_int8_t nbits[] = {0,1,1,2,1,2,2,3,1,2,2,3,2,3,3,4};
320 1.11 briggs static int
321 1.37 scottr nubus_probe_slot(bst, bsh, slot, fmt)
322 1.37 scottr bus_space_tag_t bst;
323 1.37 scottr bus_space_handle_t bsh;
324 1.37 scottr int slot;
325 1.37 scottr nubus_slot *fmt;
326 1.1 briggs {
327 1.37 scottr u_long ofs, hdr;
328 1.37 scottr int i, j, found, hdr_size;
329 1.37 scottr u_int8_t lanes;
330 1.10 briggs
331 1.12 briggs #ifdef DEBUG
332 1.37 scottr if (nubus_debug & NDB_PROBE)
333 1.37 scottr printf("probing slot %x\n", slot);
334 1.12 briggs #endif
335 1.12 briggs
336 1.37 scottr /*
337 1.37 scottr * The idea behind this glorious work of art is to probe for only
338 1.38 scottr * valid bytelanes values at appropriate locations (see DC&D p. 159
339 1.37 scottr * for a list). Note the pattern: the first 8 values are at offset
340 1.37 scottr * 0xffffff in the slot's space; the next 4 values at 0xfffffe; the
341 1.37 scottr * next 2 values at 0xfffffd; and the last one at 0xfffffc.
342 1.37 scottr *
343 1.37 scottr * The nested loops implement an efficient search of this space,
344 1.37 scottr * probing first for a valid address, then checking for each of the
345 1.37 scottr * valid bytelanes values at that address.
346 1.37 scottr */
347 1.37 scottr ofs = NBMEMSIZE;
348 1.37 scottr lanes = 0xf;
349 1.10 briggs
350 1.37 scottr for (j = 8, found = 0; j > 0 && !found; j >>= 1) {
351 1.37 scottr ofs--;
352 1.37 scottr for (i = j; i > 0; i--, lanes--) {
353 1.43 scottr if (!mac68k_bus_space_probe(bst, bsh, ofs, 1)) {
354 1.37 scottr lanes -= i;
355 1.37 scottr break;
356 1.37 scottr }
357 1.37 scottr if (bus_space_read_1(bst, bsh, ofs) ==
358 1.37 scottr (((~lanes & 0xf) << 4) | lanes)) {
359 1.37 scottr found = 1;
360 1.37 scottr break;
361 1.37 scottr }
362 1.11 briggs }
363 1.1 briggs }
364 1.37 scottr
365 1.37 scottr if (!found) {
366 1.11 briggs #ifdef DEBUG
367 1.37 scottr if (nubus_debug & NDB_PROBE)
368 1.37 scottr printf("bytelanes not found for slot %x\n", slot);
369 1.11 briggs #endif
370 1.37 scottr return 0;
371 1.37 scottr }
372 1.11 briggs
373 1.37 scottr fmt->bytelanes = lanes;
374 1.37 scottr fmt->step = nbits[(lanes & 0x0f)];
375 1.37 scottr fmt->slot = slot; /* XXX redundant; get rid of this someday */
376 1.11 briggs
377 1.11 briggs #ifdef DEBUG
378 1.12 briggs if (nubus_debug & NDB_PROBE)
379 1.26 christos printf("bytelanes of 0x%x found for slot 0x%x.\n",
380 1.37 scottr fmt->bytelanes, slot);
381 1.11 briggs #endif
382 1.1 briggs
383 1.11 briggs /*
384 1.11 briggs * Go ahead and attempt to load format header.
385 1.11 briggs * First, we need to find the first byte beyond memory that
386 1.11 briggs * would be valid. This is necessary for NUBUS_ROM_offset()
387 1.11 briggs * to work.
388 1.11 briggs */
389 1.37 scottr hdr = NBMEMSIZE;
390 1.37 scottr hdr_size = 20;
391 1.19 briggs
392 1.37 scottr i = 0x10 | (lanes & 0x0f);
393 1.11 briggs while ((i & 1) == 0) {
394 1.11 briggs hdr++;
395 1.11 briggs i >>= 1;
396 1.11 briggs }
397 1.11 briggs fmt->top = hdr;
398 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, -hdr_size);
399 1.11 briggs #ifdef DEBUG
400 1.12 briggs if (nubus_debug & NDB_PROBE)
401 1.27 scottr printf("fmt->top is 0x%lx, that minus 0x%x puts us at 0x%lx.\n",
402 1.37 scottr fmt->top, hdr_size, hdr);
403 1.37 scottr if (nubus_debug & NDB_ARITH)
404 1.37 scottr for (i = 1 ; i < 8 ; i++)
405 1.37 scottr printf("0x%lx - 0x%x = 0x%lx, + 0x%x = 0x%lx.\n",
406 1.37 scottr hdr, i, nubus_adjust_ptr(lanes, hdr, -i),
407 1.37 scottr i, nubus_adjust_ptr(lanes, hdr, i));
408 1.37 scottr #endif
409 1.37 scottr
410 1.37 scottr fmt->directory_offset =
411 1.37 scottr 0xff000000 | nubus_read_4(bst, bsh, lanes, hdr);
412 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, 4);
413 1.37 scottr fmt->length = nubus_read_4(bst, bsh, lanes, hdr);
414 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, 4);
415 1.37 scottr fmt->crc = nubus_read_4(bst, bsh, lanes, hdr);
416 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, 4);
417 1.37 scottr fmt->revision_level = nubus_read_1(bst, bsh, lanes, hdr);
418 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, 1);
419 1.37 scottr fmt->format = nubus_read_1(bst, bsh, lanes, hdr);
420 1.37 scottr hdr = nubus_adjust_ptr(lanes, hdr, 1);
421 1.37 scottr fmt->test_pattern = nubus_read_4(bst, bsh, lanes, hdr);
422 1.11 briggs
423 1.23 scottr #ifdef DEBUG
424 1.12 briggs if (nubus_debug & NDB_PROBE) {
425 1.26 christos printf("Directory offset 0x%x\t", fmt->directory_offset);
426 1.26 christos printf("Length 0x%x\t", fmt->length);
427 1.26 christos printf("CRC 0x%x\n", fmt->crc);
428 1.26 christos printf("Revision level 0x%x\t", fmt->revision_level);
429 1.26 christos printf("Format 0x%x\t", fmt->format);
430 1.26 christos printf("Test Pattern 0x%x\n", fmt->test_pattern);
431 1.12 briggs }
432 1.11 briggs #endif
433 1.11 briggs
434 1.12 briggs if ((fmt->directory_offset & 0x00ff0000) == 0) {
435 1.26 christos printf("Invalid looking directory offset (0x%x)!\n",
436 1.37 scottr fmt->directory_offset);
437 1.12 briggs return 0;
438 1.12 briggs }
439 1.11 briggs if (fmt->test_pattern != NUBUS_ROM_TEST_PATTERN) {
440 1.26 christos printf("Nubus--test pattern invalid:\n");
441 1.37 scottr printf(" slot 0x%x, bytelanes 0x%x?\n", fmt->slot, lanes);
442 1.26 christos printf(" read test 0x%x, compare with 0x%x.\n",
443 1.37 scottr fmt->test_pattern, NUBUS_ROM_TEST_PATTERN);
444 1.11 briggs return 0;
445 1.11 briggs }
446 1.11 briggs
447 1.11 briggs /* Perform CRC */
448 1.37 scottr if (fmt->crc != nubus_calc_CRC(bst, bsh, fmt)) {
449 1.37 scottr printf("Nubus--crc check failed, slot 0x%x.\n", fmt->slot);
450 1.11 briggs return 0;
451 1.1 briggs }
452 1.10 briggs
453 1.11 briggs return 1;
454 1.1 briggs }
455 1.1 briggs
456 1.37 scottr static u_int32_t
457 1.37 scottr nubus_calc_CRC(bst, bsh, fmt)
458 1.37 scottr bus_space_tag_t bst;
459 1.37 scottr bus_space_handle_t bsh;
460 1.37 scottr nubus_slot *fmt;
461 1.37 scottr {
462 1.37 scottr #if 0
463 1.37 scottr u_long base, ptr, crc_loc;
464 1.37 scottr u_int32_t sum;
465 1.37 scottr u_int8_t lanes = fmt->bytelanes;
466 1.37 scottr
467 1.37 scottr base = fmt->top;
468 1.37 scottr crc_loc = NUBUS_ROM_offset(fmt, base, -12);
469 1.37 scottr ptr = NUBUS_ROM_offset(fmt, base, -fmt->length);
470 1.37 scottr
471 1.37 scottr sum = 0;
472 1.37 scottr while (ptr < base)
473 1.37 scottr roll #1, sum
474 1.37 scottr if (ptr == crc_loc) {
475 1.37 scottr roll #3, sum
476 1.37 scottr ptr = nubus_adjust_ptr(lanes, ptr, 3);
477 1.37 scottr } else {
478 1.37 scottr sum += nubus_read_1(bst, bsh, lanes, ptr);
479 1.37 scottr }
480 1.37 scottr ptr = nubus_adjust_ptr(lanes, ptr, 1);
481 1.37 scottr }
482 1.37 scottr
483 1.37 scottr return sum;
484 1.37 scottr #endif
485 1.37 scottr return fmt->crc;
486 1.37 scottr }
487 1.37 scottr
488 1.11 briggs /*
489 1.11 briggs * Compute byte offset on card, taking into account bytelanes.
490 1.11 briggs * Base must be on a valid bytelane for this function to work.
491 1.11 briggs * Return the new address.
492 1.11 briggs *
493 1.11 briggs * XXX -- There has GOT to be a better way to do this.
494 1.11 briggs */
495 1.11 briggs static u_long
496 1.37 scottr nubus_adjust_ptr(lanes, base, amt)
497 1.37 scottr u_int8_t lanes;
498 1.37 scottr u_long base;
499 1.37 scottr long amt;
500 1.11 briggs {
501 1.37 scottr u_int8_t b, t;
502 1.11 briggs
503 1.11 briggs if (!amt)
504 1.11 briggs return base;
505 1.11 briggs
506 1.11 briggs if (amt < 0) {
507 1.11 briggs amt = -amt;
508 1.37 scottr b = lanes;
509 1.11 briggs t = (b << 4);
510 1.11 briggs b <<= (3 - (base & 0x3));
511 1.11 briggs while (amt) {
512 1.11 briggs b <<= 1;
513 1.11 briggs if (b == t)
514 1.37 scottr b = lanes;
515 1.11 briggs if (b & 0x08)
516 1.11 briggs amt--;
517 1.11 briggs base--;
518 1.11 briggs }
519 1.11 briggs return base;
520 1.11 briggs }
521 1.10 briggs
522 1.37 scottr t = (lanes & 0xf) | 0x10;
523 1.11 briggs b = t >> (base & 0x3);
524 1.11 briggs while (amt) {
525 1.11 briggs b >>= 1;
526 1.11 briggs if (b == 1)
527 1.11 briggs b = t;
528 1.11 briggs if (b & 1)
529 1.11 briggs amt--;
530 1.11 briggs base++;
531 1.11 briggs }
532 1.11 briggs
533 1.11 briggs return base;
534 1.11 briggs }
535 1.11 briggs
536 1.37 scottr static u_int8_t
537 1.37 scottr nubus_read_1(bst, bsh, lanes, ofs)
538 1.37 scottr bus_space_tag_t bst;
539 1.37 scottr bus_space_handle_t bsh;
540 1.37 scottr u_int8_t lanes;
541 1.37 scottr u_long ofs;
542 1.1 briggs {
543 1.37 scottr return bus_space_read_1(bst, bsh, ofs);
544 1.1 briggs }
545 1.1 briggs
546 1.17 briggs #ifdef notyet
547 1.17 briggs /* Nothing uses this, yet */
548 1.37 scottr static u_int16_t
549 1.37 scottr nubus_read_2(bst, bsh, lanes, ofs)
550 1.37 scottr bus_space_tag_t bst;
551 1.37 scottr bus_space_handle_t bsh;
552 1.37 scottr u_int8_t lanes;
553 1.37 scottr u_long ofs;
554 1.37 scottr {
555 1.37 scottr u_int16_t s;
556 1.37 scottr
557 1.37 scottr s = (nubus_read_1(bst, bsh, lanes, ofs) << 8);
558 1.37 scottr ofs = nubus_adjust_ptr(lanes, ofs, 1);
559 1.37 scottr s |= nubus_read_1(bst, bsh, lanes, ofs);
560 1.11 briggs return s;
561 1.11 briggs }
562 1.17 briggs #endif
563 1.1 briggs
564 1.37 scottr static u_int32_t
565 1.37 scottr nubus_read_4(bst, bsh, lanes, ofs)
566 1.37 scottr bus_space_tag_t bst;
567 1.37 scottr bus_space_handle_t bsh;
568 1.37 scottr u_int8_t lanes;
569 1.37 scottr u_long ofs;
570 1.11 briggs {
571 1.37 scottr u_int32_t l;
572 1.37 scottr int i;
573 1.10 briggs
574 1.11 briggs l = 0;
575 1.37 scottr for (i = 0; i < 4; i++) {
576 1.37 scottr l = (l << 8) | nubus_read_1(bst, bsh, lanes, ofs);
577 1.37 scottr ofs = nubus_adjust_ptr(lanes, ofs, 1);
578 1.11 briggs }
579 1.11 briggs return l;
580 1.11 briggs }
581 1.10 briggs
582 1.11 briggs void
583 1.37 scottr nubus_get_main_dir(fmt, dir_return)
584 1.37 scottr nubus_slot *fmt;
585 1.37 scottr nubus_dir *dir_return;
586 1.11 briggs {
587 1.23 scottr #ifdef DEBUG
588 1.12 briggs if (nubus_debug & NDB_FOLLOW)
589 1.37 scottr printf("nubus_get_main_dir(%p, %p)\n",
590 1.37 scottr fmt, dir_return);
591 1.12 briggs #endif
592 1.37 scottr dir_return->dirbase = nubus_adjust_ptr(fmt->bytelanes, fmt->top,
593 1.37 scottr fmt->directory_offset - 20);
594 1.37 scottr dir_return->curr_ent = dir_return->dirbase;
595 1.37 scottr }
596 1.37 scottr
597 1.37 scottr void
598 1.37 scottr nubus_get_dir_from_rsrc(fmt, dirent, dir_return)
599 1.37 scottr nubus_slot *fmt;
600 1.37 scottr nubus_dirent *dirent;
601 1.37 scottr nubus_dir *dir_return;
602 1.37 scottr {
603 1.37 scottr u_long loc;
604 1.37 scottr
605 1.37 scottr #ifdef DEBUG
606 1.37 scottr if (nubus_debug & NDB_FOLLOW)
607 1.37 scottr printf("nubus_get_dir_from_rsrc(%p, %p, %p).\n",
608 1.37 scottr fmt, dirent, dir_return);
609 1.37 scottr #endif
610 1.37 scottr if ((loc = dirent->offset) & 0x800000) {
611 1.37 scottr loc |= 0xff000000;
612 1.37 scottr }
613 1.37 scottr dir_return->dirbase =
614 1.37 scottr nubus_adjust_ptr(fmt->bytelanes, dirent->myloc, loc);
615 1.11 briggs dir_return->curr_ent = dir_return->dirbase;
616 1.1 briggs }
617 1.1 briggs
618 1.11 briggs int
619 1.37 scottr nubus_find_rsrc(bst, bsh, fmt, dir, rsrcid, dirent_return)
620 1.37 scottr bus_space_tag_t bst;
621 1.37 scottr bus_space_handle_t bsh;
622 1.37 scottr nubus_slot *fmt;
623 1.37 scottr nubus_dir *dir;
624 1.37 scottr u_int8_t rsrcid;
625 1.37 scottr nubus_dirent *dirent_return;
626 1.1 briggs {
627 1.37 scottr u_long entry;
628 1.37 scottr u_int8_t byte, lanes = fmt->bytelanes;
629 1.10 briggs
630 1.23 scottr #ifdef DEBUG
631 1.12 briggs if (nubus_debug & NDB_FOLLOW)
632 1.37 scottr printf("nubus_find_rsrc(%p, %p, 0x%x, %p)\n",
633 1.37 scottr fmt, dir, rsrcid, dirent_return);
634 1.11 briggs #endif
635 1.37 scottr if (fmt->test_pattern != NUBUS_ROM_TEST_PATTERN)
636 1.12 briggs return -1;
637 1.12 briggs
638 1.12 briggs entry = dir->curr_ent;
639 1.11 briggs do {
640 1.37 scottr byte = nubus_read_1(bst, bsh, lanes, entry);
641 1.23 scottr #ifdef DEBUG
642 1.12 briggs if (nubus_debug & NDB_FOLLOW)
643 1.26 christos printf("\tFound rsrc 0x%x.\n", byte);
644 1.11 briggs #endif
645 1.11 briggs if (byte == rsrcid) {
646 1.11 briggs dirent_return->myloc = entry;
647 1.11 briggs dirent_return->rsrc_id = rsrcid;
648 1.37 scottr entry = nubus_read_4(bst, bsh, lanes, entry);
649 1.11 briggs dirent_return->offset = (entry & 0x00ffffff);
650 1.11 briggs return 1;
651 1.11 briggs }
652 1.11 briggs if (byte == 0xff) {
653 1.11 briggs entry = dir->dirbase;
654 1.11 briggs } else {
655 1.37 scottr entry = nubus_adjust_ptr(lanes, entry, 4);
656 1.11 briggs }
657 1.37 scottr } while (entry != (u_long)dir->curr_ent);
658 1.11 briggs return 0;
659 1.1 briggs }
660 1.1 briggs
661 1.11 briggs int
662 1.37 scottr nubus_get_ind_data(bst, bsh, fmt, dirent, data_return, nbytes)
663 1.37 scottr bus_space_tag_t bst;
664 1.37 scottr bus_space_handle_t bsh;
665 1.37 scottr nubus_slot *fmt;
666 1.11 briggs nubus_dirent *dirent;
667 1.11 briggs caddr_t data_return;
668 1.11 briggs int nbytes;
669 1.11 briggs {
670 1.37 scottr u_long loc;
671 1.37 scottr u_int8_t lanes = fmt->bytelanes;
672 1.1 briggs
673 1.23 scottr #ifdef DEBUG
674 1.12 briggs if (nubus_debug & NDB_FOLLOW)
675 1.37 scottr printf("nubus_get_ind_data(%p, %p, %p, %d).\n",
676 1.37 scottr fmt, dirent, data_return, nbytes);
677 1.12 briggs #endif
678 1.11 briggs if ((loc = dirent->offset) & 0x800000) {
679 1.11 briggs loc |= 0xff000000;
680 1.11 briggs }
681 1.37 scottr loc = nubus_adjust_ptr(lanes, dirent->myloc, loc);
682 1.1 briggs
683 1.11 briggs while (nbytes--) {
684 1.37 scottr *data_return++ = nubus_read_1(bst, bsh, lanes, loc);
685 1.37 scottr loc = nubus_adjust_ptr(lanes, loc, 1);
686 1.1 briggs }
687 1.11 briggs return 1;
688 1.1 briggs }
689 1.1 briggs
690 1.11 briggs int
691 1.37 scottr nubus_get_c_string(bst, bsh, fmt, dirent, data_return, max_bytes)
692 1.37 scottr bus_space_tag_t bst;
693 1.37 scottr bus_space_handle_t bsh;
694 1.37 scottr nubus_slot *fmt;
695 1.11 briggs nubus_dirent *dirent;
696 1.11 briggs caddr_t data_return;
697 1.11 briggs int max_bytes;
698 1.1 briggs {
699 1.37 scottr u_long loc;
700 1.37 scottr u_int8_t lanes = fmt->bytelanes;
701 1.10 briggs
702 1.23 scottr #ifdef DEBUG
703 1.12 briggs if (nubus_debug & NDB_FOLLOW)
704 1.37 scottr printf("nubus_get_c_string(%p, %p, %p, %d).\n",
705 1.37 scottr fmt, dirent, data_return, max_bytes);
706 1.12 briggs #endif
707 1.37 scottr if ((loc = dirent->offset) & 0x800000)
708 1.11 briggs loc |= 0xff000000;
709 1.37 scottr
710 1.37 scottr loc = nubus_adjust_ptr(lanes, dirent->myloc, loc);
711 1.10 briggs
712 1.11 briggs *data_return = '\0';
713 1.11 briggs while (max_bytes--) {
714 1.37 scottr if ((*data_return++ =
715 1.37 scottr nubus_read_1(bst, bsh, lanes, loc)) == 0)
716 1.11 briggs return 1;
717 1.37 scottr loc = nubus_adjust_ptr(lanes, loc, 1);
718 1.11 briggs }
719 1.11 briggs return 0;
720 1.1 briggs }
721 1.2 briggs
722 1.11 briggs static char *huh = "???";
723 1.3 briggs
724 1.11 briggs char *
725 1.37 scottr nubus_get_vendor(bst, bsh, fmt, rsrc)
726 1.37 scottr bus_space_tag_t bst;
727 1.37 scottr bus_space_handle_t bsh;
728 1.37 scottr nubus_slot *fmt;
729 1.37 scottr int rsrc;
730 1.37 scottr {
731 1.37 scottr static char str_ret[64];
732 1.37 scottr nubus_dir dir;
733 1.37 scottr nubus_dirent ent;
734 1.3 briggs
735 1.23 scottr #ifdef DEBUG
736 1.12 briggs if (nubus_debug & NDB_FOLLOW)
737 1.37 scottr printf("nubus_get_vendor(%p, 0x%x).\n", fmt, rsrc);
738 1.12 briggs #endif
739 1.37 scottr nubus_get_main_dir(fmt, &dir);
740 1.37 scottr if (nubus_find_rsrc(bst, bsh, fmt, &dir, 1, &ent) <= 0)
741 1.11 briggs return huh;
742 1.37 scottr nubus_get_dir_from_rsrc(fmt, &ent, &dir);
743 1.2 briggs
744 1.37 scottr if (nubus_find_rsrc(bst, bsh, fmt, &dir, NUBUS_RSRC_VENDORINFO, &ent)
745 1.37 scottr <= 0)
746 1.11 briggs return huh;
747 1.37 scottr nubus_get_dir_from_rsrc(fmt, &ent, &dir);
748 1.10 briggs
749 1.37 scottr if (nubus_find_rsrc(bst, bsh, fmt, &dir, rsrc, &ent) <= 0)
750 1.11 briggs return huh;
751 1.10 briggs
752 1.37 scottr nubus_get_c_string(bst, bsh, fmt, &ent, str_ret, 64);
753 1.2 briggs
754 1.11 briggs return str_ret;
755 1.2 briggs }
756 1.2 briggs
757 1.11 briggs char *
758 1.37 scottr nubus_get_card_name(bst, bsh, fmt)
759 1.37 scottr bus_space_tag_t bst;
760 1.37 scottr bus_space_handle_t bsh;
761 1.37 scottr nubus_slot *fmt;
762 1.2 briggs {
763 1.37 scottr static char name_ret[64];
764 1.37 scottr nubus_dir dir;
765 1.37 scottr nubus_dirent ent;
766 1.2 briggs
767 1.23 scottr #ifdef DEBUG
768 1.12 briggs if (nubus_debug & NDB_FOLLOW)
769 1.37 scottr printf("nubus_get_card_name(%p).\n", fmt);
770 1.12 briggs #endif
771 1.37 scottr nubus_get_main_dir(fmt, &dir);
772 1.2 briggs
773 1.37 scottr if (nubus_find_rsrc(bst, bsh, fmt, &dir, 1, &ent) <= 0)
774 1.11 briggs return huh;
775 1.2 briggs
776 1.37 scottr nubus_get_dir_from_rsrc(fmt, &ent, &dir);
777 1.2 briggs
778 1.37 scottr if (nubus_find_rsrc(bst, bsh, fmt, &dir, NUBUS_RSRC_NAME, &ent) <= 0)
779 1.11 briggs return huh;
780 1.2 briggs
781 1.37 scottr nubus_get_c_string(bst, bsh, fmt, &ent, name_ret, 64);
782 1.2 briggs
783 1.11 briggs return name_ret;
784 1.2 briggs }
785