Loading...
1/*
2 * eisa_enumerator.c - provide support for EISA adapters in PA-RISC machines
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Copyright (c) 2002 Daniel Engstrom <5116@telia.com>
10 *
11 */
12
13#include <linux/ioport.h>
14#include <linux/init.h>
15#include <linux/kernel.h>
16#include <linux/slab.h>
17#include <asm/io.h>
18#include <asm/uaccess.h>
19#include <asm/byteorder.h>
20
21#include <asm/eisa_bus.h>
22#include <asm/eisa_eeprom.h>
23
24
25/*
26 * Todo:
27 *
28 * PORT init with MASK attr and other size than byte
29 * MEMORY with other decode than 20 bit
30 * CRC stuff
31 * FREEFORM stuff
32 */
33
34#define EPI 0xc80
35#define NUM_SLOT 16
36#define SLOT2PORT(x) (x<<12)
37
38
39/* macros to handle unaligned accesses and
40 * byte swapping. The data in the EEPROM is
41 * little-endian on the big-endian PAROSC */
42#define get_8(x) (*(u_int8_t*)(x))
43
44static inline u_int16_t get_16(const unsigned char *x)
45{
46 return (x[1] << 8) | x[0];
47}
48
49static inline u_int32_t get_32(const unsigned char *x)
50{
51 return (x[3] << 24) | (x[2] << 16) | (x[1] << 8) | x[0];
52}
53
54static inline u_int32_t get_24(const unsigned char *x)
55{
56 return (x[2] << 24) | (x[1] << 16) | (x[0] << 8);
57}
58
59static void print_eisa_id(char *s, u_int32_t id)
60{
61 char vendor[4];
62 int rev;
63 int device;
64
65 rev = id & 0xff;
66 id >>= 8;
67 device = id & 0xff;
68 id >>= 8;
69 vendor[3] = '\0';
70 vendor[2] = '@' + (id & 0x1f);
71 id >>= 5;
72 vendor[1] = '@' + (id & 0x1f);
73 id >>= 5;
74 vendor[0] = '@' + (id & 0x1f);
75 id >>= 5;
76
77 sprintf(s, "%s%02X%02X", vendor, device, rev);
78}
79
80static int configure_memory(const unsigned char *buf,
81 struct resource *mem_parent,
82 char *name)
83{
84 int len;
85 u_int8_t c;
86 int i;
87 struct resource *res;
88
89 len=0;
90
91 for (i=0;i<HPEE_MEMORY_MAX_ENT;i++) {
92 c = get_8(buf+len);
93
94 if (NULL != (res = kzalloc(sizeof(struct resource), GFP_KERNEL))) {
95 int result;
96
97 res->name = name;
98 res->start = mem_parent->start + get_24(buf+len+2);
99 res->end = res->start + get_16(buf+len+5)*1024;
100 res->flags = IORESOURCE_MEM;
101 printk("memory %lx-%lx ", (unsigned long)res->start, (unsigned long)res->end);
102 result = request_resource(mem_parent, res);
103 if (result < 0) {
104 printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
105 return result;
106 }
107 }
108
109 len+=7;
110
111 if (!(c & HPEE_MEMORY_MORE)) {
112 break;
113 }
114 }
115
116 return len;
117}
118
119
120static int configure_irq(const unsigned char *buf)
121{
122 int len;
123 u_int8_t c;
124 int i;
125
126 len=0;
127
128 for (i=0;i<HPEE_IRQ_MAX_ENT;i++) {
129 c = get_8(buf+len);
130
131 printk("IRQ %d ", c & HPEE_IRQ_CHANNEL_MASK);
132 if (c & HPEE_IRQ_TRIG_LEVEL) {
133 eisa_make_irq_level(c & HPEE_IRQ_CHANNEL_MASK);
134 } else {
135 eisa_make_irq_edge(c & HPEE_IRQ_CHANNEL_MASK);
136 }
137
138 len+=2;
139 /* hpux seems to allow for
140 * two bytes of irq data but only defines one of
141 * them, I think */
142 if (!(c & HPEE_IRQ_MORE)) {
143 break;
144 }
145 }
146
147 return len;
148}
149
150
151static int configure_dma(const unsigned char *buf)
152{
153 int len;
154 u_int8_t c;
155 int i;
156
157 len=0;
158
159 for (i=0;i<HPEE_DMA_MAX_ENT;i++) {
160 c = get_8(buf+len);
161 printk("DMA %d ", c&HPEE_DMA_CHANNEL_MASK);
162 /* fixme: maybe initialize the dma channel withthe timing ? */
163 len+=2;
164 if (!(c & HPEE_DMA_MORE)) {
165 break;
166 }
167 }
168
169 return len;
170}
171
172static int configure_port(const unsigned char *buf, struct resource *io_parent,
173 char *board)
174{
175 int len;
176 u_int8_t c;
177 int i;
178 struct resource *res;
179 int result;
180
181 len=0;
182
183 for (i=0;i<HPEE_PORT_MAX_ENT;i++) {
184 c = get_8(buf+len);
185
186 if (NULL != (res = kzalloc(sizeof(struct resource), GFP_KERNEL))) {
187 res->name = board;
188 res->start = get_16(buf+len+1);
189 res->end = get_16(buf+len+1)+(c&HPEE_PORT_SIZE_MASK)+1;
190 res->flags = IORESOURCE_IO;
191 printk("ioports %lx-%lx ", (unsigned long)res->start, (unsigned long)res->end);
192 result = request_resource(io_parent, res);
193 if (result < 0) {
194 printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
195 return result;
196 }
197 }
198
199 len+=3;
200 if (!(c & HPEE_PORT_MORE)) {
201 break;
202 }
203 }
204
205 return len;
206}
207
208
209/* byte 1 and 2 is the port number to write
210 * and at byte 3 the value to write starts.
211 * I assume that there are and- and or- masks
212 * here when HPEE_PORT_INIT_MASK is set but I have
213 * not yet encountered this. */
214static int configure_port_init(const unsigned char *buf)
215{
216 int len=0;
217 u_int8_t c;
218
219 while (len<HPEE_PORT_INIT_MAX_LEN) {
220 int s=0;
221 c = get_8(buf+len);
222
223 switch (c & HPEE_PORT_INIT_WIDTH_MASK) {
224 case HPEE_PORT_INIT_WIDTH_BYTE:
225 s=1;
226 if (c & HPEE_PORT_INIT_MASK) {
227 printk(KERN_WARNING "port_init: unverified mask attribute\n");
228 outb((inb(get_16(buf+len+1) &
229 get_8(buf+len+3)) |
230 get_8(buf+len+4)), get_16(buf+len+1));
231
232 } else {
233 outb(get_8(buf+len+3), get_16(buf+len+1));
234
235 }
236 break;
237 case HPEE_PORT_INIT_WIDTH_WORD:
238 s=2;
239 if (c & HPEE_PORT_INIT_MASK) {
240 printk(KERN_WARNING "port_init: unverified mask attribute\n");
241 outw((inw(get_16(buf+len+1)) &
242 get_16(buf+len+3)) |
243 get_16(buf+len+5),
244 get_16(buf+len+1));
245 } else {
246 outw(cpu_to_le16(get_16(buf+len+3)), get_16(buf+len+1));
247 }
248 break;
249 case HPEE_PORT_INIT_WIDTH_DWORD:
250 s=4;
251 if (c & HPEE_PORT_INIT_MASK) {
252 printk(KERN_WARNING "port_init: unverified mask attribute\n");
253 outl((inl(get_16(buf+len+1) &
254 get_32(buf+len+3)) |
255 get_32(buf+len+7)), get_16(buf+len+1));
256 } else {
257 outl(cpu_to_le32(get_32(buf+len+3)), get_16(buf+len+1));
258 }
259
260 break;
261 default:
262 printk(KERN_ERR "Invalid port init word %02x\n", c);
263 return 0;
264 }
265
266 if (c & HPEE_PORT_INIT_MASK) {
267 s*=2;
268 }
269
270 len+=s+3;
271 if (!(c & HPEE_PORT_INIT_MORE)) {
272 break;
273 }
274 }
275
276 return len;
277}
278
279static int configure_choise(const unsigned char *buf, u_int8_t *info)
280{
281 int len;
282
283 /* theis record contain the value of the functions
284 * configuration choises and an info byte which
285 * describes which other records to expect in this
286 * function */
287 len = get_8(buf);
288 *info=get_8(buf+len+1);
289
290 return len+2;
291}
292
293static int configure_type_string(const unsigned char *buf)
294{
295 int len;
296
297 /* just skip past the type field */
298 len = get_8(buf);
299 if (len > 80) {
300 printk(KERN_ERR "eisa_enumerator: type info field too long (%d, max is 80)\n", len);
301 }
302
303 return 1+len;
304}
305
306static int configure_function(const unsigned char *buf, int *more)
307{
308 /* the init field seems to be a two-byte field
309 * which is non-zero if there are an other function following
310 * I think it is the length of the function def
311 */
312 *more = get_16(buf);
313
314 return 2;
315}
316
317static int parse_slot_config(int slot,
318 const unsigned char *buf,
319 struct eeprom_eisa_slot_info *es,
320 struct resource *io_parent,
321 struct resource *mem_parent)
322{
323 int res=0;
324 int function_len;
325 unsigned int pos=0;
326 unsigned int maxlen;
327 int num_func=0;
328 u_int8_t flags;
329 int p0;
330
331 char *board;
332 int id_string_used=0;
333
334 if (NULL == (board = kmalloc(8, GFP_KERNEL))) {
335 return -1;
336 }
337 print_eisa_id(board, es->eisa_slot_id);
338 printk(KERN_INFO "EISA slot %d: %s %s ",
339 slot, board, es->flags&HPEE_FLAG_BOARD_IS_ISA ? "ISA" : "EISA");
340
341 maxlen = es->config_data_length < HPEE_MAX_LENGTH ?
342 es->config_data_length : HPEE_MAX_LENGTH;
343 while ((pos < maxlen) && (num_func <= es->num_functions)) {
344 pos+=configure_function(buf+pos, &function_len);
345
346 if (!function_len) {
347 break;
348 }
349 num_func++;
350 p0 = pos;
351 pos += configure_choise(buf+pos, &flags);
352
353 if (flags & HPEE_FUNCTION_INFO_F_DISABLED) {
354 /* function disabled, skip silently */
355 pos = p0 + function_len;
356 continue;
357 }
358 if (flags & HPEE_FUNCTION_INFO_CFG_FREE_FORM) {
359 /* I have no idea how to handle this */
360 printk("function %d have free-form configuration, skipping ",
361 num_func);
362 pos = p0 + function_len;
363 continue;
364 }
365
366 /* the ordering of the sections need
367 * more investigation.
368 * Currently I think that memory comaed before IRQ
369 * I assume the order is LSB to MSB in the
370 * info flags
371 * eg type, memory, irq, dma, port, HPEE_PORT_init
372 */
373
374 if (flags & HPEE_FUNCTION_INFO_HAVE_TYPE) {
375 pos += configure_type_string(buf+pos);
376 }
377
378 if (flags & HPEE_FUNCTION_INFO_HAVE_MEMORY) {
379 id_string_used=1;
380 pos += configure_memory(buf+pos, mem_parent, board);
381 }
382
383 if (flags & HPEE_FUNCTION_INFO_HAVE_IRQ) {
384 pos += configure_irq(buf+pos);
385 }
386
387 if (flags & HPEE_FUNCTION_INFO_HAVE_DMA) {
388 pos += configure_dma(buf+pos);
389 }
390
391 if (flags & HPEE_FUNCTION_INFO_HAVE_PORT) {
392 id_string_used=1;
393 pos += configure_port(buf+pos, io_parent, board);
394 }
395
396 if (flags & HPEE_FUNCTION_INFO_HAVE_PORT_INIT) {
397 pos += configure_port_init(buf+pos);
398 }
399
400 if (p0 + function_len < pos) {
401 printk(KERN_ERR "eisa_enumerator: function %d length mis-match "
402 "got %d, expected %d\n",
403 num_func, pos-p0, function_len);
404 res=-1;
405 break;
406 }
407 pos = p0 + function_len;
408 }
409 printk("\n");
410 if (!id_string_used) {
411 kfree(board);
412 }
413
414 if (pos != es->config_data_length) {
415 printk(KERN_ERR "eisa_enumerator: config data length mis-match got %d, expected %d\n",
416 pos, es->config_data_length);
417 res=-1;
418 }
419
420 if (num_func != es->num_functions) {
421 printk(KERN_ERR "eisa_enumerator: number of functions mis-match got %d, expected %d\n",
422 num_func, es->num_functions);
423 res=-2;
424 }
425
426 return res;
427
428}
429
430static int init_slot(int slot, struct eeprom_eisa_slot_info *es)
431{
432 unsigned int id;
433
434 char id_string[8];
435
436 if (!(es->slot_info&HPEE_SLOT_INFO_NO_READID)) {
437 /* try to read the id of the board in the slot */
438 id = le32_to_cpu(inl(SLOT2PORT(slot)+EPI));
439
440 if (0xffffffff == id) {
441 /* Maybe we didn't expect a card to be here... */
442 if (es->eisa_slot_id == 0xffffffff)
443 return -1;
444
445 /* this board is not here or it does not
446 * support readid
447 */
448 printk(KERN_ERR "EISA slot %d a configured board was not detected (",
449 slot);
450
451 print_eisa_id(id_string, es->eisa_slot_id);
452 printk(" expected %s)\n", id_string);
453
454 return -1;
455
456 }
457 if (es->eisa_slot_id != id) {
458 print_eisa_id(id_string, id);
459 printk(KERN_ERR "EISA slot %d id mis-match: got %s",
460 slot, id_string);
461
462 print_eisa_id(id_string, es->eisa_slot_id);
463 printk(" expected %s\n", id_string);
464
465 return -1;
466
467 }
468 }
469
470 /* now: we need to enable the board if
471 * it supports enabling and run through
472 * the port init sction if present
473 * and finally record any interrupt polarity
474 */
475 if (es->slot_features & HPEE_SLOT_FEATURES_ENABLE) {
476 /* enable board */
477 outb(0x01| inb(SLOT2PORT(slot)+EPI+4),
478 SLOT2PORT(slot)+EPI+4);
479 }
480
481 return 0;
482}
483
484
485int eisa_enumerator(unsigned long eeprom_addr,
486 struct resource *io_parent, struct resource *mem_parent)
487{
488 int i;
489 struct eeprom_header *eh;
490 static char eeprom_buf[HPEE_MAX_LENGTH];
491
492 for (i=0; i < HPEE_MAX_LENGTH; i++) {
493 eeprom_buf[i] = gsc_readb(eeprom_addr+i);
494 }
495
496 printk(KERN_INFO "Enumerating EISA bus\n");
497
498 eh = (struct eeprom_header*)(eeprom_buf);
499 for (i=0;i<eh->num_slots;i++) {
500 struct eeprom_eisa_slot_info *es;
501
502 es = (struct eeprom_eisa_slot_info*)
503 (&eeprom_buf[HPEE_SLOT_INFO(i)]);
504
505 if (-1==init_slot(i+1, es)) {
506 continue;
507 }
508
509 if (es->config_data_offset < HPEE_MAX_LENGTH) {
510 if (parse_slot_config(i+1, &eeprom_buf[es->config_data_offset],
511 es, io_parent, mem_parent)) {
512 return -1;
513 }
514 } else {
515 printk (KERN_WARNING "EISA EEPROM offset 0x%x out of range\n",es->config_data_offset);
516 return -1;
517 }
518 }
519 return eh->num_slots;
520}
521
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * eisa_enumerator.c - provide support for EISA adapters in PA-RISC machines
4 *
5 * Copyright (c) 2002 Daniel Engstrom <5116@telia.com>
6 */
7
8#include <linux/ioport.h>
9#include <linux/init.h>
10#include <linux/kernel.h>
11#include <linux/slab.h>
12#include <asm/io.h>
13#include <linux/uaccess.h>
14#include <asm/byteorder.h>
15
16#include <asm/eisa_bus.h>
17#include <asm/eisa_eeprom.h>
18
19
20/*
21 * Todo:
22 *
23 * PORT init with MASK attr and other size than byte
24 * MEMORY with other decode than 20 bit
25 * CRC stuff
26 * FREEFORM stuff
27 */
28
29#define EPI 0xc80
30#define NUM_SLOT 16
31#define SLOT2PORT(x) (x<<12)
32
33
34/* macros to handle unaligned accesses and
35 * byte swapping. The data in the EEPROM is
36 * little-endian on the big-endian PAROSC */
37#define get_8(x) (*(u_int8_t*)(x))
38
39static inline u_int16_t get_16(const unsigned char *x)
40{
41 return (x[1] << 8) | x[0];
42}
43
44static inline u_int32_t get_32(const unsigned char *x)
45{
46 return (x[3] << 24) | (x[2] << 16) | (x[1] << 8) | x[0];
47}
48
49static inline u_int32_t get_24(const unsigned char *x)
50{
51 return (x[2] << 24) | (x[1] << 16) | (x[0] << 8);
52}
53
54static void print_eisa_id(char *s, u_int32_t id)
55{
56 char vendor[4];
57 int rev;
58 int device;
59
60 rev = id & 0xff;
61 id >>= 8;
62 device = id & 0xff;
63 id >>= 8;
64 vendor[3] = '\0';
65 vendor[2] = '@' + (id & 0x1f);
66 id >>= 5;
67 vendor[1] = '@' + (id & 0x1f);
68 id >>= 5;
69 vendor[0] = '@' + (id & 0x1f);
70 id >>= 5;
71
72 sprintf(s, "%s%02X%02X", vendor, device, rev);
73}
74
75static int configure_memory(const unsigned char *buf,
76 struct resource *mem_parent,
77 char *name)
78{
79 int len;
80 u_int8_t c;
81 int i;
82 struct resource *res;
83
84 len=0;
85
86 for (i=0;i<HPEE_MEMORY_MAX_ENT;i++) {
87 c = get_8(buf+len);
88
89 if (NULL != (res = kzalloc(sizeof(struct resource), GFP_KERNEL))) {
90 int result;
91
92 res->name = name;
93 res->start = mem_parent->start + get_24(buf+len+2);
94 res->end = res->start + get_16(buf+len+5)*1024;
95 res->flags = IORESOURCE_MEM;
96 pr_cont("memory %pR ", res);
97 result = request_resource(mem_parent, res);
98 if (result < 0) {
99 printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
100 return result;
101 }
102 }
103
104 len+=7;
105
106 if (!(c & HPEE_MEMORY_MORE)) {
107 break;
108 }
109 }
110
111 return len;
112}
113
114
115static int configure_irq(const unsigned char *buf)
116{
117 int len;
118 u_int8_t c;
119 int i;
120
121 len=0;
122
123 for (i=0;i<HPEE_IRQ_MAX_ENT;i++) {
124 c = get_8(buf+len);
125
126 pr_cont("IRQ %d ", c & HPEE_IRQ_CHANNEL_MASK);
127 if (c & HPEE_IRQ_TRIG_LEVEL) {
128 eisa_make_irq_level(c & HPEE_IRQ_CHANNEL_MASK);
129 } else {
130 eisa_make_irq_edge(c & HPEE_IRQ_CHANNEL_MASK);
131 }
132
133 len+=2;
134 /* hpux seems to allow for
135 * two bytes of irq data but only defines one of
136 * them, I think */
137 if (!(c & HPEE_IRQ_MORE)) {
138 break;
139 }
140 }
141
142 return len;
143}
144
145
146static int configure_dma(const unsigned char *buf)
147{
148 int len;
149 u_int8_t c;
150 int i;
151
152 len=0;
153
154 for (i=0;i<HPEE_DMA_MAX_ENT;i++) {
155 c = get_8(buf+len);
156 pr_cont("DMA %d ", c&HPEE_DMA_CHANNEL_MASK);
157 /* fixme: maybe initialize the dma channel withthe timing ? */
158 len+=2;
159 if (!(c & HPEE_DMA_MORE)) {
160 break;
161 }
162 }
163
164 return len;
165}
166
167static int configure_port(const unsigned char *buf, struct resource *io_parent,
168 char *board)
169{
170 int len;
171 u_int8_t c;
172 int i;
173 struct resource *res;
174 int result;
175
176 len=0;
177
178 for (i=0;i<HPEE_PORT_MAX_ENT;i++) {
179 c = get_8(buf+len);
180
181 if (NULL != (res = kzalloc(sizeof(struct resource), GFP_KERNEL))) {
182 res->name = board;
183 res->start = get_16(buf+len+1);
184 res->end = get_16(buf+len+1)+(c&HPEE_PORT_SIZE_MASK)+1;
185 res->flags = IORESOURCE_IO;
186 pr_cont("ioports %pR ", res);
187 result = request_resource(io_parent, res);
188 if (result < 0) {
189 printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
190 return result;
191 }
192 }
193
194 len+=3;
195 if (!(c & HPEE_PORT_MORE)) {
196 break;
197 }
198 }
199
200 return len;
201}
202
203
204/* byte 1 and 2 is the port number to write
205 * and at byte 3 the value to write starts.
206 * I assume that there are and- and or- masks
207 * here when HPEE_PORT_INIT_MASK is set but I have
208 * not yet encountered this. */
209static int configure_port_init(const unsigned char *buf)
210{
211 int len=0;
212 u_int8_t c;
213
214 while (len<HPEE_PORT_INIT_MAX_LEN) {
215 int s=0;
216 c = get_8(buf+len);
217
218 switch (c & HPEE_PORT_INIT_WIDTH_MASK) {
219 case HPEE_PORT_INIT_WIDTH_BYTE:
220 s=1;
221 if (c & HPEE_PORT_INIT_MASK) {
222 printk(KERN_WARNING "port_init: unverified mask attribute\n");
223 outb((inb(get_16(buf+len+1) &
224 get_8(buf+len+3)) |
225 get_8(buf+len+4)), get_16(buf+len+1));
226
227 } else {
228 outb(get_8(buf+len+3), get_16(buf+len+1));
229
230 }
231 break;
232 case HPEE_PORT_INIT_WIDTH_WORD:
233 s=2;
234 if (c & HPEE_PORT_INIT_MASK) {
235 printk(KERN_WARNING "port_init: unverified mask attribute\n");
236 outw((inw(get_16(buf+len+1)) &
237 get_16(buf+len+3)) |
238 get_16(buf+len+5),
239 get_16(buf+len+1));
240 } else {
241 outw(cpu_to_le16(get_16(buf+len+3)), get_16(buf+len+1));
242 }
243 break;
244 case HPEE_PORT_INIT_WIDTH_DWORD:
245 s=4;
246 if (c & HPEE_PORT_INIT_MASK) {
247 printk(KERN_WARNING "port_init: unverified mask attribute\n");
248 outl((inl(get_16(buf+len+1) &
249 get_32(buf+len+3)) |
250 get_32(buf+len+7)), get_16(buf+len+1));
251 } else {
252 outl(cpu_to_le32(get_32(buf+len+3)), get_16(buf+len+1));
253 }
254
255 break;
256 default:
257 printk(KERN_ERR "Invalid port init word %02x\n", c);
258 return 0;
259 }
260
261 if (c & HPEE_PORT_INIT_MASK) {
262 s*=2;
263 }
264
265 len+=s+3;
266 if (!(c & HPEE_PORT_INIT_MORE)) {
267 break;
268 }
269 }
270
271 return len;
272}
273
274static int configure_choise(const unsigned char *buf, u_int8_t *info)
275{
276 int len;
277
278 /* theis record contain the value of the functions
279 * configuration choises and an info byte which
280 * describes which other records to expect in this
281 * function */
282 len = get_8(buf);
283 *info=get_8(buf+len+1);
284
285 return len+2;
286}
287
288static int configure_type_string(const unsigned char *buf)
289{
290 int len;
291
292 /* just skip past the type field */
293 len = get_8(buf);
294 if (len > 80) {
295 printk(KERN_ERR "eisa_enumerator: type info field too long (%d, max is 80)\n", len);
296 }
297
298 return 1+len;
299}
300
301static int configure_function(const unsigned char *buf, int *more)
302{
303 /* the init field seems to be a two-byte field
304 * which is non-zero if there are an other function following
305 * I think it is the length of the function def
306 */
307 *more = get_16(buf);
308
309 return 2;
310}
311
312static int parse_slot_config(int slot,
313 const unsigned char *buf,
314 struct eeprom_eisa_slot_info *es,
315 struct resource *io_parent,
316 struct resource *mem_parent)
317{
318 int res=0;
319 int function_len;
320 unsigned int pos=0;
321 unsigned int maxlen;
322 int num_func=0;
323 u_int8_t flags;
324 int p0;
325
326 char *board;
327 int id_string_used=0;
328
329 if (NULL == (board = kmalloc(8, GFP_KERNEL))) {
330 return -1;
331 }
332 print_eisa_id(board, es->eisa_slot_id);
333 printk(KERN_INFO "EISA slot %d: %s %s ",
334 slot, board, es->flags&HPEE_FLAG_BOARD_IS_ISA ? "ISA" : "EISA");
335
336 maxlen = es->config_data_length < HPEE_MAX_LENGTH ?
337 es->config_data_length : HPEE_MAX_LENGTH;
338 while ((pos < maxlen) && (num_func <= es->num_functions)) {
339 pos+=configure_function(buf+pos, &function_len);
340
341 if (!function_len) {
342 break;
343 }
344 num_func++;
345 p0 = pos;
346 pos += configure_choise(buf+pos, &flags);
347
348 if (flags & HPEE_FUNCTION_INFO_F_DISABLED) {
349 /* function disabled, skip silently */
350 pos = p0 + function_len;
351 continue;
352 }
353 if (flags & HPEE_FUNCTION_INFO_CFG_FREE_FORM) {
354 /* I have no idea how to handle this */
355 printk("function %d have free-form configuration, skipping ",
356 num_func);
357 pos = p0 + function_len;
358 continue;
359 }
360
361 /* the ordering of the sections need
362 * more investigation.
363 * Currently I think that memory comaed before IRQ
364 * I assume the order is LSB to MSB in the
365 * info flags
366 * eg type, memory, irq, dma, port, HPEE_PORT_init
367 */
368
369 if (flags & HPEE_FUNCTION_INFO_HAVE_TYPE) {
370 pos += configure_type_string(buf+pos);
371 }
372
373 if (flags & HPEE_FUNCTION_INFO_HAVE_MEMORY) {
374 id_string_used=1;
375 pos += configure_memory(buf+pos, mem_parent, board);
376 }
377
378 if (flags & HPEE_FUNCTION_INFO_HAVE_IRQ) {
379 pos += configure_irq(buf+pos);
380 }
381
382 if (flags & HPEE_FUNCTION_INFO_HAVE_DMA) {
383 pos += configure_dma(buf+pos);
384 }
385
386 if (flags & HPEE_FUNCTION_INFO_HAVE_PORT) {
387 id_string_used=1;
388 pos += configure_port(buf+pos, io_parent, board);
389 }
390
391 if (flags & HPEE_FUNCTION_INFO_HAVE_PORT_INIT) {
392 pos += configure_port_init(buf+pos);
393 }
394
395 if (p0 + function_len < pos) {
396 printk(KERN_ERR "eisa_enumerator: function %d length mismatch "
397 "got %d, expected %d\n",
398 num_func, pos-p0, function_len);
399 res=-1;
400 break;
401 }
402 pos = p0 + function_len;
403 }
404 pr_cont("\n");
405 if (!id_string_used) {
406 kfree(board);
407 }
408
409 if (pos != es->config_data_length) {
410 printk(KERN_ERR "eisa_enumerator: config data length mismatch got %d, expected %d\n",
411 pos, es->config_data_length);
412 res=-1;
413 }
414
415 if (num_func != es->num_functions) {
416 printk(KERN_ERR "eisa_enumerator: number of functions mismatch got %d, expected %d\n",
417 num_func, es->num_functions);
418 res=-2;
419 }
420
421 return res;
422
423}
424
425static int init_slot(int slot, struct eeprom_eisa_slot_info *es)
426{
427 unsigned int id;
428
429 char id_string[8];
430
431 if (!(es->slot_info&HPEE_SLOT_INFO_NO_READID)) {
432 /* try to read the id of the board in the slot */
433 id = le32_to_cpu(inl(SLOT2PORT(slot)+EPI));
434
435 if (0xffffffff == id) {
436 /* Maybe we didn't expect a card to be here... */
437 if (es->eisa_slot_id == 0xffffffff)
438 return -1;
439
440 /* this board is not here or it does not
441 * support readid
442 */
443 printk(KERN_ERR "EISA slot %d a configured board was not detected (",
444 slot);
445
446 print_eisa_id(id_string, es->eisa_slot_id);
447 printk(" expected %s)\n", id_string);
448
449 return -1;
450
451 }
452 if (es->eisa_slot_id != id) {
453 print_eisa_id(id_string, id);
454 printk(KERN_ERR "EISA slot %d id mismatch: got %s",
455 slot, id_string);
456
457 print_eisa_id(id_string, es->eisa_slot_id);
458 printk(" expected %s\n", id_string);
459
460 return -1;
461
462 }
463 }
464
465 /* now: we need to enable the board if
466 * it supports enabling and run through
467 * the port init sction if present
468 * and finally record any interrupt polarity
469 */
470 if (es->slot_features & HPEE_SLOT_FEATURES_ENABLE) {
471 /* enable board */
472 outb(0x01| inb(SLOT2PORT(slot)+EPI+4),
473 SLOT2PORT(slot)+EPI+4);
474 }
475
476 return 0;
477}
478
479
480int eisa_enumerator(unsigned long eeprom_addr,
481 struct resource *io_parent, struct resource *mem_parent)
482{
483 int i;
484 struct eeprom_header *eh;
485 static char eeprom_buf[HPEE_MAX_LENGTH];
486
487 for (i=0; i < HPEE_MAX_LENGTH; i++) {
488 eeprom_buf[i] = gsc_readb(eeprom_addr+i);
489 }
490
491 printk(KERN_INFO "Enumerating EISA bus\n");
492
493 eh = (struct eeprom_header*)(eeprom_buf);
494 for (i=0;i<eh->num_slots;i++) {
495 struct eeprom_eisa_slot_info *es;
496
497 es = (struct eeprom_eisa_slot_info*)
498 (&eeprom_buf[HPEE_SLOT_INFO(i)]);
499
500 if (-1==init_slot(i+1, es)) {
501 continue;
502 }
503
504 if (es->config_data_offset < HPEE_MAX_LENGTH) {
505 if (parse_slot_config(i+1, &eeprom_buf[es->config_data_offset],
506 es, io_parent, mem_parent)) {
507 return -1;
508 }
509 } else {
510 printk (KERN_WARNING "EISA EEPROM offset 0x%x out of range\n",es->config_data_offset);
511 return -1;
512 }
513 }
514 return eh->num_slots;
515}
516