bdeeed0988
Loading a NuBus driver module on a non-NuBus machine triggers the
BUG_ON(!drv->bus->p) in driver_register(), because bus_register() was
not called, because it is conditional on MACH_IS_MAC.
Fix the crash by calling bus_register() unconditionally. Call it from
a postcore_initcall(), like other busses do.
Hence, the bus type is available for device_register(), which happens
in a subsys initcall, and for driver_register(), which happens in a
device or module initcall.
Cc: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
Reported-by: Michael Schmitz <schmitzmic@gmail.com>
Tested-by: Stan Johnson <userm57@yahoo.com>
Fixes: 7f86c765a6
("nubus: Add support for the driver model")
Signed-off-by: Finn Thain <fthain@telegraphics.com.au>
Reviewed-by: Geert Uytterhoeven <geert@linux-m68k.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
886 lines
22 KiB
C
886 lines
22 KiB
C
// 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);
|