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