| // SPDX-License-Identifier: GPL-2.0 | 
 | /* | 
 |  *	Macintosh Nubus Interface Code | 
 |  * | 
 |  *      Originally by Alan Cox | 
 |  * | 
 |  *      Mostly rewritten by David Huggins-Daines, C. Scott Ananian, | 
 |  *      and others. | 
 |  */ | 
 |  | 
 | #include <linux/types.h> | 
 | #include <linux/kernel.h> | 
 | #include <linux/string.h> | 
 | #include <linux/nubus.h> | 
 | #include <linux/errno.h> | 
 | #include <linux/init.h> | 
 | #include <linux/module.h> | 
 | #include <linux/seq_file.h> | 
 | #include <linux/slab.h> | 
 | #include <asm/setup.h> | 
 | #include <asm/page.h> | 
 | #include <asm/hwtest.h> | 
 |  | 
 | /* Constants */ | 
 |  | 
 | /* This is, of course, the size in bytelanes, rather than the size in | 
 |    actual bytes */ | 
 | #define FORMAT_BLOCK_SIZE 20 | 
 | #define ROM_DIR_OFFSET 0x24 | 
 |  | 
 | #define NUBUS_TEST_PATTERN 0x5A932BC7 | 
 |  | 
 | /* Globals */ | 
 |  | 
 | LIST_HEAD(nubus_func_rsrcs); | 
 |  | 
 | /* Meaning of "bytelanes": | 
 |  | 
 |    The card ROM may appear on any or all bytes of each long word in | 
 |    NuBus memory.  The low 4 bits of the "map" value found in the | 
 |    format block (at the top of the slot address space, as well as at | 
 |    the top of the MacOS ROM) tells us which bytelanes, i.e. which byte | 
 |    offsets within each longword, are valid.  Thus: | 
 |  | 
 |    A map of 0x0f, as found in the MacOS ROM, means that all bytelanes | 
 |    are valid. | 
 |  | 
 |    A map of 0xf0 means that no bytelanes are valid (We pray that we | 
 |    will never encounter this, but stranger things have happened) | 
 |  | 
 |    A map of 0xe1 means that only the MSB of each long word is actually | 
 |    part of the card ROM.  (We hope to never encounter NuBus on a | 
 |    little-endian machine.  Again, stranger things have happened) | 
 |  | 
 |    A map of 0x78 means that only the LSB of each long word is valid. | 
 |  | 
 |    Etcetera, etcetera.  Hopefully this clears up some confusion over | 
 |    what the following code actually does.  */ | 
 |  | 
 | static inline int not_useful(void *p, int map) | 
 | { | 
 | 	unsigned long pv = (unsigned long)p; | 
 |  | 
 | 	pv &= 3; | 
 | 	if (map & (1 << pv)) | 
 | 		return 0; | 
 | 	return 1; | 
 | } | 
 |  | 
 | static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map) | 
 | { | 
 | 	/* This will hold the result */ | 
 | 	unsigned long v = 0; | 
 | 	unsigned char *p = *ptr; | 
 |  | 
 | 	while (len) { | 
 | 		v <<= 8; | 
 | 		while (not_useful(p, map)) | 
 | 			p++; | 
 | 		v |= *p++; | 
 | 		len--; | 
 | 	} | 
 | 	*ptr = p; | 
 | 	return v; | 
 | } | 
 |  | 
 | static void nubus_rewind(unsigned char **ptr, int len, int map) | 
 | { | 
 | 	unsigned char *p = *ptr; | 
 |  | 
 | 	while (len) { | 
 | 		do { | 
 | 			p--; | 
 | 		} while (not_useful(p, map)); | 
 | 		len--; | 
 | 	} | 
 | 	*ptr = p; | 
 | } | 
 |  | 
 | static void nubus_advance(unsigned char **ptr, int len, int map) | 
 | { | 
 | 	unsigned char *p = *ptr; | 
 |  | 
 | 	while (len) { | 
 | 		while (not_useful(p, map)) | 
 | 			p++; | 
 | 		p++; | 
 | 		len--; | 
 | 	} | 
 | 	*ptr = p; | 
 | } | 
 |  | 
 | static void nubus_move(unsigned char **ptr, int len, int map) | 
 | { | 
 | 	unsigned long slot_space = (unsigned long)*ptr & 0xFF000000; | 
 |  | 
 | 	if (len > 0) | 
 | 		nubus_advance(ptr, len, map); | 
 | 	else if (len < 0) | 
 | 		nubus_rewind(ptr, -len, map); | 
 |  | 
 | 	if (((unsigned long)*ptr & 0xFF000000) != slot_space) | 
 | 		pr_err("%s: moved out of slot address space!\n", __func__); | 
 | } | 
 |  | 
 | /* Now, functions to read the sResource tree */ | 
 |  | 
 | /* Each sResource entry consists of a 1-byte ID and a 3-byte data | 
 |    field.  If that data field contains an offset, then obviously we | 
 |    have to expand it from a 24-bit signed number to a 32-bit signed | 
 |    number. */ | 
 |  | 
 | static inline long nubus_expand32(long foo) | 
 | { | 
 | 	if (foo & 0x00800000)	/* 24bit negative */ | 
 | 		foo |= 0xFF000000; | 
 | 	return foo; | 
 | } | 
 |  | 
 | static inline void *nubus_rom_addr(int slot) | 
 | { | 
 | 	/* | 
 | 	 *	Returns the first byte after the card. We then walk | 
 | 	 *	backwards to get the lane register and the config | 
 | 	 */ | 
 | 	return (void *)(0xF1000000 + (slot << 24)); | 
 | } | 
 |  | 
 | unsigned char *nubus_dirptr(const struct nubus_dirent *nd) | 
 | { | 
 | 	unsigned char *p = nd->base; | 
 |  | 
 | 	/* Essentially, just step over the bytelanes using whatever | 
 | 	   offset we might have found */ | 
 | 	nubus_move(&p, nubus_expand32(nd->data), nd->mask); | 
 | 	/* And return the value */ | 
 | 	return p; | 
 | } | 
 |  | 
 | /* These two are for pulling resource data blocks (i.e. stuff that's | 
 |    pointed to with offsets) out of the card ROM. */ | 
 |  | 
 | void nubus_get_rsrc_mem(void *dest, const struct nubus_dirent *dirent, | 
 | 			unsigned int len) | 
 | { | 
 | 	unsigned char *t = (unsigned char *)dest; | 
 | 	unsigned char *p = nubus_dirptr(dirent); | 
 |  | 
 | 	while (len) { | 
 | 		*t++ = nubus_get_rom(&p, 1, dirent->mask); | 
 | 		len--; | 
 | 	} | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_rsrc_mem); | 
 |  | 
 | unsigned int nubus_get_rsrc_str(char *dest, const struct nubus_dirent *dirent, | 
 | 				unsigned int len) | 
 | { | 
 | 	char *t = dest; | 
 | 	unsigned char *p = nubus_dirptr(dirent); | 
 |  | 
 | 	while (len > 1) { | 
 | 		unsigned char c = nubus_get_rom(&p, 1, dirent->mask); | 
 |  | 
 | 		if (!c) | 
 | 			break; | 
 | 		*t++ = c; | 
 | 		len--; | 
 | 	} | 
 | 	if (len > 0) | 
 | 		*t = '\0'; | 
 | 	return t - dest; | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_rsrc_str); | 
 |  | 
 | void nubus_seq_write_rsrc_mem(struct seq_file *m, | 
 | 			      const struct nubus_dirent *dirent, | 
 | 			      unsigned int len) | 
 | { | 
 | 	unsigned long buf[32]; | 
 | 	unsigned int buf_size = sizeof(buf); | 
 | 	unsigned char *p = nubus_dirptr(dirent); | 
 |  | 
 | 	/* If possible, write out full buffers */ | 
 | 	while (len >= buf_size) { | 
 | 		unsigned int i; | 
 |  | 
 | 		for (i = 0; i < ARRAY_SIZE(buf); i++) | 
 | 			buf[i] = nubus_get_rom(&p, sizeof(buf[0]), | 
 | 					       dirent->mask); | 
 | 		seq_write(m, buf, buf_size); | 
 | 		len -= buf_size; | 
 | 	} | 
 | 	/* If not, write out individual bytes */ | 
 | 	while (len--) | 
 | 		seq_putc(m, nubus_get_rom(&p, 1, dirent->mask)); | 
 | } | 
 |  | 
 | int nubus_get_root_dir(const struct nubus_board *board, | 
 | 		       struct nubus_dir *dir) | 
 | { | 
 | 	dir->ptr = dir->base = board->directory; | 
 | 	dir->done = 0; | 
 | 	dir->mask = board->lanes; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_root_dir); | 
 |  | 
 | /* This is a slyly renamed version of the above */ | 
 | int nubus_get_func_dir(const struct nubus_rsrc *fres, struct nubus_dir *dir) | 
 | { | 
 | 	dir->ptr = dir->base = fres->directory; | 
 | 	dir->done = 0; | 
 | 	dir->mask = fres->board->lanes; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_func_dir); | 
 |  | 
 | int nubus_get_board_dir(const struct nubus_board *board, | 
 | 			struct nubus_dir *dir) | 
 | { | 
 | 	struct nubus_dirent ent; | 
 |  | 
 | 	dir->ptr = dir->base = board->directory; | 
 | 	dir->done = 0; | 
 | 	dir->mask = board->lanes; | 
 |  | 
 | 	/* Now dereference it (the first directory is always the board | 
 | 	   directory) */ | 
 | 	if (nubus_readdir(dir, &ent) == -1) | 
 | 		return -1; | 
 | 	if (nubus_get_subdir(&ent, dir) == -1) | 
 | 		return -1; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_board_dir); | 
 |  | 
 | int nubus_get_subdir(const struct nubus_dirent *ent, | 
 | 		     struct nubus_dir *dir) | 
 | { | 
 | 	dir->ptr = dir->base = nubus_dirptr(ent); | 
 | 	dir->done = 0; | 
 | 	dir->mask = ent->mask; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_get_subdir); | 
 |  | 
 | int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent) | 
 | { | 
 | 	u32 resid; | 
 |  | 
 | 	if (nd->done) | 
 | 		return -1; | 
 |  | 
 | 	/* Do this first, otherwise nubus_rewind & co are off by 4 */ | 
 | 	ent->base = nd->ptr; | 
 |  | 
 | 	/* This moves nd->ptr forward */ | 
 | 	resid = nubus_get_rom(&nd->ptr, 4, nd->mask); | 
 |  | 
 | 	/* EOL marker, as per the Apple docs */ | 
 | 	if ((resid & 0xff000000) == 0xff000000) { | 
 | 		/* Mark it as done */ | 
 | 		nd->done = 1; | 
 | 		return -1; | 
 | 	} | 
 |  | 
 | 	/* First byte is the resource ID */ | 
 | 	ent->type = resid >> 24; | 
 | 	/* Low 3 bytes might contain data (or might not) */ | 
 | 	ent->data = resid & 0xffffff; | 
 | 	ent->mask = nd->mask; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_readdir); | 
 |  | 
 | int nubus_rewinddir(struct nubus_dir *dir) | 
 | { | 
 | 	dir->ptr = dir->base; | 
 | 	dir->done = 0; | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(nubus_rewinddir); | 
 |  | 
 | /* Driver interface functions, more or less like in pci.c */ | 
 |  | 
 | struct nubus_rsrc *nubus_first_rsrc_or_null(void) | 
 | { | 
 | 	return list_first_entry_or_null(&nubus_func_rsrcs, struct nubus_rsrc, | 
 | 					list); | 
 | } | 
 | EXPORT_SYMBOL(nubus_first_rsrc_or_null); | 
 |  | 
 | struct nubus_rsrc *nubus_next_rsrc_or_null(struct nubus_rsrc *from) | 
 | { | 
 | 	if (list_is_last(&from->list, &nubus_func_rsrcs)) | 
 | 		return NULL; | 
 | 	return list_next_entry(from, list); | 
 | } | 
 | EXPORT_SYMBOL(nubus_next_rsrc_or_null); | 
 |  | 
 | int | 
 | nubus_find_rsrc(struct nubus_dir *dir, unsigned char rsrc_type, | 
 | 		struct nubus_dirent *ent) | 
 | { | 
 | 	while (nubus_readdir(dir, ent) != -1) { | 
 | 		if (ent->type == rsrc_type) | 
 | 			return 0; | 
 | 	} | 
 | 	return -1; | 
 | } | 
 | EXPORT_SYMBOL(nubus_find_rsrc); | 
 |  | 
 | /* Initialization functions - decide which slots contain stuff worth | 
 |    looking at, and print out lots and lots of information from the | 
 |    resource blocks. */ | 
 |  | 
 | static int __init nubus_get_block_rsrc_dir(struct nubus_board *board, | 
 | 					   struct proc_dir_entry *procdir, | 
 | 					   const struct nubus_dirent *parent) | 
 | { | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 |  | 
 | 	nubus_get_subdir(parent, &dir); | 
 | 	dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		u32 size; | 
 |  | 
 | 		nubus_get_rsrc_mem(&size, &ent, 4); | 
 | 		pr_debug("        block (0x%x), size %d\n", ent.type, size); | 
 | 		nubus_proc_add_rsrc_mem(dir.procdir, &ent, size); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_display_vidmode(struct nubus_board *board, | 
 | 					    struct proc_dir_entry *procdir, | 
 | 					    const struct nubus_dirent *parent) | 
 | { | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 |  | 
 | 	nubus_get_subdir(parent, &dir); | 
 | 	dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		switch (ent.type) { | 
 | 		case 1: /* mVidParams */ | 
 | 		case 2: /* mTable */ | 
 | 		{ | 
 | 			u32 size; | 
 |  | 
 | 			nubus_get_rsrc_mem(&size, &ent, 4); | 
 | 			pr_debug("        block (0x%x), size %d\n", ent.type, | 
 | 				size); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, size); | 
 | 			break; | 
 | 		} | 
 | 		default: | 
 | 			pr_debug("        unknown resource 0x%02x, data 0x%06x\n", | 
 | 				ent.type, ent.data); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 0); | 
 | 		} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_display_resource(struct nubus_rsrc *fres, | 
 | 					     struct proc_dir_entry *procdir, | 
 | 					     const struct nubus_dirent *ent) | 
 | { | 
 | 	switch (ent->type) { | 
 | 	case NUBUS_RESID_GAMMADIR: | 
 | 		pr_debug("    gamma directory offset: 0x%06x\n", ent->data); | 
 | 		nubus_get_block_rsrc_dir(fres->board, procdir, ent); | 
 | 		break; | 
 | 	case 0x0080 ... 0x0085: | 
 | 		pr_debug("    mode 0x%02x info offset: 0x%06x\n", | 
 | 			ent->type, ent->data); | 
 | 		nubus_get_display_vidmode(fres->board, procdir, ent); | 
 | 		break; | 
 | 	default: | 
 | 		pr_debug("    unknown resource 0x%02x, data 0x%06x\n", | 
 | 			ent->type, ent->data); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 0); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_network_resource(struct nubus_rsrc *fres, | 
 | 					     struct proc_dir_entry *procdir, | 
 | 					     const struct nubus_dirent *ent) | 
 | { | 
 | 	switch (ent->type) { | 
 | 	case NUBUS_RESID_MAC_ADDRESS: | 
 | 	{ | 
 | 		char addr[6]; | 
 |  | 
 | 		nubus_get_rsrc_mem(addr, ent, 6); | 
 | 		pr_debug("    MAC address: %pM\n", addr); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 6); | 
 | 		break; | 
 | 	} | 
 | 	default: | 
 | 		pr_debug("    unknown resource 0x%02x, data 0x%06x\n", | 
 | 			ent->type, ent->data); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 0); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_cpu_resource(struct nubus_rsrc *fres, | 
 | 					 struct proc_dir_entry *procdir, | 
 | 					 const struct nubus_dirent *ent) | 
 | { | 
 | 	switch (ent->type) { | 
 | 	case NUBUS_RESID_MEMINFO: | 
 | 	{ | 
 | 		unsigned long meminfo[2]; | 
 |  | 
 | 		nubus_get_rsrc_mem(&meminfo, ent, 8); | 
 | 		pr_debug("    memory: [ 0x%08lx 0x%08lx ]\n", | 
 | 			meminfo[0], meminfo[1]); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 8); | 
 | 		break; | 
 | 	} | 
 | 	case NUBUS_RESID_ROMINFO: | 
 | 	{ | 
 | 		unsigned long rominfo[2]; | 
 |  | 
 | 		nubus_get_rsrc_mem(&rominfo, ent, 8); | 
 | 		pr_debug("    ROM:    [ 0x%08lx 0x%08lx ]\n", | 
 | 			rominfo[0], rominfo[1]); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 8); | 
 | 		break; | 
 | 	} | 
 | 	default: | 
 | 		pr_debug("    unknown resource 0x%02x, data 0x%06x\n", | 
 | 			ent->type, ent->data); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 0); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_private_resource(struct nubus_rsrc *fres, | 
 | 					     struct proc_dir_entry *procdir, | 
 | 					     const struct nubus_dirent *ent) | 
 | { | 
 | 	switch (fres->category) { | 
 | 	case NUBUS_CAT_DISPLAY: | 
 | 		nubus_get_display_resource(fres, procdir, ent); | 
 | 		break; | 
 | 	case NUBUS_CAT_NETWORK: | 
 | 		nubus_get_network_resource(fres, procdir, ent); | 
 | 		break; | 
 | 	case NUBUS_CAT_CPU: | 
 | 		nubus_get_cpu_resource(fres, procdir, ent); | 
 | 		break; | 
 | 	default: | 
 | 		pr_debug("    unknown resource 0x%02x, data 0x%06x\n", | 
 | 			ent->type, ent->data); | 
 | 		nubus_proc_add_rsrc_mem(procdir, ent, 0); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct nubus_rsrc * __init | 
 | nubus_get_functional_resource(struct nubus_board *board, int slot, | 
 | 			      const struct nubus_dirent *parent) | 
 | { | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 | 	struct nubus_rsrc *fres; | 
 |  | 
 | 	pr_debug("  Functional resource 0x%02x:\n", parent->type); | 
 | 	nubus_get_subdir(parent, &dir); | 
 | 	dir.procdir = nubus_proc_add_rsrc_dir(board->procdir, parent, board); | 
 |  | 
 | 	/* Actually we should probably panic if this fails */ | 
 | 	fres = kzalloc(sizeof(*fres), GFP_ATOMIC); | 
 | 	if (!fres) | 
 | 		return NULL; | 
 | 	fres->resid = parent->type; | 
 | 	fres->directory = dir.base; | 
 | 	fres->board = board; | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		switch (ent.type) { | 
 | 		case NUBUS_RESID_TYPE: | 
 | 		{ | 
 | 			unsigned short nbtdata[4]; | 
 |  | 
 | 			nubus_get_rsrc_mem(nbtdata, &ent, 8); | 
 | 			fres->category = nbtdata[0]; | 
 | 			fres->type     = nbtdata[1]; | 
 | 			fres->dr_sw    = nbtdata[2]; | 
 | 			fres->dr_hw    = nbtdata[3]; | 
 | 			pr_debug("    type: [cat 0x%x type 0x%x sw 0x%x hw 0x%x]\n", | 
 | 				nbtdata[0], nbtdata[1], nbtdata[2], nbtdata[3]); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 8); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_NAME: | 
 | 		{ | 
 | 			char name[64]; | 
 | 			unsigned int len; | 
 |  | 
 | 			len = nubus_get_rsrc_str(name, &ent, sizeof(name)); | 
 | 			pr_debug("    name: %s\n", name); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_DRVRDIR: | 
 | 		{ | 
 | 			/* MacOS driver.  If we were NetBSD we might | 
 | 			   use this :-) */ | 
 | 			pr_debug("    driver directory offset: 0x%06x\n", | 
 | 				ent.data); | 
 | 			nubus_get_block_rsrc_dir(board, dir.procdir, &ent); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_MINOR_BASEOS: | 
 | 		{ | 
 | 			/* We will need this in order to support | 
 | 			   multiple framebuffers.  It might be handy | 
 | 			   for Ethernet as well */ | 
 | 			u32 base_offset; | 
 |  | 
 | 			nubus_get_rsrc_mem(&base_offset, &ent, 4); | 
 | 			pr_debug("    memory offset: 0x%08x\n", base_offset); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 4); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_MINOR_LENGTH: | 
 | 		{ | 
 | 			/* Ditto */ | 
 | 			u32 length; | 
 |  | 
 | 			nubus_get_rsrc_mem(&length, &ent, 4); | 
 | 			pr_debug("    memory length: 0x%08x\n", length); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 4); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_FLAGS: | 
 | 			pr_debug("    flags: 0x%06x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_HWDEVID: | 
 | 			pr_debug("    hwdevid: 0x%06x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		default: | 
 | 			/* Local/Private resources have their own | 
 | 			   function */ | 
 | 			nubus_get_private_resource(fres, dir.procdir, &ent); | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return fres; | 
 | } | 
 |  | 
 | /* This is *really* cool. */ | 
 | static int __init nubus_get_icon(struct nubus_board *board, | 
 | 				 struct proc_dir_entry *procdir, | 
 | 				 const struct nubus_dirent *ent) | 
 | { | 
 | 	/* Should be 32x32 if my memory serves me correctly */ | 
 | 	u32 icon[32]; | 
 | 	int i; | 
 |  | 
 | 	nubus_get_rsrc_mem(&icon, ent, 128); | 
 | 	pr_debug("    icon:\n"); | 
 | 	for (i = 0; i < 8; i++) | 
 | 		pr_debug("        %08x %08x %08x %08x\n", | 
 | 			icon[i * 4 + 0], icon[i * 4 + 1], | 
 | 			icon[i * 4 + 2], icon[i * 4 + 3]); | 
 | 	nubus_proc_add_rsrc_mem(procdir, ent, 128); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_vendorinfo(struct nubus_board *board, | 
 | 				       struct proc_dir_entry *procdir, | 
 | 				       const struct nubus_dirent *parent) | 
 | { | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 | 	static char *vendor_fields[6] = { "ID", "serial", "revision", | 
 | 	                                  "part", "date", "unknown field" }; | 
 |  | 
 | 	pr_debug("    vendor info:\n"); | 
 | 	nubus_get_subdir(parent, &dir); | 
 | 	dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		char name[64]; | 
 | 		unsigned int len; | 
 |  | 
 | 		/* These are all strings, we think */ | 
 | 		len = nubus_get_rsrc_str(name, &ent, sizeof(name)); | 
 | 		if (ent.type < 1 || ent.type > 5) | 
 | 			ent.type = 5; | 
 | 		pr_debug("    %s: %s\n", vendor_fields[ent.type - 1], name); | 
 | 		nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init nubus_get_board_resource(struct nubus_board *board, int slot, | 
 | 					   const struct nubus_dirent *parent) | 
 | { | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 |  | 
 | 	pr_debug("  Board resource 0x%02x:\n", parent->type); | 
 | 	nubus_get_subdir(parent, &dir); | 
 | 	dir.procdir = nubus_proc_add_rsrc_dir(board->procdir, parent, board); | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		switch (ent.type) { | 
 | 		case NUBUS_RESID_TYPE: | 
 | 		{ | 
 | 			unsigned short nbtdata[4]; | 
 | 			/* This type is always the same, and is not | 
 | 			   useful except insofar as it tells us that | 
 | 			   we really are looking at a board resource. */ | 
 | 			nubus_get_rsrc_mem(nbtdata, &ent, 8); | 
 | 			pr_debug("    type: [cat 0x%x type 0x%x sw 0x%x hw 0x%x]\n", | 
 | 				nbtdata[0], nbtdata[1], nbtdata[2], nbtdata[3]); | 
 | 			if (nbtdata[0] != 1 || nbtdata[1] != 0 || | 
 | 			    nbtdata[2] != 0 || nbtdata[3] != 0) | 
 | 				pr_err("Slot %X: sResource is not a board resource!\n", | 
 | 				       slot); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 8); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_NAME: | 
 | 		{ | 
 | 			unsigned int len; | 
 |  | 
 | 			len = nubus_get_rsrc_str(board->name, &ent, | 
 | 						 sizeof(board->name)); | 
 | 			pr_debug("    name: %s\n", board->name); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); | 
 | 			break; | 
 | 		} | 
 | 		case NUBUS_RESID_ICON: | 
 | 			nubus_get_icon(board, dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_BOARDID: | 
 | 			pr_debug("    board id: 0x%x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_PRIMARYINIT: | 
 | 			pr_debug("    primary init offset: 0x%06x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_VENDORINFO: | 
 | 			nubus_get_vendorinfo(board, dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_FLAGS: | 
 | 			pr_debug("    flags: 0x%06x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_HWDEVID: | 
 | 			pr_debug("    hwdevid: 0x%06x\n", ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		case NUBUS_RESID_SECONDINIT: | 
 | 			pr_debug("    secondary init offset: 0x%06x\n", | 
 | 				 ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 			/* WTF isn't this in the functional resources? */ | 
 | 		case NUBUS_RESID_VIDNAMES: | 
 | 			pr_debug("    vidnames directory offset: 0x%06x\n", | 
 | 				ent.data); | 
 | 			nubus_get_block_rsrc_dir(board, dir.procdir, &ent); | 
 | 			break; | 
 | 			/* Same goes for this */ | 
 | 		case NUBUS_RESID_VIDMODES: | 
 | 			pr_debug("    video mode parameter directory offset: 0x%06x\n", | 
 | 				ent.data); | 
 | 			nubus_proc_add_rsrc(dir.procdir, &ent); | 
 | 			break; | 
 | 		default: | 
 | 			pr_debug("    unknown resource 0x%02x, data 0x%06x\n", | 
 | 				ent.type, ent.data); | 
 | 			nubus_proc_add_rsrc_mem(dir.procdir, &ent, 0); | 
 | 		} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void __init nubus_add_board(int slot, int bytelanes) | 
 | { | 
 | 	struct nubus_board *board; | 
 | 	unsigned char *rp; | 
 | 	unsigned long dpat; | 
 | 	struct nubus_dir dir; | 
 | 	struct nubus_dirent ent; | 
 | 	int prev_resid = -1; | 
 |  | 
 | 	/* Move to the start of the format block */ | 
 | 	rp = nubus_rom_addr(slot); | 
 | 	nubus_rewind(&rp, FORMAT_BLOCK_SIZE, bytelanes); | 
 |  | 
 | 	/* Actually we should probably panic if this fails */ | 
 | 	if ((board = kzalloc(sizeof(*board), GFP_ATOMIC)) == NULL) | 
 | 		return; | 
 | 	board->fblock = rp; | 
 |  | 
 | 	/* Dump the format block for debugging purposes */ | 
 | 	pr_debug("Slot %X, format block at 0x%p:\n", slot, rp); | 
 | 	pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); | 
 | 	pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); | 
 | 	pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); | 
 | 	pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); | 
 | 	pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); | 
 | 	pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); | 
 | 	pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); | 
 | 	pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); | 
 | 	rp = board->fblock; | 
 |  | 
 | 	board->slot = slot; | 
 | 	board->slot_addr = (unsigned long)nubus_slot_addr(slot); | 
 | 	board->doffset = nubus_get_rom(&rp, 4, bytelanes); | 
 | 	/* rom_length is *supposed* to be the total length of the | 
 | 	 * ROM.  In practice it is the "amount of ROM used to compute | 
 | 	 * the CRC."  So some jokers decide to set it to zero and | 
 | 	 * set the crc to zero so they don't have to do any math. | 
 | 	 * See the Performa 460 ROM, for example.  Those Apple "engineers". | 
 | 	 */ | 
 | 	board->rom_length = nubus_get_rom(&rp, 4, bytelanes); | 
 | 	board->crc = nubus_get_rom(&rp, 4, bytelanes); | 
 | 	board->rev = nubus_get_rom(&rp, 1, bytelanes); | 
 | 	board->format = nubus_get_rom(&rp, 1, bytelanes); | 
 | 	board->lanes = bytelanes; | 
 |  | 
 | 	/* Directory offset should be small and negative... */ | 
 | 	if (!(board->doffset & 0x00FF0000)) | 
 | 		pr_warn("Slot %X: Dodgy doffset!\n", slot); | 
 | 	dpat = nubus_get_rom(&rp, 4, bytelanes); | 
 | 	if (dpat != NUBUS_TEST_PATTERN) | 
 | 		pr_warn("Slot %X: Wrong test pattern %08lx!\n", slot, dpat); | 
 |  | 
 | 	/* | 
 | 	 *	I wonder how the CRC is meant to work - | 
 | 	 *		any takers ? | 
 | 	 * CSA: According to MAC docs, not all cards pass the CRC anyway, | 
 | 	 * since the initial Macintosh ROM releases skipped the check. | 
 | 	 */ | 
 |  | 
 | 	/* Set up the directory pointer */ | 
 | 	board->directory = board->fblock; | 
 | 	nubus_move(&board->directory, nubus_expand32(board->doffset), | 
 | 	           board->lanes); | 
 |  | 
 | 	nubus_get_root_dir(board, &dir); | 
 |  | 
 | 	/* We're ready to rock */ | 
 | 	pr_debug("Slot %X resources:\n", slot); | 
 |  | 
 | 	/* Each slot should have one board resource and any number of | 
 | 	 * functional resources.  So we'll fill in some fields in the | 
 | 	 * struct nubus_board from the board resource, then walk down | 
 | 	 * the list of functional resources, spinning out a nubus_rsrc | 
 | 	 * for each of them. | 
 | 	 */ | 
 | 	if (nubus_readdir(&dir, &ent) == -1) { | 
 | 		/* We can't have this! */ | 
 | 		pr_err("Slot %X: Board resource not found!\n", slot); | 
 | 		kfree(board); | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	if (ent.type < 1 || ent.type > 127) | 
 | 		pr_warn("Slot %X: Board resource ID is invalid!\n", slot); | 
 |  | 
 | 	board->procdir = nubus_proc_add_board(board); | 
 |  | 
 | 	nubus_get_board_resource(board, slot, &ent); | 
 |  | 
 | 	while (nubus_readdir(&dir, &ent) != -1) { | 
 | 		struct nubus_rsrc *fres; | 
 |  | 
 | 		fres = nubus_get_functional_resource(board, slot, &ent); | 
 | 		if (fres == NULL) | 
 | 			continue; | 
 |  | 
 | 		/* Resources should appear in ascending ID order. This sanity | 
 | 		 * check prevents duplicate resource IDs. | 
 | 		 */ | 
 | 		if (fres->resid <= prev_resid) { | 
 | 			kfree(fres); | 
 | 			continue; | 
 | 		} | 
 | 		prev_resid = fres->resid; | 
 |  | 
 | 		list_add_tail(&fres->list, &nubus_func_rsrcs); | 
 | 	} | 
 |  | 
 | 	if (nubus_device_register(board)) | 
 | 		put_device(&board->dev); | 
 | } | 
 |  | 
 | static void __init nubus_probe_slot(int slot) | 
 | { | 
 | 	unsigned char dp; | 
 | 	unsigned char *rp; | 
 | 	int i; | 
 |  | 
 | 	rp = nubus_rom_addr(slot); | 
 | 	for (i = 4; i; i--) { | 
 | 		rp--; | 
 | 		if (!hwreg_present(rp)) | 
 | 			continue; | 
 |  | 
 | 		dp = *rp; | 
 |  | 
 | 		/* The last byte of the format block consists of two | 
 | 		   nybbles which are "mirror images" of each other. | 
 | 		   These show us the valid bytelanes */ | 
 | 		if ((((dp >> 4) ^ dp) & 0x0F) != 0x0F) | 
 | 			continue; | 
 | 		/* Check that this value is actually *on* one of the | 
 | 		   bytelanes it claims are valid! */ | 
 | 		if (not_useful(rp, dp)) | 
 | 			continue; | 
 |  | 
 | 		/* Looks promising.  Let's put it on the list. */ | 
 | 		nubus_add_board(slot, dp); | 
 |  | 
 | 		return; | 
 | 	} | 
 | } | 
 |  | 
 | static void __init nubus_scan_bus(void) | 
 | { | 
 | 	int slot; | 
 |  | 
 | 	pr_info("NuBus: Scanning NuBus slots.\n"); | 
 | 	for (slot = 9; slot < 15; slot++) { | 
 | 		nubus_probe_slot(slot); | 
 | 	} | 
 | } | 
 |  | 
 | static int __init nubus_init(void) | 
 | { | 
 | 	int err; | 
 |  | 
 | 	if (!MACH_IS_MAC) | 
 | 		return 0; | 
 |  | 
 | 	nubus_proc_init(); | 
 | 	err = nubus_parent_device_register(); | 
 | 	if (err) | 
 | 		return err; | 
 | 	nubus_scan_bus(); | 
 | 	return 0; | 
 | } | 
 |  | 
 | subsys_initcall(nubus_init); |