Greg Kroah-Hartman | b244131 | 2017-11-01 15:07:57 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* |
| 3 | * Macintosh Nubus Interface Code |
| 4 | * |
| 5 | * Originally by Alan Cox |
| 6 | * |
| 7 | * Mostly rewritten by David Huggins-Daines, C. Scott Ananian, |
| 8 | * and others. |
| 9 | */ |
| 10 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 11 | #include <linux/types.h> |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/string.h> |
| 14 | #include <linux/nubus.h> |
| 15 | #include <linux/errno.h> |
| 16 | #include <linux/init.h> |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 17 | #include <linux/module.h> |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 18 | #include <linux/seq_file.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 19 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <asm/setup.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <asm/page.h> |
| 22 | #include <asm/hwtest.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | |
| 24 | /* Constants */ |
| 25 | |
| 26 | /* This is, of course, the size in bytelanes, rather than the size in |
| 27 | actual bytes */ |
| 28 | #define FORMAT_BLOCK_SIZE 20 |
| 29 | #define ROM_DIR_OFFSET 0x24 |
| 30 | |
| 31 | #define NUBUS_TEST_PATTERN 0x5A932BC7 |
| 32 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | /* Globals */ |
| 34 | |
Finn Thain | 72b44f6 | 2023-05-16 11:22:05 +1000 | [diff] [blame] | 35 | /* The "nubus.populate_procfs" parameter makes slot resources available in |
| 36 | * procfs. It's deprecated and disabled by default because procfs is no longer |
| 37 | * thought to be suitable for that and some board ROMs make it too expensive. |
| 38 | */ |
| 39 | bool nubus_populate_procfs; |
| 40 | module_param_named(populate_procfs, nubus_populate_procfs, bool, 0); |
| 41 | |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 42 | LIST_HEAD(nubus_func_rsrcs); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | |
| 44 | /* Meaning of "bytelanes": |
| 45 | |
| 46 | The card ROM may appear on any or all bytes of each long word in |
| 47 | NuBus memory. The low 4 bits of the "map" value found in the |
| 48 | format block (at the top of the slot address space, as well as at |
| 49 | the top of the MacOS ROM) tells us which bytelanes, i.e. which byte |
| 50 | offsets within each longword, are valid. Thus: |
| 51 | |
| 52 | A map of 0x0f, as found in the MacOS ROM, means that all bytelanes |
| 53 | are valid. |
| 54 | |
| 55 | A map of 0xf0 means that no bytelanes are valid (We pray that we |
| 56 | will never encounter this, but stranger things have happened) |
| 57 | |
| 58 | A map of 0xe1 means that only the MSB of each long word is actually |
| 59 | part of the card ROM. (We hope to never encounter NuBus on a |
| 60 | little-endian machine. Again, stranger things have happened) |
| 61 | |
| 62 | A map of 0x78 means that only the LSB of each long word is valid. |
| 63 | |
| 64 | Etcetera, etcetera. Hopefully this clears up some confusion over |
| 65 | what the following code actually does. */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 66 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 | static inline int not_useful(void *p, int map) |
| 68 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 69 | unsigned long pv = (unsigned long)p; |
| 70 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | pv &= 3; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 72 | if (map & (1 << pv)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | return 0; |
| 74 | return 1; |
| 75 | } |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 76 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | static unsigned long nubus_get_rom(unsigned char **ptr, int len, int map) |
| 78 | { |
| 79 | /* This will hold the result */ |
| 80 | unsigned long v = 0; |
| 81 | unsigned char *p = *ptr; |
| 82 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 83 | while (len) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | v <<= 8; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 85 | while (not_useful(p, map)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | p++; |
| 87 | v |= *p++; |
| 88 | len--; |
| 89 | } |
| 90 | *ptr = p; |
| 91 | return v; |
| 92 | } |
| 93 | |
| 94 | static void nubus_rewind(unsigned char **ptr, int len, int map) |
| 95 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 96 | unsigned char *p = *ptr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 98 | while (len) { |
| 99 | do { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | p--; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 101 | } while (not_useful(p, map)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 102 | len--; |
| 103 | } |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 104 | *ptr = p; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | } |
| 106 | |
| 107 | static void nubus_advance(unsigned char **ptr, int len, int map) |
| 108 | { |
| 109 | unsigned char *p = *ptr; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 110 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 111 | while (len) { |
| 112 | while (not_useful(p, map)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | p++; |
Ilpo Järvinen | 2e0eb73 | 2008-10-15 22:01:31 -0700 | [diff] [blame] | 114 | p++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | len--; |
| 116 | } |
| 117 | *ptr = p; |
| 118 | } |
| 119 | |
| 120 | static void nubus_move(unsigned char **ptr, int len, int map) |
| 121 | { |
Finn Thain | 85cc313 | 2017-04-22 21:24:16 -0400 | [diff] [blame] | 122 | unsigned long slot_space = (unsigned long)*ptr & 0xFF000000; |
| 123 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 124 | if (len > 0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | nubus_advance(ptr, len, map); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 126 | else if (len < 0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | nubus_rewind(ptr, -len, map); |
Finn Thain | 85cc313 | 2017-04-22 21:24:16 -0400 | [diff] [blame] | 128 | |
| 129 | if (((unsigned long)*ptr & 0xFF000000) != slot_space) |
| 130 | pr_err("%s: moved out of slot address space!\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | } |
| 132 | |
| 133 | /* Now, functions to read the sResource tree */ |
| 134 | |
| 135 | /* Each sResource entry consists of a 1-byte ID and a 3-byte data |
| 136 | field. If that data field contains an offset, then obviously we |
| 137 | have to expand it from a 24-bit signed number to a 32-bit signed |
| 138 | number. */ |
| 139 | |
| 140 | static inline long nubus_expand32(long foo) |
| 141 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 142 | if (foo & 0x00800000) /* 24bit negative */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | foo |= 0xFF000000; |
| 144 | return foo; |
| 145 | } |
| 146 | |
| 147 | static inline void *nubus_rom_addr(int slot) |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 148 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | /* |
| 150 | * Returns the first byte after the card. We then walk |
| 151 | * backwards to get the lane register and the config |
| 152 | */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 153 | return (void *)(0xF1000000 + (slot << 24)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 154 | } |
| 155 | |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 156 | unsigned char *nubus_dirptr(const struct nubus_dirent *nd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | { |
| 158 | unsigned char *p = nd->base; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 159 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | /* Essentially, just step over the bytelanes using whatever |
| 161 | offset we might have found */ |
| 162 | nubus_move(&p, nubus_expand32(nd->data), nd->mask); |
| 163 | /* And return the value */ |
| 164 | return p; |
| 165 | } |
| 166 | |
| 167 | /* These two are for pulling resource data blocks (i.e. stuff that's |
| 168 | pointed to with offsets) out of the card ROM. */ |
| 169 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 170 | void nubus_get_rsrc_mem(void *dest, const struct nubus_dirent *dirent, |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 171 | unsigned int len) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | { |
Himanshu Jha | 51b67a6 | 2017-08-27 13:02:28 +0530 | [diff] [blame] | 173 | unsigned char *t = dest; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 | unsigned char *p = nubus_dirptr(dirent); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 175 | |
| 176 | while (len) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | *t++ = nubus_get_rom(&p, 1, dirent->mask); |
| 178 | len--; |
| 179 | } |
| 180 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 181 | EXPORT_SYMBOL(nubus_get_rsrc_mem); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 183 | unsigned int nubus_get_rsrc_str(char *dest, const struct nubus_dirent *dirent, |
| 184 | unsigned int len) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | { |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 186 | char *t = dest; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | unsigned char *p = nubus_dirptr(dirent); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 188 | |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 189 | while (len > 1) { |
| 190 | unsigned char c = nubus_get_rom(&p, 1, dirent->mask); |
| 191 | |
| 192 | if (!c) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | break; |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 194 | *t++ = c; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | len--; |
| 196 | } |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 197 | if (len > 0) |
| 198 | *t = '\0'; |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 199 | return t - dest; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 201 | EXPORT_SYMBOL(nubus_get_rsrc_str); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 203 | void nubus_seq_write_rsrc_mem(struct seq_file *m, |
| 204 | const struct nubus_dirent *dirent, |
| 205 | unsigned int len) |
| 206 | { |
| 207 | unsigned long buf[32]; |
| 208 | unsigned int buf_size = sizeof(buf); |
| 209 | unsigned char *p = nubus_dirptr(dirent); |
| 210 | |
| 211 | /* If possible, write out full buffers */ |
| 212 | while (len >= buf_size) { |
| 213 | unsigned int i; |
| 214 | |
| 215 | for (i = 0; i < ARRAY_SIZE(buf); i++) |
| 216 | buf[i] = nubus_get_rom(&p, sizeof(buf[0]), |
| 217 | dirent->mask); |
| 218 | seq_write(m, buf, buf_size); |
| 219 | len -= buf_size; |
| 220 | } |
| 221 | /* If not, write out individual bytes */ |
| 222 | while (len--) |
| 223 | seq_putc(m, nubus_get_rom(&p, 1, dirent->mask)); |
| 224 | } |
| 225 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 226 | int nubus_get_root_dir(const struct nubus_board *board, |
| 227 | struct nubus_dir *dir) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 228 | { |
| 229 | dir->ptr = dir->base = board->directory; |
| 230 | dir->done = 0; |
| 231 | dir->mask = board->lanes; |
| 232 | return 0; |
| 233 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 234 | EXPORT_SYMBOL(nubus_get_root_dir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | |
| 236 | /* This is a slyly renamed version of the above */ |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 237 | int nubus_get_func_dir(const struct nubus_rsrc *fres, struct nubus_dir *dir) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | { |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 239 | dir->ptr = dir->base = fres->directory; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 240 | dir->done = 0; |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 241 | dir->mask = fres->board->lanes; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 242 | return 0; |
| 243 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 244 | EXPORT_SYMBOL(nubus_get_func_dir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 245 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 246 | int nubus_get_board_dir(const struct nubus_board *board, |
| 247 | struct nubus_dir *dir) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 248 | { |
| 249 | struct nubus_dirent ent; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 250 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | dir->ptr = dir->base = board->directory; |
| 252 | dir->done = 0; |
| 253 | dir->mask = board->lanes; |
| 254 | |
| 255 | /* Now dereference it (the first directory is always the board |
| 256 | directory) */ |
| 257 | if (nubus_readdir(dir, &ent) == -1) |
| 258 | return -1; |
| 259 | if (nubus_get_subdir(&ent, dir) == -1) |
| 260 | return -1; |
| 261 | return 0; |
| 262 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 263 | EXPORT_SYMBOL(nubus_get_board_dir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 | |
| 265 | int nubus_get_subdir(const struct nubus_dirent *ent, |
| 266 | struct nubus_dir *dir) |
| 267 | { |
| 268 | dir->ptr = dir->base = nubus_dirptr(ent); |
| 269 | dir->done = 0; |
| 270 | dir->mask = ent->mask; |
| 271 | return 0; |
| 272 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 273 | EXPORT_SYMBOL(nubus_get_subdir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 274 | |
| 275 | int nubus_readdir(struct nubus_dir *nd, struct nubus_dirent *ent) |
| 276 | { |
| 277 | u32 resid; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 278 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | if (nd->done) |
| 280 | return -1; |
| 281 | |
| 282 | /* Do this first, otherwise nubus_rewind & co are off by 4 */ |
| 283 | ent->base = nd->ptr; |
| 284 | |
| 285 | /* This moves nd->ptr forward */ |
| 286 | resid = nubus_get_rom(&nd->ptr, 4, nd->mask); |
| 287 | |
| 288 | /* EOL marker, as per the Apple docs */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 289 | if ((resid & 0xff000000) == 0xff000000) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 | /* Mark it as done */ |
| 291 | nd->done = 1; |
| 292 | return -1; |
| 293 | } |
| 294 | |
| 295 | /* First byte is the resource ID */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 296 | ent->type = resid >> 24; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | /* Low 3 bytes might contain data (or might not) */ |
| 298 | ent->data = resid & 0xffffff; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 299 | ent->mask = nd->mask; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | return 0; |
| 301 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 302 | EXPORT_SYMBOL(nubus_readdir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 303 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 304 | int nubus_rewinddir(struct nubus_dir *dir) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 305 | { |
| 306 | dir->ptr = dir->base; |
David Huggins-Daines | e36b991 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 307 | dir->done = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 308 | return 0; |
| 309 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 310 | EXPORT_SYMBOL(nubus_rewinddir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 311 | |
| 312 | /* Driver interface functions, more or less like in pci.c */ |
| 313 | |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 314 | struct nubus_rsrc *nubus_first_rsrc_or_null(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | { |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 316 | return list_first_entry_or_null(&nubus_func_rsrcs, struct nubus_rsrc, |
| 317 | list); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | } |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 319 | EXPORT_SYMBOL(nubus_first_rsrc_or_null); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 320 | |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 321 | struct nubus_rsrc *nubus_next_rsrc_or_null(struct nubus_rsrc *from) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 | { |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 323 | if (list_is_last(&from->list, &nubus_func_rsrcs)) |
| 324 | return NULL; |
| 325 | return list_next_entry(from, list); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | } |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 327 | EXPORT_SYMBOL(nubus_next_rsrc_or_null); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 328 | |
| 329 | int |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 330 | nubus_find_rsrc(struct nubus_dir *dir, unsigned char rsrc_type, |
| 331 | struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | { |
| 333 | while (nubus_readdir(dir, ent) != -1) { |
| 334 | if (ent->type == rsrc_type) |
| 335 | return 0; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 336 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | return -1; |
| 338 | } |
Adrian Bunk | 99ffab8 | 2008-02-04 22:30:23 -0800 | [diff] [blame] | 339 | EXPORT_SYMBOL(nubus_find_rsrc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 340 | |
| 341 | /* Initialization functions - decide which slots contain stuff worth |
| 342 | looking at, and print out lots and lots of information from the |
| 343 | resource blocks. */ |
| 344 | |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 345 | static int __init nubus_get_block_rsrc_dir(struct nubus_board *board, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 346 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 347 | const struct nubus_dirent *parent) |
| 348 | { |
| 349 | struct nubus_dir dir; |
| 350 | struct nubus_dirent ent; |
| 351 | |
| 352 | nubus_get_subdir(parent, &dir); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 353 | dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 354 | |
| 355 | while (nubus_readdir(&dir, &ent) != -1) { |
| 356 | u32 size; |
| 357 | |
| 358 | nubus_get_rsrc_mem(&size, &ent, 4); |
| 359 | pr_debug(" block (0x%x), size %d\n", ent.type, size); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 360 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, size); |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 361 | } |
| 362 | return 0; |
| 363 | } |
| 364 | |
| 365 | static int __init nubus_get_display_vidmode(struct nubus_board *board, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 366 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 367 | const struct nubus_dirent *parent) |
| 368 | { |
| 369 | struct nubus_dir dir; |
| 370 | struct nubus_dirent ent; |
| 371 | |
| 372 | nubus_get_subdir(parent, &dir); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 373 | dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 374 | |
| 375 | while (nubus_readdir(&dir, &ent) != -1) { |
| 376 | switch (ent.type) { |
| 377 | case 1: /* mVidParams */ |
| 378 | case 2: /* mTable */ |
| 379 | { |
| 380 | u32 size; |
| 381 | |
| 382 | nubus_get_rsrc_mem(&size, &ent, 4); |
| 383 | pr_debug(" block (0x%x), size %d\n", ent.type, |
| 384 | size); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 385 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, size); |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 386 | break; |
| 387 | } |
| 388 | default: |
| 389 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 390 | ent.type, ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 391 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 0); |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 392 | } |
| 393 | } |
| 394 | return 0; |
| 395 | } |
| 396 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 397 | static int __init nubus_get_display_resource(struct nubus_rsrc *fres, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 398 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 399 | const struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 400 | { |
| 401 | switch (ent->type) { |
| 402 | case NUBUS_RESID_GAMMADIR: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 403 | pr_debug(" gamma directory offset: 0x%06x\n", ent->data); |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 404 | nubus_get_block_rsrc_dir(fres->board, procdir, ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | break; |
| 406 | case 0x0080 ... 0x0085: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 407 | pr_debug(" mode 0x%02x info offset: 0x%06x\n", |
| 408 | ent->type, ent->data); |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 409 | nubus_get_display_vidmode(fres->board, procdir, ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 410 | break; |
| 411 | default: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 412 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 413 | ent->type, ent->data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 414 | nubus_proc_add_rsrc_mem(procdir, ent, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 415 | } |
| 416 | return 0; |
| 417 | } |
| 418 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 419 | static int __init nubus_get_network_resource(struct nubus_rsrc *fres, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 420 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 421 | const struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 422 | { |
| 423 | switch (ent->type) { |
| 424 | case NUBUS_RESID_MAC_ADDRESS: |
| 425 | { |
| 426 | char addr[6]; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 427 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 | nubus_get_rsrc_mem(addr, ent, 6); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 429 | pr_debug(" MAC address: %pM\n", addr); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 430 | nubus_proc_add_rsrc_mem(procdir, ent, 6); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | break; |
| 432 | } |
| 433 | default: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 434 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 435 | ent->type, ent->data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 436 | nubus_proc_add_rsrc_mem(procdir, ent, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 437 | } |
| 438 | return 0; |
| 439 | } |
| 440 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 441 | static int __init nubus_get_cpu_resource(struct nubus_rsrc *fres, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 442 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 443 | const struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 444 | { |
| 445 | switch (ent->type) { |
| 446 | case NUBUS_RESID_MEMINFO: |
| 447 | { |
| 448 | unsigned long meminfo[2]; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 449 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 450 | nubus_get_rsrc_mem(&meminfo, ent, 8); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 451 | pr_debug(" memory: [ 0x%08lx 0x%08lx ]\n", |
| 452 | meminfo[0], meminfo[1]); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 453 | nubus_proc_add_rsrc_mem(procdir, ent, 8); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 454 | break; |
| 455 | } |
| 456 | case NUBUS_RESID_ROMINFO: |
| 457 | { |
| 458 | unsigned long rominfo[2]; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 459 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 460 | nubus_get_rsrc_mem(&rominfo, ent, 8); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 461 | pr_debug(" ROM: [ 0x%08lx 0x%08lx ]\n", |
| 462 | rominfo[0], rominfo[1]); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 463 | nubus_proc_add_rsrc_mem(procdir, ent, 8); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 464 | break; |
| 465 | } |
| 466 | default: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 467 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 468 | ent->type, ent->data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 469 | nubus_proc_add_rsrc_mem(procdir, ent, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | } |
| 471 | return 0; |
| 472 | } |
| 473 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 474 | static int __init nubus_get_private_resource(struct nubus_rsrc *fres, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 475 | struct proc_dir_entry *procdir, |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 476 | const struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | { |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 478 | switch (fres->category) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 479 | case NUBUS_CAT_DISPLAY: |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 480 | nubus_get_display_resource(fres, procdir, ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | break; |
| 482 | case NUBUS_CAT_NETWORK: |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 483 | nubus_get_network_resource(fres, procdir, ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 484 | break; |
| 485 | case NUBUS_CAT_CPU: |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 486 | nubus_get_cpu_resource(fres, procdir, ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 487 | break; |
| 488 | default: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 489 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 490 | ent->type, ent->data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 491 | nubus_proc_add_rsrc_mem(procdir, ent, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 492 | } |
| 493 | return 0; |
| 494 | } |
| 495 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 496 | static struct nubus_rsrc * __init |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 497 | nubus_get_functional_resource(struct nubus_board *board, int slot, |
| 498 | const struct nubus_dirent *parent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 499 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 500 | struct nubus_dir dir; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 501 | struct nubus_dirent ent; |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 502 | struct nubus_rsrc *fres; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 503 | |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 504 | pr_debug(" Functional resource 0x%02x:\n", parent->type); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | nubus_get_subdir(parent, &dir); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 506 | dir.procdir = nubus_proc_add_rsrc_dir(board->procdir, parent, board); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 508 | /* Actually we should probably panic if this fails */ |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 509 | fres = kzalloc(sizeof(*fres), GFP_ATOMIC); |
| 510 | if (!fres) |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 511 | return NULL; |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 512 | fres->resid = parent->type; |
| 513 | fres->directory = dir.base; |
| 514 | fres->board = board; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 515 | |
| 516 | while (nubus_readdir(&dir, &ent) != -1) { |
| 517 | switch (ent.type) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 518 | case NUBUS_RESID_TYPE: |
| 519 | { |
| 520 | unsigned short nbtdata[4]; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 521 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 522 | nubus_get_rsrc_mem(nbtdata, &ent, 8); |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 523 | fres->category = nbtdata[0]; |
| 524 | fres->type = nbtdata[1]; |
| 525 | fres->dr_sw = nbtdata[2]; |
| 526 | fres->dr_hw = nbtdata[3]; |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 527 | pr_debug(" type: [cat 0x%x type 0x%x sw 0x%x hw 0x%x]\n", |
| 528 | nbtdata[0], nbtdata[1], nbtdata[2], nbtdata[3]); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 529 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 8); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 | break; |
| 531 | } |
| 532 | case NUBUS_RESID_NAME: |
| 533 | { |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 534 | char name[64]; |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 535 | unsigned int len; |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 536 | |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 537 | len = nubus_get_rsrc_str(name, &ent, sizeof(name)); |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 538 | pr_debug(" name: %s\n", name); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 539 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 540 | break; |
| 541 | } |
| 542 | case NUBUS_RESID_DRVRDIR: |
| 543 | { |
| 544 | /* MacOS driver. If we were NetBSD we might |
| 545 | use this :-) */ |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 546 | pr_debug(" driver directory offset: 0x%06x\n", |
| 547 | ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 548 | nubus_get_block_rsrc_dir(board, dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 549 | break; |
| 550 | } |
| 551 | case NUBUS_RESID_MINOR_BASEOS: |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 552 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 553 | /* We will need this in order to support |
| 554 | multiple framebuffers. It might be handy |
| 555 | for Ethernet as well */ |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 556 | u32 base_offset; |
| 557 | |
| 558 | nubus_get_rsrc_mem(&base_offset, &ent, 4); |
| 559 | pr_debug(" memory offset: 0x%08x\n", base_offset); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 560 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 4); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | break; |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 562 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | case NUBUS_RESID_MINOR_LENGTH: |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 564 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 565 | /* Ditto */ |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 566 | u32 length; |
| 567 | |
| 568 | nubus_get_rsrc_mem(&length, &ent, 4); |
| 569 | pr_debug(" memory length: 0x%08x\n", length); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 570 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 4); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 571 | break; |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 572 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 | case NUBUS_RESID_FLAGS: |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 574 | pr_debug(" flags: 0x%06x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 575 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 576 | break; |
| 577 | case NUBUS_RESID_HWDEVID: |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 578 | pr_debug(" hwdevid: 0x%06x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 579 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 580 | break; |
| 581 | default: |
Finn Thain | 72b44f6 | 2023-05-16 11:22:05 +1000 | [diff] [blame] | 582 | if (nubus_populate_procfs) |
| 583 | nubus_get_private_resource(fres, dir.procdir, |
| 584 | &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 585 | } |
| 586 | } |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 587 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 588 | return fres; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 589 | } |
| 590 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | /* This is *really* cool. */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 592 | static int __init nubus_get_icon(struct nubus_board *board, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 593 | struct proc_dir_entry *procdir, |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 594 | const struct nubus_dirent *ent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 595 | { |
| 596 | /* Should be 32x32 if my memory serves me correctly */ |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 597 | u32 icon[32]; |
| 598 | int i; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 599 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | nubus_get_rsrc_mem(&icon, ent, 128); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 601 | pr_debug(" icon:\n"); |
| 602 | for (i = 0; i < 8; i++) |
| 603 | pr_debug(" %08x %08x %08x %08x\n", |
| 604 | icon[i * 4 + 0], icon[i * 4 + 1], |
| 605 | icon[i * 4 + 2], icon[i * 4 + 3]); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 606 | nubus_proc_add_rsrc_mem(procdir, ent, 128); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 607 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 608 | return 0; |
| 609 | } |
| 610 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 611 | static int __init nubus_get_vendorinfo(struct nubus_board *board, |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 612 | struct proc_dir_entry *procdir, |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 613 | const struct nubus_dirent *parent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 614 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 615 | struct nubus_dir dir; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 616 | struct nubus_dirent ent; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 617 | static char *vendor_fields[6] = { "ID", "serial", "revision", |
| 618 | "part", "date", "unknown field" }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 | |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 620 | pr_debug(" vendor info:\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 621 | nubus_get_subdir(parent, &dir); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 622 | dir.procdir = nubus_proc_add_rsrc_dir(procdir, parent, board); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 623 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 624 | while (nubus_readdir(&dir, &ent) != -1) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 | char name[64]; |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 626 | unsigned int len; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 627 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 628 | /* These are all strings, we think */ |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 629 | len = nubus_get_rsrc_str(name, &ent, sizeof(name)); |
Finn Thain | 2f828fb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 630 | if (ent.type < 1 || ent.type > 5) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 631 | ent.type = 5; |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 632 | pr_debug(" %s: %s\n", vendor_fields[ent.type - 1], name); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 633 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 634 | } |
| 635 | return 0; |
| 636 | } |
| 637 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 638 | static int __init nubus_get_board_resource(struct nubus_board *board, int slot, |
| 639 | const struct nubus_dirent *parent) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 640 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 641 | struct nubus_dir dir; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 642 | struct nubus_dirent ent; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 643 | |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 644 | pr_debug(" Board resource 0x%02x:\n", parent->type); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 | nubus_get_subdir(parent, &dir); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 646 | dir.procdir = nubus_proc_add_rsrc_dir(board->procdir, parent, board); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 647 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 648 | while (nubus_readdir(&dir, &ent) != -1) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | switch (ent.type) { |
| 650 | case NUBUS_RESID_TYPE: |
| 651 | { |
| 652 | unsigned short nbtdata[4]; |
| 653 | /* This type is always the same, and is not |
| 654 | useful except insofar as it tells us that |
| 655 | we really are looking at a board resource. */ |
| 656 | nubus_get_rsrc_mem(nbtdata, &ent, 8); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 657 | pr_debug(" type: [cat 0x%x type 0x%x sw 0x%x hw 0x%x]\n", |
| 658 | nbtdata[0], nbtdata[1], nbtdata[2], nbtdata[3]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 659 | if (nbtdata[0] != 1 || nbtdata[1] != 0 || |
| 660 | nbtdata[2] != 0 || nbtdata[3] != 0) |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 661 | pr_err("Slot %X: sResource is not a board resource!\n", |
| 662 | slot); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 663 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 8); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 664 | break; |
| 665 | } |
| 666 | case NUBUS_RESID_NAME: |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 667 | { |
| 668 | unsigned int len; |
| 669 | |
| 670 | len = nubus_get_rsrc_str(board->name, &ent, |
| 671 | sizeof(board->name)); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 672 | pr_debug(" name: %s\n", board->name); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 673 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, len + 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 674 | break; |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 675 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 676 | case NUBUS_RESID_ICON: |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 677 | nubus_get_icon(board, dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | break; |
| 679 | case NUBUS_RESID_BOARDID: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 680 | pr_debug(" board id: 0x%x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 681 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 682 | break; |
| 683 | case NUBUS_RESID_PRIMARYINIT: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 684 | pr_debug(" primary init offset: 0x%06x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 685 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 686 | break; |
| 687 | case NUBUS_RESID_VENDORINFO: |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 688 | nubus_get_vendorinfo(board, dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 689 | break; |
| 690 | case NUBUS_RESID_FLAGS: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 691 | pr_debug(" flags: 0x%06x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 692 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 693 | break; |
| 694 | case NUBUS_RESID_HWDEVID: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 695 | pr_debug(" hwdevid: 0x%06x\n", ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 696 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 697 | break; |
| 698 | case NUBUS_RESID_SECONDINIT: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 699 | pr_debug(" secondary init offset: 0x%06x\n", |
| 700 | ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 701 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 702 | break; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 703 | /* WTF isn't this in the functional resources? */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 704 | case NUBUS_RESID_VIDNAMES: |
Finn Thain | 883b8cb | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 705 | pr_debug(" vidnames directory offset: 0x%06x\n", |
| 706 | ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 707 | nubus_get_block_rsrc_dir(board, dir.procdir, &ent); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 708 | break; |
| 709 | /* Same goes for this */ |
| 710 | case NUBUS_RESID_VIDMODES: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 711 | pr_debug(" video mode parameter directory offset: 0x%06x\n", |
| 712 | ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 713 | nubus_proc_add_rsrc(dir.procdir, &ent); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 714 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 715 | default: |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 716 | pr_debug(" unknown resource 0x%02x, data 0x%06x\n", |
| 717 | ent.type, ent.data); |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 718 | nubus_proc_add_rsrc_mem(dir.procdir, &ent, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 719 | } |
| 720 | } |
| 721 | return 0; |
| 722 | } |
| 723 | |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 724 | static void __init nubus_add_board(int slot, int bytelanes) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 725 | { |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 726 | struct nubus_board *board; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 727 | unsigned char *rp; |
| 728 | unsigned long dpat; |
| 729 | struct nubus_dir dir; |
| 730 | struct nubus_dirent ent; |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 731 | int prev_resid = -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 732 | |
| 733 | /* Move to the start of the format block */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 734 | rp = nubus_rom_addr(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 735 | nubus_rewind(&rp, FORMAT_BLOCK_SIZE, bytelanes); |
| 736 | |
| 737 | /* Actually we should probably panic if this fails */ |
Yoann Padioleau | dd00cc4 | 2007-07-19 01:49:03 -0700 | [diff] [blame] | 738 | if ((board = kzalloc(sizeof(*board), GFP_ATOMIC)) == NULL) |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 739 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 740 | board->fblock = rp; |
| 741 | |
| 742 | /* Dump the format block for debugging purposes */ |
David Huggins-Daines | 71ae40e | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 743 | pr_debug("Slot %X, format block at 0x%p:\n", slot, rp); |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 744 | pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); |
| 745 | pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); |
| 746 | pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); |
David Huggins-Daines | 71ae40e | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 747 | pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); |
| 748 | pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); |
| 749 | pr_debug("%08lx\n", nubus_get_rom(&rp, 4, bytelanes)); |
| 750 | pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); |
| 751 | pr_debug("%02lx\n", nubus_get_rom(&rp, 1, bytelanes)); |
David Huggins-Daines | 71ae40e | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 752 | rp = board->fblock; |
| 753 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 754 | board->slot = slot; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 755 | board->slot_addr = (unsigned long)nubus_slot_addr(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 756 | board->doffset = nubus_get_rom(&rp, 4, bytelanes); |
| 757 | /* rom_length is *supposed* to be the total length of the |
| 758 | * ROM. In practice it is the "amount of ROM used to compute |
| 759 | * the CRC." So some jokers decide to set it to zero and |
| 760 | * set the crc to zero so they don't have to do any math. |
| 761 | * See the Performa 460 ROM, for example. Those Apple "engineers". |
| 762 | */ |
| 763 | board->rom_length = nubus_get_rom(&rp, 4, bytelanes); |
| 764 | board->crc = nubus_get_rom(&rp, 4, bytelanes); |
| 765 | board->rev = nubus_get_rom(&rp, 1, bytelanes); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 766 | board->format = nubus_get_rom(&rp, 1, bytelanes); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 767 | board->lanes = bytelanes; |
| 768 | |
| 769 | /* Directory offset should be small and negative... */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 770 | if (!(board->doffset & 0x00FF0000)) |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 771 | pr_warn("Slot %X: Dodgy doffset!\n", slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 772 | dpat = nubus_get_rom(&rp, 4, bytelanes); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 773 | if (dpat != NUBUS_TEST_PATTERN) |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 774 | pr_warn("Slot %X: Wrong test pattern %08lx!\n", slot, dpat); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 775 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 776 | /* |
| 777 | * I wonder how the CRC is meant to work - |
| 778 | * any takers ? |
| 779 | * CSA: According to MAC docs, not all cards pass the CRC anyway, |
| 780 | * since the initial Macintosh ROM releases skipped the check. |
| 781 | */ |
| 782 | |
David Huggins-Daines | 475e6e1 | 2017-04-22 21:24:16 -0400 | [diff] [blame] | 783 | /* Set up the directory pointer */ |
| 784 | board->directory = board->fblock; |
| 785 | nubus_move(&board->directory, nubus_expand32(board->doffset), |
| 786 | board->lanes); |
| 787 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 788 | nubus_get_root_dir(board, &dir); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 789 | |
| 790 | /* We're ready to rock */ |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 791 | pr_debug("Slot %X resources:\n", slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 792 | |
| 793 | /* Each slot should have one board resource and any number of |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 794 | * functional resources. So we'll fill in some fields in the |
| 795 | * struct nubus_board from the board resource, then walk down |
| 796 | * the list of functional resources, spinning out a nubus_rsrc |
| 797 | * for each of them. |
| 798 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 799 | if (nubus_readdir(&dir, &ent) == -1) { |
| 800 | /* We can't have this! */ |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 801 | pr_err("Slot %X: Board resource not found!\n", slot); |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 802 | kfree(board); |
| 803 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 804 | } |
| 805 | |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 806 | if (ent.type < 1 || ent.type > 127) |
| 807 | pr_warn("Slot %X: Board resource ID is invalid!\n", slot); |
| 808 | |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 809 | board->procdir = nubus_proc_add_board(board); |
| 810 | |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 811 | nubus_get_board_resource(board, slot, &ent); |
| 812 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 | while (nubus_readdir(&dir, &ent) != -1) { |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 814 | struct nubus_rsrc *fres; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 815 | |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 816 | fres = nubus_get_functional_resource(board, slot, &ent); |
| 817 | if (fres == NULL) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 818 | continue; |
| 819 | |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 820 | /* Resources should appear in ascending ID order. This sanity |
| 821 | * check prevents duplicate resource IDs. |
| 822 | */ |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 823 | if (fres->resid <= prev_resid) { |
| 824 | kfree(fres); |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 825 | continue; |
| 826 | } |
Finn Thain | 189e19e | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 827 | prev_resid = fres->resid; |
Finn Thain | d7811a3 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 828 | |
Finn Thain | 41b8481 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 829 | list_add_tail(&fres->list, &nubus_func_rsrcs); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 830 | } |
| 831 | |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 832 | if (nubus_device_register(board)) |
| 833 | put_device(&board->dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 834 | } |
| 835 | |
Finn Thain | 460cf95 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 836 | static void __init nubus_probe_slot(int slot) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | { |
| 838 | unsigned char dp; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 839 | unsigned char *rp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 840 | int i; |
| 841 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 842 | rp = nubus_rom_addr(slot); |
| 843 | for (i = 4; i; i--) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | rp--; |
Finn Thain | 9f97977 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 845 | if (!hwreg_present(rp)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 | continue; |
| 847 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | dp = *rp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 849 | |
| 850 | /* The last byte of the format block consists of two |
| 851 | nybbles which are "mirror images" of each other. |
| 852 | These show us the valid bytelanes */ |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 853 | if ((((dp >> 4) ^ dp) & 0x0F) != 0x0F) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | continue; |
| 855 | /* Check that this value is actually *on* one of the |
| 856 | bytelanes it claims are valid! */ |
Finn Thain | 85cc313 | 2017-04-22 21:24:16 -0400 | [diff] [blame] | 857 | if (not_useful(rp, dp)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 | continue; |
| 859 | |
| 860 | /* Looks promising. Let's put it on the list. */ |
| 861 | nubus_add_board(slot, dp); |
| 862 | |
| 863 | return; |
| 864 | } |
| 865 | } |
| 866 | |
Finn Thain | 460cf95 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 867 | static void __init nubus_scan_bus(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 868 | { |
| 869 | int slot; |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 870 | |
Finn Thain | f53bad0 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 871 | pr_info("NuBus: Scanning NuBus slots.\n"); |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 872 | for (slot = 9; slot < 15; slot++) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 873 | nubus_probe_slot(slot); |
| 874 | } |
| 875 | } |
| 876 | |
| 877 | static int __init nubus_init(void) |
| 878 | { |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 879 | int err; |
| 880 | |
Finn Thain | f42e555 | 2017-04-08 19:51:15 -0400 | [diff] [blame] | 881 | if (!MACH_IS_MAC) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 882 | return 0; |
| 883 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 884 | nubus_proc_init(); |
Finn Thain | bdeeed0 | 2018-05-09 11:04:48 +1000 | [diff] [blame] | 885 | err = nubus_parent_device_register(); |
Finn Thain | 7f86c76 | 2018-01-13 17:37:14 -0500 | [diff] [blame] | 886 | if (err) |
| 887 | return err; |
Finn Thain | 2f7dd07 | 2018-01-13 17:37:13 -0500 | [diff] [blame] | 888 | nubus_scan_bus(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 889 | return 0; |
| 890 | } |
| 891 | |
| 892 | subsys_initcall(nubus_init); |