Skip to content

L
linux
Commit f42e5550 authored by Finn Thain's avatar Finn Thain Committed by Geert Uytterhoeven
Browse files
Options

nubus: Clean up whitespace 

Signed-off-by: default avatarFinn Thain <fthain@telegraphics.com.au>
[geert: rebased]
Signed-off-by: default avatarGeert Uytterhoeven <geert@linux-m68k.org>
parent 71ae40e4
Hide whitespace changes
Inline Side-by-side
Showing with 148 additions and 162 deletions
drivers/nubus/nubus.c
View file @ f42e5550
...@@ -44,8 +44,8 @@ extern void oss_nubus_init(void); ...@@ -44,8 +44,8 @@ extern void oss_nubus_init(void);
/* Globals */ /* Globals */
struct nubus_dev* nubus_devices; struct nubus_dev *nubus_devices;
struct nubus_board* nubus_boards; struct nubus_board *nubus_boards;
/* Meaning of "bytelanes": /* Meaning of "bytelanes":
...@@ -69,26 +69,26 @@ struct nubus_board* nubus_boards; ...@@ -69,26 +69,26 @@ struct nubus_board* nubus_boards;
Etcetera, etcetera. Hopefully this clears up some confusion over Etcetera, etcetera. Hopefully this clears up some confusion over
what the following code actually does. */ what the following code actually does. */
static inline int not_useful(void *p, int map) static inline int not_useful(void *p, int map)
{ {
unsigned long pv=(unsigned long)p; unsigned long pv = (unsigned long)p;
pv &= 3; pv &= 3;
if(map & (1<<pv)) if (map & (1 << pv))
return 0; return 0;
return 1; return 1;
} }
static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map) static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map)
{ {
/* This will hold the result */ /* This will hold the result */
unsigned long v = 0; unsigned long v = 0;
unsigned char *p = *ptr; unsigned char *p = *ptr;
while(len) while (len) {
{
v <<= 8; v <<= 8;
while(not_useful(p,map)) while (not_useful(p, map))
p++; p++;
v |= *p++; v |= *p++;
len--; len--;
...@@ -99,31 +99,28 @@ static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map) ...@@ -99,31 +99,28 @@ static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map)
static void nubus_rewind(unsigned char **ptr, int len, int map) static void nubus_rewind(unsigned char **ptr, int len, int map)
{ {
unsigned char *p=*ptr; unsigned char *p = *ptr;
/* Sanity check */ /* Sanity check */
if(len > 65536) if (len > 65536)
pr_err("rewind of 0x%08x!\n", len); pr_err("rewind of 0x%08x!\n", len);
while(len) while (len) {
{ do {
do
{
p--; p--;
} } while (not_useful(p, map));
while(not_useful(p, map));
len--; len--;
} }
*ptr=p; *ptr = p;
} }
static void nubus_advance(unsigned char **ptr, int len, int map) static void nubus_advance(unsigned char **ptr, int len, int map)
{ {
unsigned char *p = *ptr; unsigned char *p = *ptr;
if(len>65536)
if (len > 65536)
pr_err("advance of 0x%08x!\n", len); pr_err("advance of 0x%08x!\n", len);
while(len) while (len) {
{ while (not_useful(p, map))
while(not_useful(p,map))
p++; p++;
p++; p++;
len--; len--;
...@@ -133,9 +130,9 @@ static void nubus_advance(unsigned char **ptr, int len, int map) ...@@ -133,9 +130,9 @@ static void nubus_advance(unsigned char **ptr, int len, int map)
static void nubus_move(unsigned char **ptr, int len, int map) static void nubus_move(unsigned char **ptr, int len, int map)
{ {
if(len > 0) if (len > 0)
nubus_advance(ptr, len, map); nubus_advance(ptr, len, map);
else if(len < 0) else if (len < 0)
nubus_rewind(ptr, -len, map); nubus_rewind(ptr, -len, map);
} }
...@@ -148,23 +145,24 @@ static void nubus_move(unsigned char **ptr, int len, int map) ...@@ -148,23 +145,24 @@ static void nubus_move(unsigned char **ptr, int len, int map)
static inline long nubus_expand32(long foo) static inline long nubus_expand32(long foo)
{ {
if(foo & 0x00800000) /* 24bit negative */ if (foo & 0x00800000) /* 24bit negative */
foo |= 0xFF000000; foo |= 0xFF000000;
return foo; return foo;
} }
static inline void *nubus_rom_addr(int slot) static inline void *nubus_rom_addr(int slot)
{ {
/* /*
* Returns the first byte after the card. We then walk * Returns the first byte after the card. We then walk
* backwards to get the lane register and the config * backwards to get the lane register and the config
*/ */
return (void *)(0xF1000000+(slot<<24)); return (void *)(0xF1000000 + (slot << 24));
} }
static unsigned char *nubus_dirptr(const struct nubus_dirent *nd) static unsigned char *nubus_dirptr(const struct nubus_dirent *nd)
{ {
unsigned char *p = nd->base; unsigned char *p = nd->base;
/* Essentially, just step over the bytelanes using whatever /* Essentially, just step over the bytelanes using whatever
offset we might have found */ offset we might have found */
nubus_move(&p, nubus_expand32(nd->data), nd->mask); nubus_move(&p, nubus_expand32(nd->data), nd->mask);
...@@ -175,36 +173,36 @@ static unsigned char *nubus_dirptr(const struct nubus_dirent *nd) ...@@ -175,36 +173,36 @@ static unsigned char *nubus_dirptr(const struct nubus_dirent *nd)
/* These two are for pulling resource data blocks (i.e. stuff that's /* These two are for pulling resource data blocks (i.e. stuff that's
pointed to with offsets) out of the card ROM. */ pointed to with offsets) out of the card ROM. */
void nubus_get_rsrc_mem(void *dest, const struct nubus_dirent* dirent, void nubus_get_rsrc_mem(void *dest, const struct nubus_dirent *dirent,
int len) int len)
{ {
unsigned char *t = (unsigned char *)dest; unsigned char *t = (unsigned char *)dest;
unsigned char *p = nubus_dirptr(dirent); unsigned char *p = nubus_dirptr(dirent);
while(len)
{ while (len) {
*t++ = nubus_get_rom(&p, 1, dirent->mask); *t++ = nubus_get_rom(&p, 1, dirent->mask);
len--; len--;
} }
} }
EXPORT_SYMBOL(nubus_get_rsrc_mem); EXPORT_SYMBOL(nubus_get_rsrc_mem);
void nubus_get_rsrc_str(void *dest, const struct nubus_dirent* dirent, void nubus_get_rsrc_str(void *dest, const struct nubus_dirent *dirent,
int len) int len)
{ {
unsigned char *t=(unsigned char *)dest; unsigned char *t = (unsigned char *)dest;
unsigned char *p = nubus_dirptr(dirent); unsigned char *p = nubus_dirptr(dirent);
while(len)
{ while (len) {
*t = nubus_get_rom(&p, 1, dirent->mask); *t = nubus_get_rom(&p, 1, dirent->mask);
if(!*t++) if (!*t++)
break; break;
len--; len--;
} }
} }
EXPORT_SYMBOL(nubus_get_rsrc_str); EXPORT_SYMBOL(nubus_get_rsrc_str);
int nubus_get_root_dir(const struct nubus_board* board, int nubus_get_root_dir(const struct nubus_board *board,
struct nubus_dir* dir) struct nubus_dir *dir)
{ {
dir->ptr = dir->base = board->directory; dir->ptr = dir->base = board->directory;
dir->done = 0; dir->done = 0;
...@@ -214,8 +212,8 @@ int nubus_get_root_dir(const struct nubus_board* board, ...@@ -214,8 +212,8 @@ int nubus_get_root_dir(const struct nubus_board* board,
EXPORT_SYMBOL(nubus_get_root_dir); EXPORT_SYMBOL(nubus_get_root_dir);
/* This is a slyly renamed version of the above */ /* This is a slyly renamed version of the above */
int nubus_get_func_dir(const struct nubus_dev* dev, int nubus_get_func_dir(const struct nubus_dev *dev,
struct nubus_dir* dir) struct nubus_dir *dir)
{ {
dir->ptr = dir->base = dev->directory; dir->ptr = dir->base = dev->directory;
dir->done = 0; dir->done = 0;
...@@ -224,11 +222,11 @@ int nubus_get_func_dir(const struct nubus_dev* dev, ...@@ -224,11 +222,11 @@ int nubus_get_func_dir(const struct nubus_dev* dev,
} }
EXPORT_SYMBOL(nubus_get_func_dir); EXPORT_SYMBOL(nubus_get_func_dir);
int nubus_get_board_dir(const struct nubus_board* board, int nubus_get_board_dir(const struct nubus_board *board,
struct nubus_dir* dir) struct nubus_dir *dir)
{ {
struct nubus_dirent ent; struct nubus_dirent ent;
dir->ptr = dir->base = board->directory; dir->ptr = dir->base = board->directory;
dir->done = 0; dir->done = 0;
dir->mask = board->lanes; dir->mask = board->lanes;
...@@ -256,6 +254,7 @@ EXPORT_SYMBOL(nubus_get_subdir); ...@@ -256,6 +254,7 @@ EXPORT_SYMBOL(nubus_get_subdir);
int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent) int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent)
{ {
u32 resid; u32 resid;
if (nd->done) if (nd->done)
return -1; return -1;
...@@ -266,27 +265,25 @@ int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent) ...@@ -266,27 +265,25 @@ int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent)
resid = nubus_get_rom(&nd->ptr, 4, nd->mask); resid = nubus_get_rom(&nd->ptr, 4, nd->mask);
/* EOL marker, as per the Apple docs */ /* EOL marker, as per the Apple docs */
if((resid&0xff000000) == 0xff000000) if ((resid & 0xff000000) == 0xff000000) {
{
/* Mark it as done */ /* Mark it as done */
nd->done = 1; nd->done = 1;
return -1; return -1;
} }
/* First byte is the resource ID */ /* First byte is the resource ID */
ent->type = resid >> 24; ent->type = resid >> 24;
/* Low 3 bytes might contain data (or might not) */ /* Low 3 bytes might contain data (or might not) */
ent->data = resid & 0xffffff; ent->data = resid & 0xffffff;
ent->mask = nd->mask; ent->mask = nd->mask;
return 0; return 0;
} }
EXPORT_SYMBOL(nubus_readdir); EXPORT_SYMBOL(nubus_readdir);
int nubus_rewinddir(struct nubus_dir* dir) int nubus_rewinddir(struct nubus_dir *dir)
{ {
dir->ptr = dir->base; dir->ptr = dir->base;
dir->done = 0; dir->done = 0;
return 0; return 0;
} }
EXPORT_SYMBOL(nubus_rewinddir); EXPORT_SYMBOL(nubus_rewinddir);
...@@ -294,20 +291,15 @@ EXPORT_SYMBOL(nubus_rewinddir); ...@@ -294,20 +291,15 @@ EXPORT_SYMBOL(nubus_rewinddir);
/* Driver interface functions, more or less like in pci.c */ /* Driver interface functions, more or less like in pci.c */
struct nubus_dev* struct nubus_dev*
nubus_find_device(unsigned short category, nubus_find_device(unsigned short category, unsigned short type,
unsigned short type, unsigned short dr_hw, unsigned short dr_sw,
unsigned short dr_hw, const struct nubus_dev *from)
unsigned short dr_sw,
const struct nubus_dev* from)
{ {
struct nubus_dev* itor = struct nubus_dev *itor = from ? from->next : nubus_devices;
from ? from->next : nubus_devices;
while (itor) { while (itor) {
if (itor->category == category if (itor->category == category && itor->type == type &&
&& itor->type == type itor->dr_hw == dr_hw && itor->dr_sw == dr_sw)
&& itor->dr_hw == dr_hw
&& itor->dr_sw == dr_sw)
return itor; return itor;
itor = itor->next; itor = itor->next;
} }
...@@ -316,16 +308,13 @@ nubus_find_device(unsigned short category, ...@@ -316,16 +308,13 @@ nubus_find_device(unsigned short category,
EXPORT_SYMBOL(nubus_find_device); EXPORT_SYMBOL(nubus_find_device);
struct nubus_dev* struct nubus_dev*
nubus_find_type(unsigned short category, nubus_find_type(unsigned short category, unsigned short type,
unsigned short type, const struct nubus_dev *from)
const struct nubus_dev* from)
{ {
struct nubus_dev* itor = struct nubus_dev *itor = from ? from->next : nubus_devices;
from ? from->next : nubus_devices;
while (itor) { while (itor) {
if (itor->category == category if (itor->category == category && itor->type == type)
&& itor->type == type)
return itor; return itor;
itor = itor->next; itor = itor->next;
} }
...@@ -334,12 +323,10 @@ nubus_find_type(unsigned short category, ...@@ -334,12 +323,10 @@ nubus_find_type(unsigned short category,
EXPORT_SYMBOL(nubus_find_type); EXPORT_SYMBOL(nubus_find_type);
struct nubus_dev* struct nubus_dev*
nubus_find_slot(unsigned int slot, nubus_find_slot(unsigned int slot, const struct nubus_dev *from)
const struct nubus_dev* from)
{ {
struct nubus_dev* itor = struct nubus_dev *itor = from ? from->next : nubus_devices;
from ? from->next : nubus_devices;
while (itor) { while (itor) {
if (itor->board->slot == slot) if (itor->board->slot == slot)
return itor; return itor;
...@@ -350,13 +337,13 @@ nubus_find_slot(unsigned int slot, ...@@ -350,13 +337,13 @@ nubus_find_slot(unsigned int slot,
EXPORT_SYMBOL(nubus_find_slot); EXPORT_SYMBOL(nubus_find_slot);
int int
nubus_find_rsrc(struct nubus_dir* dir, unsigned char rsrc_type, nubus_find_rsrc(struct nubus_dir *dir, unsigned char rsrc_type,
struct nubus_dirent* ent) struct nubus_dirent *ent)
{ {
while (nubus_readdir(dir, ent) != -1) { while (nubus_readdir(dir, ent) != -1) {
if (ent->type == rsrc_type) if (ent->type == rsrc_type)
return 0; return 0;
} }
return -1; return -1;
} }
EXPORT_SYMBOL(nubus_find_rsrc); EXPORT_SYMBOL(nubus_find_rsrc);
...@@ -370,8 +357,8 @@ EXPORT_SYMBOL(nubus_find_rsrc); ...@@ -370,8 +357,8 @@ EXPORT_SYMBOL(nubus_find_rsrc);
among other things. The rest of it should go in the /proc code. among other things. The rest of it should go in the /proc code.
For now, we just use it to give verbose boot logs. */ For now, we just use it to give verbose boot logs. */
static int __init nubus_show_display_resource(struct nubus_dev* dev, static int __init nubus_show_display_resource(struct nubus_dev *dev,
const struct nubus_dirent* ent) const struct nubus_dirent *ent)
{ {
switch (ent->type) { switch (ent->type) {
case NUBUS_RESID_GAMMADIR: case NUBUS_RESID_GAMMADIR:
...@@ -388,14 +375,14 @@ static int __init nubus_show_display_resource(struct nubus_dev* dev, ...@@ -388,14 +375,14 @@ static int __init nubus_show_display_resource(struct nubus_dev* dev,
return 0; return 0;
} }
static int __init nubus_show_network_resource(struct nubus_dev* dev, static int __init nubus_show_network_resource(struct nubus_dev *dev,
const struct nubus_dirent* ent) const struct nubus_dirent *ent)
{ {
switch (ent->type) { switch (ent->type) {
case NUBUS_RESID_MAC_ADDRESS: case NUBUS_RESID_MAC_ADDRESS:
{ {
char addr[6]; char addr[6];
nubus_get_rsrc_mem(addr, ent, 6); nubus_get_rsrc_mem(addr, ent, 6);
pr_info(" MAC address: %pM\n", addr); pr_info(" MAC address: %pM\n", addr);
break; break;
...@@ -407,13 +394,14 @@ static int __init nubus_show_network_resource(struct nubus_dev* dev, ...@@ -407,13 +394,14 @@ static int __init nubus_show_network_resource(struct nubus_dev* dev,
return 0; return 0;
} }
static int __init nubus_show_cpu_resource(struct nubus_dev* dev, static int __init nubus_show_cpu_resource(struct nubus_dev *dev,
const struct nubus_dirent* ent) const struct nubus_dirent *ent)
{ {
switch (ent->type) { switch (ent->type) {
case NUBUS_RESID_MEMINFO: case NUBUS_RESID_MEMINFO:
{ {
unsigned long meminfo[2]; unsigned long meminfo[2];
nubus_get_rsrc_mem(&meminfo, ent, 8); nubus_get_rsrc_mem(&meminfo, ent, 8);
pr_info(" memory: [ 0x%08lx 0x%08lx ]\n", pr_info(" memory: [ 0x%08lx 0x%08lx ]\n",
meminfo[0], meminfo[1]); meminfo[0], meminfo[1]);
...@@ -422,6 +410,7 @@ static int __init nubus_show_cpu_resource(struct nubus_dev* dev, ...@@ -422,6 +410,7 @@ static int __init nubus_show_cpu_resource(struct nubus_dev* dev,
case NUBUS_RESID_ROMINFO: case NUBUS_RESID_ROMINFO:
{ {
unsigned long rominfo[2]; unsigned long rominfo[2];
nubus_get_rsrc_mem(&rominfo, ent, 8); nubus_get_rsrc_mem(&rominfo, ent, 8);
pr_info(" ROM: [ 0x%08lx 0x%08lx ]\n", pr_info(" ROM: [ 0x%08lx 0x%08lx ]\n",
rominfo[0], rominfo[1]); rominfo[0], rominfo[1]);
...@@ -434,8 +423,8 @@ static int __init nubus_show_cpu_resource(struct nubus_dev* dev, ...@@ -434,8 +423,8 @@ static int __init nubus_show_cpu_resource(struct nubus_dev* dev,
return 0; return 0;
} }
static int __init nubus_show_private_resource(struct nubus_dev* dev, static int __init nubus_show_private_resource(struct nubus_dev *dev,
const struct nubus_dirent* ent) const struct nubus_dirent *ent)
{ {
switch (dev->category) { switch (dev->category) {
case NUBUS_CAT_DISPLAY: case NUBUS_CAT_DISPLAY:
...@@ -454,39 +443,37 @@ static int __init nubus_show_private_resource(struct nubus_dev* dev, ...@@ -454,39 +443,37 @@ static int __init nubus_show_private_resource(struct nubus_dev* dev,
return 0; return 0;
} }
static struct nubus_dev* __init static struct nubus_dev * __init
nubus_get_functional_resource(struct nubus_board* board, nubus_get_functional_resource(struct nubus_board *board, int slot,
int slot, const struct nubus_dirent *parent)
const struct nubus_dirent* parent)
{ {
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
struct nubus_dev* dev; struct nubus_dev *dev;
pr_info(" Function 0x%02x:\n", parent->type); pr_info(" Function 0x%02x:\n", parent->type);
nubus_get_subdir(parent, &dir); nubus_get_subdir(parent, &dir);
/* Apple seems to have botched the ROM on the IIx */ /* Apple seems to have botched the ROM on the IIx */
if (slot == 0 && (unsigned long)dir.base % 2) if (slot == 0 && (unsigned long)dir.base % 2)
dir.base += 1; dir.base += 1;
pr_debug("%s: parent is 0x%p, dir is 0x%p\n", pr_debug("%s: parent is 0x%p, dir is 0x%p\n",
__func__, parent->base, dir.base); __func__, parent->base, dir.base);
/* Actually we should probably panic if this fails */ /* Actually we should probably panic if this fails */
if ((dev = kzalloc(sizeof(*dev), GFP_ATOMIC)) == NULL) if ((dev = kzalloc(sizeof(*dev), GFP_ATOMIC)) == NULL)
return NULL; return NULL;
dev->resid = parent->type; dev->resid = parent->type;
dev->directory = dir.base; dev->directory = dir.base;
dev->board = board; dev->board = board;
while (nubus_readdir(&dir, &ent) != -1) while (nubus_readdir(&dir, &ent) != -1) {
{ switch (ent.type) {
switch(ent.type)
{
case NUBUS_RESID_TYPE: case NUBUS_RESID_TYPE:
{ {
unsigned short nbtdata[4]; unsigned short nbtdata[4];
nubus_get_rsrc_mem(nbtdata, &ent, 8); nubus_get_rsrc_mem(nbtdata, &ent, 8);
dev->category = nbtdata[0]; dev->category = nbtdata[0];
dev->type = nbtdata[1]; dev->type = nbtdata[1];
...@@ -508,6 +495,7 @@ static struct nubus_dev* __init ...@@ -508,6 +495,7 @@ static struct nubus_dev* __init
use this :-) */ use this :-) */
struct nubus_dir drvr_dir; struct nubus_dir drvr_dir;
struct nubus_dirent drvr_ent; struct nubus_dirent drvr_ent;
nubus_get_subdir(&ent, &drvr_dir); nubus_get_subdir(&ent, &drvr_dir);
nubus_readdir(&drvr_dir, &drvr_ent); nubus_readdir(&drvr_dir, &drvr_ent);
dev->driver = nubus_dirptr(&drvr_ent); dev->driver = nubus_dirptr(&drvr_ent);
...@@ -525,7 +513,7 @@ static struct nubus_dev* __init ...@@ -525,7 +513,7 @@ static struct nubus_dev* __init
/* Ditto */ /* Ditto */
nubus_get_rsrc_mem(&dev->iosize, &ent, 4); nubus_get_rsrc_mem(&dev->iosize, &ent, 4);
pr_info(" memory length: 0x%08lx\n", dev->iosize); pr_info(" memory length: 0x%08lx\n", dev->iosize);
break; break;
case NUBUS_RESID_FLAGS: case NUBUS_RESID_FLAGS:
dev->flags = ent.data; dev->flags = ent.data;
pr_info(" flags: 0x%06x\n", dev->flags); pr_info(" flags: 0x%06x\n", dev->flags);
...@@ -540,16 +528,17 @@ static struct nubus_dev* __init ...@@ -540,16 +528,17 @@ static struct nubus_dev* __init
nubus_show_private_resource(dev, &ent); nubus_show_private_resource(dev, &ent);
} }
} }
return dev; return dev;
} }
/* This is cool. */ /* This is cool. */
static int __init nubus_get_vidnames(struct nubus_board* board, static int __init nubus_get_vidnames(struct nubus_board *board,
const struct nubus_dirent* parent) const struct nubus_dirent *parent)
{ {
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
/* FIXME: obviously we want to put this in a header file soon */ /* FIXME: obviously we want to put this in a header file soon */
struct vidmode { struct vidmode {
u32 size; u32 size;
...@@ -564,14 +553,13 @@ static int __init nubus_get_vidnames(struct nubus_board* board, ...@@ -564,14 +553,13 @@ static int __init nubus_get_vidnames(struct nubus_board* board,
pr_debug("%s: parent is 0x%p, dir is 0x%p\n", pr_debug("%s: parent is 0x%p, dir is 0x%p\n",
__func__, parent->base, dir.base); __func__, parent->base, dir.base);
while(nubus_readdir(&dir, &ent) != -1) while (nubus_readdir(&dir, &ent) != -1) {
{
struct vidmode mode; struct vidmode mode;
u32 size; u32 size;
/* First get the length */ /* First get the length */
nubus_get_rsrc_mem(&size, &ent, 4); nubus_get_rsrc_mem(&size, &ent, 4);
/* Now clobber the whole thing */ /* Now clobber the whole thing */
if (size > sizeof(mode) - 1) if (size > sizeof(mode) - 1)
size = sizeof(mode) - 1; size = sizeof(mode) - 1;
...@@ -584,13 +572,13 @@ static int __init nubus_get_vidnames(struct nubus_board* board, ...@@ -584,13 +572,13 @@ static int __init nubus_get_vidnames(struct nubus_board* board,
} }
/* This is *really* cool. */ /* This is *really* cool. */
static int __init nubus_get_icon(struct nubus_board* board, static int __init nubus_get_icon(struct nubus_board *board,
const struct nubus_dirent* ent) const struct nubus_dirent *ent)
{ {
/* Should be 32x32 if my memory serves me correctly */ /* Should be 32x32 if my memory serves me correctly */
unsigned char icon[128]; unsigned char icon[128];
int x, y; int x, y;
nubus_get_rsrc_mem(&icon, ent, 128); nubus_get_rsrc_mem(&icon, ent, 128);
pr_info(" icon:\n"); pr_info(" icon:\n");
...@@ -600,8 +588,7 @@ static int __init nubus_get_icon(struct nubus_board* board, ...@@ -600,8 +588,7 @@ static int __init nubus_get_icon(struct nubus_board* board,
for (y = 0; y < 32; y++) { for (y = 0; y < 32; y++) {
pr_info(" "); pr_info(" ");
for (x = 0; x < 32; x++) { for (x = 0; x < 32; x++) {
if (icon[y*4 + x/8] if (icon[y * 4 + x / 8] & (0x80 >> (x % 8)))
& (0x80 >> (x%8)))
pr_cont("*"); pr_cont("*");
else else
pr_cont(" "); pr_cont(" ");
...@@ -611,23 +598,22 @@ static int __init nubus_get_icon(struct nubus_board* board, ...@@ -611,23 +598,22 @@ static int __init nubus_get_icon(struct nubus_board* board,
return 0; return 0;
} }
static int __init nubus_get_vendorinfo(struct nubus_board* board, static int __init nubus_get_vendorinfo(struct nubus_board *board,
const struct nubus_dirent* parent) const struct nubus_dirent *parent)
{ {
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
static char* vendor_fields[6] = {"ID", "serial", "revision", static char *vendor_fields[6] = { "ID", "serial", "revision",
"part", "date", "unknown field"}; "part", "date", "unknown field" };
pr_info(" vendor info:\n"); pr_info(" vendor info:\n");
nubus_get_subdir(parent, &dir); nubus_get_subdir(parent, &dir);
pr_debug("%s: parent is 0x%p, dir is 0x%p\n", pr_debug("%s: parent is 0x%p, dir is 0x%p\n",
__func__, parent->base, dir.base); __func__, parent->base, dir.base);
while(nubus_readdir(&dir, &ent) != -1) while (nubus_readdir(&dir, &ent) != -1) {
{
char name[64]; char name[64];
/* These are all strings, we think */ /* These are all strings, we think */
nubus_get_rsrc_str(name, &ent, 64); nubus_get_rsrc_str(name, &ent, 64);
if (ent.type > 5) if (ent.type > 5)
...@@ -637,18 +623,17 @@ static int __init nubus_get_vendorinfo(struct nubus_board* board, ...@@ -637,18 +623,17 @@ static int __init nubus_get_vendorinfo(struct nubus_board* board,
return 0; return 0;
} }
static int __init nubus_get_board_resource(struct nubus_board* board, int slot, static int __init nubus_get_board_resource(struct nubus_board *board, int slot,
const struct nubus_dirent* parent) const struct nubus_dirent *parent)
{ {
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
nubus_get_subdir(parent, &dir); nubus_get_subdir(parent, &dir);
pr_debug("%s: parent is 0x%p, dir is 0x%p\n", pr_debug("%s: parent is 0x%p, dir is 0x%p\n",
__func__, parent->base, dir.base); __func__, parent->base, dir.base);
while(nubus_readdir(&dir, &ent) != -1) while (nubus_readdir(&dir, &ent) != -1) {
{
switch (ent.type) { switch (ent.type) {
case NUBUS_RESID_TYPE: case NUBUS_RESID_TYPE:
{ {
...@@ -689,7 +674,7 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot, ...@@ -689,7 +674,7 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot,
case NUBUS_RESID_SECONDINIT: case NUBUS_RESID_SECONDINIT:
pr_info(" secondary init offset: 0x%06x\n", ent.data); pr_info(" secondary init offset: 0x%06x\n", ent.data);
break; break;
/* WTF isn't this in the functional resources? */ /* WTF isn't this in the functional resources? */
case NUBUS_RESID_VIDNAMES: case NUBUS_RESID_VIDNAMES:
nubus_get_vidnames(board, &ent); nubus_get_vidnames(board, &ent);
break; break;
...@@ -697,7 +682,7 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot, ...@@ -697,7 +682,7 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot,
case NUBUS_RESID_VIDMODES: case NUBUS_RESID_VIDMODES:
pr_info(" video mode parameter directory offset: 0x%06x\n", pr_info(" video mode parameter directory offset: 0x%06x\n",
ent.data); ent.data);
break; break;
default: default:
pr_info(" unknown resource %02X, data 0x%06x\n", pr_info(" unknown resource %02X, data 0x%06x\n",
ent.type, ent.data); ent.type, ent.data);
...@@ -710,8 +695,8 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot, ...@@ -710,8 +695,8 @@ static int __init nubus_get_board_resource(struct nubus_board* board, int slot,
sResources in the motherboard ROM */ sResources in the motherboard ROM */
static void __init nubus_find_rom_dir(struct nubus_board* board) static void __init nubus_find_rom_dir(struct nubus_board* board)
{ {
unsigned char* rp; unsigned char *rp;
unsigned char* romdir; unsigned char *romdir;
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
...@@ -744,14 +729,14 @@ static void __init nubus_find_rom_dir(struct nubus_board* board) ...@@ -744,14 +729,14 @@ static void __init nubus_find_rom_dir(struct nubus_board* board)
if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG) if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG)
printk(KERN_INFO "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data); printk(KERN_INFO "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data);
/* This one takes us to where we want to go. */ /* This one takes us to where we want to go. */
if (nubus_readdir(&dir, &ent) == -1) if (nubus_readdir(&dir, &ent) == -1)
goto badrom; goto badrom;
if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG) if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG)
printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data); printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data);
nubus_get_subdir(&ent, &dir); nubus_get_subdir(&ent, &dir);
/* Resource ID 01, also an "Unknown Macintosh" */ /* Resource ID 01, also an "Unknown Macintosh" */
if (nubus_readdir(&dir, &ent) == -1) if (nubus_readdir(&dir, &ent) == -1)
goto badrom; goto badrom;
if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG) if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG)
printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data); printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data);
...@@ -770,12 +755,12 @@ static void __init nubus_find_rom_dir(struct nubus_board* board) ...@@ -770,12 +755,12 @@ static void __init nubus_find_rom_dir(struct nubus_board* board)
goto badrom; goto badrom;
if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG) if (console_loglevel >= CONSOLE_LOGLEVEL_DEBUG)
printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data); printk(KERN_DEBUG "nubus_get_rom_dir: entry %02x %06x\n", ent.type, ent.data);
/* Bwahahahaha... */ /* Bwahahahaha... */
nubus_get_subdir(&ent, &dir); nubus_get_subdir(&ent, &dir);
board->directory = dir.base; board->directory = dir.base;
return; return;
/* Even more evil laughter... */ /* Even more evil laughter... */
badrom: badrom:
board->directory = board->fblock; board->directory = board->fblock;
...@@ -784,23 +769,22 @@ static void __init nubus_find_rom_dir(struct nubus_board* board) ...@@ -784,23 +769,22 @@ static void __init nubus_find_rom_dir(struct nubus_board* board)
} }
/* Add a board (might be many devices) to the list */ /* Add a board (might be many devices) to the list */
static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) static struct nubus_board * __init nubus_add_board(int slot, int bytelanes)
{ {
struct nubus_board* board; struct nubus_board *board;
struct nubus_board** boardp; struct nubus_board **boardp;
unsigned char *rp; unsigned char *rp;
unsigned long dpat; unsigned long dpat;
struct nubus_dir dir; struct nubus_dir dir;
struct nubus_dirent ent; struct nubus_dirent ent;
/* Move to the start of the format block */ /* Move to the start of the format block */
rp = nubus_rom_addr(slot); rp = nubus_rom_addr(slot);
nubus_rewind(&rp, FORMAT_BLOCK_SIZE, bytelanes); nubus_rewind(&rp, FORMAT_BLOCK_SIZE, bytelanes);
/* Actually we should probably panic if this fails */ /* Actually we should probably panic if this fails */
if ((board = kzalloc(sizeof(*board), GFP_ATOMIC)) == NULL) if ((board = kzalloc(sizeof(*board), GFP_ATOMIC)) == NULL)
return NULL; return NULL;
board->fblock = rp; board->fblock = rp;
/* Dump the format block for debugging purposes */ /* Dump the format block for debugging purposes */
...@@ -816,7 +800,7 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) ...@@ -816,7 +800,7 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes)
rp = board->fblock; rp = board->fblock;
board->slot = slot; board->slot = slot;
board->slot_addr = (unsigned long) nubus_slot_addr(slot); board->slot_addr = (unsigned long)nubus_slot_addr(slot);
board->doffset = nubus_get_rom(&rp, 4, bytelanes); board->doffset = nubus_get_rom(&rp, 4, bytelanes);
/* rom_length is *supposed* to be the total length of the /* rom_length is *supposed* to be the total length of the
* ROM. In practice it is the "amount of ROM used to compute * ROM. In practice it is the "amount of ROM used to compute
...@@ -827,16 +811,16 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) ...@@ -827,16 +811,16 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes)
board->rom_length = nubus_get_rom(&rp, 4, bytelanes); board->rom_length = nubus_get_rom(&rp, 4, bytelanes);
board->crc = nubus_get_rom(&rp, 4, bytelanes); board->crc = nubus_get_rom(&rp, 4, bytelanes);
board->rev = nubus_get_rom(&rp, 1, bytelanes); board->rev = nubus_get_rom(&rp, 1, bytelanes);
board->format = nubus_get_rom(&rp,1, bytelanes); board->format = nubus_get_rom(&rp, 1, bytelanes);
board->lanes = bytelanes; board->lanes = bytelanes;
/* Directory offset should be small and negative... */ /* Directory offset should be small and negative... */
if(!(board->doffset & 0x00FF0000)) if (!(board->doffset & 0x00FF0000))
pr_warn("Dodgy doffset!\n"); pr_warn("Dodgy doffset!\n");
dpat = nubus_get_rom(&rp, 4, bytelanes); dpat = nubus_get_rom(&rp, 4, bytelanes);
if(dpat != NUBUS_TEST_PATTERN) if (dpat != NUBUS_TEST_PATTERN)
pr_warn("Wrong test pattern %08lx!\n", dpat); pr_warn("Wrong test pattern %08lx!\n", dpat);
/* /*
* I wonder how the CRC is meant to work - * I wonder how the CRC is meant to work -
* any takers ? * any takers ?
...@@ -846,7 +830,7 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) ...@@ -846,7 +830,7 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes)
/* Attempt to work around slot zero weirdness */ /* Attempt to work around slot zero weirdness */
nubus_find_rom_dir(board); nubus_find_rom_dir(board);
nubus_get_root_dir(board, &dir); nubus_get_root_dir(board, &dir);
/* We're ready to rock */ /* We're ready to rock */
pr_info("Slot %X:\n", slot); pr_info("Slot %X:\n", slot);
...@@ -869,8 +853,9 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) ...@@ -869,8 +853,9 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes)
resources. I have no idea WTF to do about this. */ resources. I have no idea WTF to do about this. */
while (nubus_readdir(&dir, &ent) != -1) { while (nubus_readdir(&dir, &ent) != -1) {
struct nubus_dev* dev; struct nubus_dev *dev;
struct nubus_dev** devp; struct nubus_dev **devp;
dev = nubus_get_functional_resource(board, slot, &ent); dev = nubus_get_functional_resource(board, slot, &ent);
if (dev == NULL) if (dev == NULL)
continue; continue;
...@@ -878,32 +863,33 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes) ...@@ -878,32 +863,33 @@ static struct nubus_board* __init nubus_add_board(int slot, int bytelanes)
/* We zeroed this out above */ /* We zeroed this out above */
if (board->first_dev == NULL) if (board->first_dev == NULL)
board->first_dev = dev; board->first_dev = dev;
/* Put it on the global NuBus device chain. Keep entries in order. */ /* Put it on the global NuBus device chain. Keep entries in order. */
for (devp=&nubus_devices; *devp!=NULL; devp=&((*devp)->next)) for (devp = &nubus_devices; *devp != NULL;
devp = &((*devp)->next))
/* spin */; /* spin */;
*devp = dev; *devp = dev;
dev->next = NULL; dev->next = NULL;
} }
/* Put it on the global NuBus board chain. Keep entries in order. */ /* Put it on the global NuBus board chain. Keep entries in order. */
for (boardp=&nubus_boards; *boardp!=NULL; boardp=&((*boardp)->next)) for (boardp = &nubus_boards; *boardp != NULL;
boardp = &((*boardp)->next))
/* spin */; /* spin */;
*boardp = board; *boardp = board;
board->next = NULL; board->next = NULL;
return board; return board;
} }
void __init nubus_probe_slot(int slot) void __init nubus_probe_slot(int slot)
{ {
unsigned char dp; unsigned char dp;
unsigned char* rp; unsigned char *rp;
int i; int i;
rp = nubus_rom_addr(slot); rp = nubus_rom_addr(slot);
for(i = 4; i; i--) for (i = 4; i; i--) {
{
int card_present; int card_present;
rp--; rp--;
...@@ -918,11 +904,11 @@ void __init nubus_probe_slot(int slot) ...@@ -918,11 +904,11 @@ void __init nubus_probe_slot(int slot)
/* The last byte of the format block consists of two /* The last byte of the format block consists of two
nybbles which are "mirror images" of each other. nybbles which are "mirror images" of each other.
These show us the valid bytelanes */ These show us the valid bytelanes */
if ((((dp>>4) ^ dp) & 0x0F) != 0x0F) if ((((dp >> 4) ^ dp) & 0x0F) != 0x0F)
continue; continue;
/* Check that this value is actually *on* one of the /* Check that this value is actually *on* one of the
bytelanes it claims are valid! */ bytelanes it claims are valid! */
if ((dp & 0x0F) >= (1<<i)) if ((dp & 0x0F) >= (1 << i))
continue; continue;
/* Looks promising. Let's put it on the list. */ /* Looks promising. Let's put it on the list. */
...@@ -935,19 +921,19 @@ void __init nubus_probe_slot(int slot) ...@@ -935,19 +921,19 @@ void __init nubus_probe_slot(int slot)
void __init nubus_scan_bus(void) void __init nubus_scan_bus(void)
{ {
int slot; int slot;
/* This might not work on your machine */ /* This might not work on your machine */
#ifdef I_WANT_TO_PROBE_SLOT_ZERO #ifdef I_WANT_TO_PROBE_SLOT_ZERO
nubus_probe_slot(0); nubus_probe_slot(0);
#endif #endif
for(slot = 9; slot < 15; slot++) for (slot = 9; slot < 15; slot++) {
{
nubus_probe_slot(slot); nubus_probe_slot(slot);
} }
} }
static int __init nubus_init(void) static int __init nubus_init(void)
{ {
if (!MACH_IS_MAC) if (!MACH_IS_MAC)
return 0; return 0;
/* Initialize the NuBus interrupts */ /* Initialize the NuBus interrupts */
...@@ -963,11 +949,11 @@ static int __init nubus_init(void) ...@@ -963,11 +949,11 @@ static int __init nubus_init(void)
gurus can fix the real cause of the problem. */ gurus can fix the real cause of the problem. */
mdelay(1000); mdelay(1000);
#endif #endif
/* And probe */ /* And probe */
pr_info("NuBus: Scanning NuBus slots.\n"); pr_info("NuBus: Scanning NuBus slots.\n");
nubus_devices = NULL; nubus_devices = NULL;
nubus_boards = NULL; nubus_boards = NULL;
nubus_scan_bus(); nubus_scan_bus();
nubus_proc_init(); nubus_proc_init();
return 0; return 0;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7