Loading...
1/*
2 * Compaq Hot Plug Controller Driver
3 *
4 * Copyright (C) 1995,2001 Compaq Computer Corporation
5 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
6 * Copyright (C) 2001 IBM Corp.
7 *
8 * All rights reserved.
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or (at
13 * your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
18 * NON INFRINGEMENT. See the GNU General Public License for more
19 * details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24 *
25 * Send feedback to <greg@kroah.com>
26 *
27 */
28
29#include <linux/module.h>
30#include <linux/kernel.h>
31#include <linux/types.h>
32#include <linux/proc_fs.h>
33#include <linux/slab.h>
34#include <linux/workqueue.h>
35#include <linux/pci.h>
36#include <linux/pci_hotplug.h>
37#include <linux/init.h>
38#include <asm/uaccess.h>
39#include "cpqphp.h"
40#include "cpqphp_nvram.h"
41
42
43#define ROM_INT15_PHY_ADDR 0x0FF859
44#define READ_EV 0xD8A4
45#define WRITE_EV 0xD8A5
46
47struct register_foo {
48 union {
49 unsigned long lword; /* eax */
50 unsigned short word; /* ax */
51
52 struct {
53 unsigned char low; /* al */
54 unsigned char high; /* ah */
55 } byte;
56 } data;
57
58 unsigned char opcode; /* see below */
59 unsigned long length; /* if the reg. is a pointer, how much data */
60} __attribute__ ((packed));
61
62struct all_reg {
63 struct register_foo eax_reg;
64 struct register_foo ebx_reg;
65 struct register_foo ecx_reg;
66 struct register_foo edx_reg;
67 struct register_foo edi_reg;
68 struct register_foo esi_reg;
69 struct register_foo eflags_reg;
70} __attribute__ ((packed));
71
72
73struct ev_hrt_header {
74 u8 Version;
75 u8 num_of_ctrl;
76 u8 next;
77};
78
79struct ev_hrt_ctrl {
80 u8 bus;
81 u8 device;
82 u8 function;
83 u8 mem_avail;
84 u8 p_mem_avail;
85 u8 io_avail;
86 u8 bus_avail;
87 u8 next;
88};
89
90
91static u8 evbuffer_init;
92static u8 evbuffer_length;
93static u8 evbuffer[1024];
94
95static void __iomem *compaq_int15_entry_point;
96
97/* lock for ordering int15_bios_call() */
98static spinlock_t int15_lock;
99
100
101/* This is a series of function that deals with
102 * setting & getting the hotplug resource table in some environment variable.
103 */
104
105/*
106 * We really shouldn't be doing this unless there is a _very_ good reason to!!!
107 * greg k-h
108 */
109
110
111static u32 add_byte( u32 **p_buffer, u8 value, u32 *used, u32 *avail)
112{
113 u8 **tByte;
114
115 if ((*used + 1) > *avail)
116 return(1);
117
118 *((u8*)*p_buffer) = value;
119 tByte = (u8**)p_buffer;
120 (*tByte)++;
121 *used+=1;
122 return(0);
123}
124
125
126static u32 add_dword( u32 **p_buffer, u32 value, u32 *used, u32 *avail)
127{
128 if ((*used + 4) > *avail)
129 return(1);
130
131 **p_buffer = value;
132 (*p_buffer)++;
133 *used+=4;
134 return(0);
135}
136
137
138/*
139 * check_for_compaq_ROM
140 *
141 * this routine verifies that the ROM OEM string is 'COMPAQ'
142 *
143 * returns 0 for non-Compaq ROM, 1 for Compaq ROM
144 */
145static int check_for_compaq_ROM (void __iomem *rom_start)
146{
147 u8 temp1, temp2, temp3, temp4, temp5, temp6;
148 int result = 0;
149
150 temp1 = readb(rom_start + 0xffea + 0);
151 temp2 = readb(rom_start + 0xffea + 1);
152 temp3 = readb(rom_start + 0xffea + 2);
153 temp4 = readb(rom_start + 0xffea + 3);
154 temp5 = readb(rom_start + 0xffea + 4);
155 temp6 = readb(rom_start + 0xffea + 5);
156 if ((temp1 == 'C') &&
157 (temp2 == 'O') &&
158 (temp3 == 'M') &&
159 (temp4 == 'P') &&
160 (temp5 == 'A') &&
161 (temp6 == 'Q')) {
162 result = 1;
163 }
164 dbg ("%s - returned %d\n", __func__, result);
165 return result;
166}
167
168
169static u32 access_EV (u16 operation, u8 *ev_name, u8 *buffer, u32 *buf_size)
170{
171 unsigned long flags;
172 int op = operation;
173 int ret_val;
174
175 if (!compaq_int15_entry_point)
176 return -ENODEV;
177
178 spin_lock_irqsave(&int15_lock, flags);
179 __asm__ (
180 "xorl %%ebx,%%ebx\n" \
181 "xorl %%edx,%%edx\n" \
182 "pushf\n" \
183 "push %%cs\n" \
184 "cli\n" \
185 "call *%6\n"
186 : "=c" (*buf_size), "=a" (ret_val)
187 : "a" (op), "c" (*buf_size), "S" (ev_name),
188 "D" (buffer), "m" (compaq_int15_entry_point)
189 : "%ebx", "%edx");
190 spin_unlock_irqrestore(&int15_lock, flags);
191
192 return((ret_val & 0xFF00) >> 8);
193}
194
195
196/*
197 * load_HRT
198 *
199 * Read the hot plug Resource Table from NVRAM
200 */
201static int load_HRT (void __iomem *rom_start)
202{
203 u32 available;
204 u32 temp_dword;
205 u8 temp_byte = 0xFF;
206 u32 rc;
207
208 if (!check_for_compaq_ROM(rom_start)) {
209 return -ENODEV;
210 }
211
212 available = 1024;
213
214 /* Now load the EV */
215 temp_dword = available;
216
217 rc = access_EV(READ_EV, "CQTHPS", evbuffer, &temp_dword);
218
219 evbuffer_length = temp_dword;
220
221 /* We're maintaining the resource lists so write FF to invalidate old
222 * info
223 */
224 temp_dword = 1;
225
226 rc = access_EV(WRITE_EV, "CQTHPS", &temp_byte, &temp_dword);
227
228 return rc;
229}
230
231
232/*
233 * store_HRT
234 *
235 * Save the hot plug Resource Table in NVRAM
236 */
237static u32 store_HRT (void __iomem *rom_start)
238{
239 u32 *buffer;
240 u32 *pFill;
241 u32 usedbytes;
242 u32 available;
243 u32 temp_dword;
244 u32 rc;
245 u8 loop;
246 u8 numCtrl = 0;
247 struct controller *ctrl;
248 struct pci_resource *resNode;
249 struct ev_hrt_header *p_EV_header;
250 struct ev_hrt_ctrl *p_ev_ctrl;
251
252 available = 1024;
253
254 if (!check_for_compaq_ROM(rom_start)) {
255 return(1);
256 }
257
258 buffer = (u32*) evbuffer;
259
260 if (!buffer)
261 return(1);
262
263 pFill = buffer;
264 usedbytes = 0;
265
266 p_EV_header = (struct ev_hrt_header *) pFill;
267
268 ctrl = cpqhp_ctrl_list;
269
270 /* The revision of this structure */
271 rc = add_byte( &pFill, 1 + ctrl->push_flag, &usedbytes, &available);
272 if (rc)
273 return(rc);
274
275 /* The number of controllers */
276 rc = add_byte( &pFill, 1, &usedbytes, &available);
277 if (rc)
278 return(rc);
279
280 while (ctrl) {
281 p_ev_ctrl = (struct ev_hrt_ctrl *) pFill;
282
283 numCtrl++;
284
285 /* The bus number */
286 rc = add_byte( &pFill, ctrl->bus, &usedbytes, &available);
287 if (rc)
288 return(rc);
289
290 /* The device Number */
291 rc = add_byte( &pFill, PCI_SLOT(ctrl->pci_dev->devfn), &usedbytes, &available);
292 if (rc)
293 return(rc);
294
295 /* The function Number */
296 rc = add_byte( &pFill, PCI_FUNC(ctrl->pci_dev->devfn), &usedbytes, &available);
297 if (rc)
298 return(rc);
299
300 /* Skip the number of available entries */
301 rc = add_dword( &pFill, 0, &usedbytes, &available);
302 if (rc)
303 return(rc);
304
305 /* Figure out memory Available */
306
307 resNode = ctrl->mem_head;
308
309 loop = 0;
310
311 while (resNode) {
312 loop ++;
313
314 /* base */
315 rc = add_dword( &pFill, resNode->base, &usedbytes, &available);
316 if (rc)
317 return(rc);
318
319 /* length */
320 rc = add_dword( &pFill, resNode->length, &usedbytes, &available);
321 if (rc)
322 return(rc);
323
324 resNode = resNode->next;
325 }
326
327 /* Fill in the number of entries */
328 p_ev_ctrl->mem_avail = loop;
329
330 /* Figure out prefetchable memory Available */
331
332 resNode = ctrl->p_mem_head;
333
334 loop = 0;
335
336 while (resNode) {
337 loop ++;
338
339 /* base */
340 rc = add_dword( &pFill, resNode->base, &usedbytes, &available);
341 if (rc)
342 return(rc);
343
344 /* length */
345 rc = add_dword( &pFill, resNode->length, &usedbytes, &available);
346 if (rc)
347 return(rc);
348
349 resNode = resNode->next;
350 }
351
352 /* Fill in the number of entries */
353 p_ev_ctrl->p_mem_avail = loop;
354
355 /* Figure out IO Available */
356
357 resNode = ctrl->io_head;
358
359 loop = 0;
360
361 while (resNode) {
362 loop ++;
363
364 /* base */
365 rc = add_dword( &pFill, resNode->base, &usedbytes, &available);
366 if (rc)
367 return(rc);
368
369 /* length */
370 rc = add_dword( &pFill, resNode->length, &usedbytes, &available);
371 if (rc)
372 return(rc);
373
374 resNode = resNode->next;
375 }
376
377 /* Fill in the number of entries */
378 p_ev_ctrl->io_avail = loop;
379
380 /* Figure out bus Available */
381
382 resNode = ctrl->bus_head;
383
384 loop = 0;
385
386 while (resNode) {
387 loop ++;
388
389 /* base */
390 rc = add_dword( &pFill, resNode->base, &usedbytes, &available);
391 if (rc)
392 return(rc);
393
394 /* length */
395 rc = add_dword( &pFill, resNode->length, &usedbytes, &available);
396 if (rc)
397 return(rc);
398
399 resNode = resNode->next;
400 }
401
402 /* Fill in the number of entries */
403 p_ev_ctrl->bus_avail = loop;
404
405 ctrl = ctrl->next;
406 }
407
408 p_EV_header->num_of_ctrl = numCtrl;
409
410 /* Now store the EV */
411
412 temp_dword = usedbytes;
413
414 rc = access_EV(WRITE_EV, "CQTHPS", (u8*) buffer, &temp_dword);
415
416 dbg("usedbytes = 0x%x, length = 0x%x\n", usedbytes, temp_dword);
417
418 evbuffer_length = temp_dword;
419
420 if (rc) {
421 err(msg_unable_to_save);
422 return(1);
423 }
424
425 return(0);
426}
427
428
429void compaq_nvram_init (void __iomem *rom_start)
430{
431 if (rom_start) {
432 compaq_int15_entry_point = (rom_start + ROM_INT15_PHY_ADDR - ROM_PHY_ADDR);
433 }
434 dbg("int15 entry = %p\n", compaq_int15_entry_point);
435
436 /* initialize our int15 lock */
437 spin_lock_init(&int15_lock);
438}
439
440
441int compaq_nvram_load (void __iomem *rom_start, struct controller *ctrl)
442{
443 u8 bus, device, function;
444 u8 nummem, numpmem, numio, numbus;
445 u32 rc;
446 u8 *p_byte;
447 struct pci_resource *mem_node;
448 struct pci_resource *p_mem_node;
449 struct pci_resource *io_node;
450 struct pci_resource *bus_node;
451 struct ev_hrt_ctrl *p_ev_ctrl;
452 struct ev_hrt_header *p_EV_header;
453
454 if (!evbuffer_init) {
455 /* Read the resource list information in from NVRAM */
456 if (load_HRT(rom_start))
457 memset (evbuffer, 0, 1024);
458
459 evbuffer_init = 1;
460 }
461
462 /* If we saved information in NVRAM, use it now */
463 p_EV_header = (struct ev_hrt_header *) evbuffer;
464
465 /* The following code is for systems where version 1.0 of this
466 * driver has been loaded, but doesn't support the hardware.
467 * In that case, the driver would incorrectly store something
468 * in NVRAM.
469 */
470 if ((p_EV_header->Version == 2) ||
471 ((p_EV_header->Version == 1) && !ctrl->push_flag)) {
472 p_byte = &(p_EV_header->next);
473
474 p_ev_ctrl = (struct ev_hrt_ctrl *) &(p_EV_header->next);
475
476 p_byte += 3;
477
478 if (p_byte > ((u8*)p_EV_header + evbuffer_length))
479 return 2;
480
481 bus = p_ev_ctrl->bus;
482 device = p_ev_ctrl->device;
483 function = p_ev_ctrl->function;
484
485 while ((bus != ctrl->bus) ||
486 (device != PCI_SLOT(ctrl->pci_dev->devfn)) ||
487 (function != PCI_FUNC(ctrl->pci_dev->devfn))) {
488 nummem = p_ev_ctrl->mem_avail;
489 numpmem = p_ev_ctrl->p_mem_avail;
490 numio = p_ev_ctrl->io_avail;
491 numbus = p_ev_ctrl->bus_avail;
492
493 p_byte += 4;
494
495 if (p_byte > ((u8*)p_EV_header + evbuffer_length))
496 return 2;
497
498 /* Skip forward to the next entry */
499 p_byte += (nummem + numpmem + numio + numbus) * 8;
500
501 if (p_byte > ((u8*)p_EV_header + evbuffer_length))
502 return 2;
503
504 p_ev_ctrl = (struct ev_hrt_ctrl *) p_byte;
505
506 p_byte += 3;
507
508 if (p_byte > ((u8*)p_EV_header + evbuffer_length))
509 return 2;
510
511 bus = p_ev_ctrl->bus;
512 device = p_ev_ctrl->device;
513 function = p_ev_ctrl->function;
514 }
515
516 nummem = p_ev_ctrl->mem_avail;
517 numpmem = p_ev_ctrl->p_mem_avail;
518 numio = p_ev_ctrl->io_avail;
519 numbus = p_ev_ctrl->bus_avail;
520
521 p_byte += 4;
522
523 if (p_byte > ((u8*)p_EV_header + evbuffer_length))
524 return 2;
525
526 while (nummem--) {
527 mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
528
529 if (!mem_node)
530 break;
531
532 mem_node->base = *(u32*)p_byte;
533 dbg("mem base = %8.8x\n",mem_node->base);
534 p_byte += 4;
535
536 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
537 kfree(mem_node);
538 return 2;
539 }
540
541 mem_node->length = *(u32*)p_byte;
542 dbg("mem length = %8.8x\n",mem_node->length);
543 p_byte += 4;
544
545 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
546 kfree(mem_node);
547 return 2;
548 }
549
550 mem_node->next = ctrl->mem_head;
551 ctrl->mem_head = mem_node;
552 }
553
554 while (numpmem--) {
555 p_mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
556
557 if (!p_mem_node)
558 break;
559
560 p_mem_node->base = *(u32*)p_byte;
561 dbg("pre-mem base = %8.8x\n",p_mem_node->base);
562 p_byte += 4;
563
564 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
565 kfree(p_mem_node);
566 return 2;
567 }
568
569 p_mem_node->length = *(u32*)p_byte;
570 dbg("pre-mem length = %8.8x\n",p_mem_node->length);
571 p_byte += 4;
572
573 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
574 kfree(p_mem_node);
575 return 2;
576 }
577
578 p_mem_node->next = ctrl->p_mem_head;
579 ctrl->p_mem_head = p_mem_node;
580 }
581
582 while (numio--) {
583 io_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
584
585 if (!io_node)
586 break;
587
588 io_node->base = *(u32*)p_byte;
589 dbg("io base = %8.8x\n",io_node->base);
590 p_byte += 4;
591
592 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
593 kfree(io_node);
594 return 2;
595 }
596
597 io_node->length = *(u32*)p_byte;
598 dbg("io length = %8.8x\n",io_node->length);
599 p_byte += 4;
600
601 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
602 kfree(io_node);
603 return 2;
604 }
605
606 io_node->next = ctrl->io_head;
607 ctrl->io_head = io_node;
608 }
609
610 while (numbus--) {
611 bus_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
612
613 if (!bus_node)
614 break;
615
616 bus_node->base = *(u32*)p_byte;
617 p_byte += 4;
618
619 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
620 kfree(bus_node);
621 return 2;
622 }
623
624 bus_node->length = *(u32*)p_byte;
625 p_byte += 4;
626
627 if (p_byte > ((u8*)p_EV_header + evbuffer_length)) {
628 kfree(bus_node);
629 return 2;
630 }
631
632 bus_node->next = ctrl->bus_head;
633 ctrl->bus_head = bus_node;
634 }
635
636 /* If all of the following fail, we don't have any resources for
637 * hot plug add
638 */
639 rc = 1;
640 rc &= cpqhp_resource_sort_and_combine(&(ctrl->mem_head));
641 rc &= cpqhp_resource_sort_and_combine(&(ctrl->p_mem_head));
642 rc &= cpqhp_resource_sort_and_combine(&(ctrl->io_head));
643 rc &= cpqhp_resource_sort_and_combine(&(ctrl->bus_head));
644
645 if (rc)
646 return(rc);
647 } else {
648 if ((evbuffer[0] != 0) && (!ctrl->push_flag))
649 return 1;
650 }
651
652 return 0;
653}
654
655
656int compaq_nvram_store (void __iomem *rom_start)
657{
658 int rc = 1;
659
660 if (rom_start == NULL)
661 return -ENODEV;
662
663 if (evbuffer_init) {
664 rc = store_HRT(rom_start);
665 if (rc) {
666 err(msg_unable_to_save);
667 }
668 }
669 return rc;
670}
671
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Compaq Hot Plug Controller Driver
4 *
5 * Copyright (C) 1995,2001 Compaq Computer Corporation
6 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
7 * Copyright (C) 2001 IBM Corp.
8 *
9 * All rights reserved.
10 *
11 * Send feedback to <greg@kroah.com>
12 *
13 */
14
15#include <linux/module.h>
16#include <linux/kernel.h>
17#include <linux/types.h>
18#include <linux/proc_fs.h>
19#include <linux/slab.h>
20#include <linux/workqueue.h>
21#include <linux/pci.h>
22#include <linux/pci_hotplug.h>
23#include <linux/uaccess.h>
24#include "cpqphp.h"
25#include "cpqphp_nvram.h"
26
27
28#define ROM_INT15_PHY_ADDR 0x0FF859
29#define READ_EV 0xD8A4
30#define WRITE_EV 0xD8A5
31
32struct register_foo {
33 union {
34 unsigned long lword; /* eax */
35 unsigned short word; /* ax */
36
37 struct {
38 unsigned char low; /* al */
39 unsigned char high; /* ah */
40 } byte;
41 } data;
42
43 unsigned char opcode; /* see below */
44 unsigned long length; /* if the reg. is a pointer, how much data */
45} __attribute__ ((packed));
46
47struct all_reg {
48 struct register_foo eax_reg;
49 struct register_foo ebx_reg;
50 struct register_foo ecx_reg;
51 struct register_foo edx_reg;
52 struct register_foo edi_reg;
53 struct register_foo esi_reg;
54 struct register_foo eflags_reg;
55} __attribute__ ((packed));
56
57
58struct ev_hrt_header {
59 u8 Version;
60 u8 num_of_ctrl;
61 u8 next;
62};
63
64struct ev_hrt_ctrl {
65 u8 bus;
66 u8 device;
67 u8 function;
68 u8 mem_avail;
69 u8 p_mem_avail;
70 u8 io_avail;
71 u8 bus_avail;
72 u8 next;
73};
74
75
76static u8 evbuffer_init;
77static u8 evbuffer_length;
78static u8 evbuffer[1024];
79
80static void __iomem *compaq_int15_entry_point;
81
82/* lock for ordering int15_bios_call() */
83static DEFINE_SPINLOCK(int15_lock);
84
85
86/* This is a series of function that deals with
87 * setting & getting the hotplug resource table in some environment variable.
88 */
89
90/*
91 * We really shouldn't be doing this unless there is a _very_ good reason to!!!
92 * greg k-h
93 */
94
95
96static u32 add_byte(u32 **p_buffer, u8 value, u32 *used, u32 *avail)
97{
98 u8 **tByte;
99
100 if ((*used + 1) > *avail)
101 return(1);
102
103 *((u8 *)*p_buffer) = value;
104 tByte = (u8 **)p_buffer;
105 (*tByte)++;
106 *used += 1;
107 return(0);
108}
109
110
111static u32 add_dword(u32 **p_buffer, u32 value, u32 *used, u32 *avail)
112{
113 if ((*used + 4) > *avail)
114 return(1);
115
116 **p_buffer = value;
117 (*p_buffer)++;
118 *used += 4;
119 return(0);
120}
121
122
123/*
124 * check_for_compaq_ROM
125 *
126 * this routine verifies that the ROM OEM string is 'COMPAQ'
127 *
128 * returns 0 for non-Compaq ROM, 1 for Compaq ROM
129 */
130static int check_for_compaq_ROM(void __iomem *rom_start)
131{
132 u8 temp1, temp2, temp3, temp4, temp5, temp6;
133 int result = 0;
134
135 temp1 = readb(rom_start + 0xffea + 0);
136 temp2 = readb(rom_start + 0xffea + 1);
137 temp3 = readb(rom_start + 0xffea + 2);
138 temp4 = readb(rom_start + 0xffea + 3);
139 temp5 = readb(rom_start + 0xffea + 4);
140 temp6 = readb(rom_start + 0xffea + 5);
141 if ((temp1 == 'C') &&
142 (temp2 == 'O') &&
143 (temp3 == 'M') &&
144 (temp4 == 'P') &&
145 (temp5 == 'A') &&
146 (temp6 == 'Q')) {
147 result = 1;
148 }
149 dbg("%s - returned %d\n", __func__, result);
150 return result;
151}
152
153
154static u32 access_EV(u16 operation, u8 *ev_name, u8 *buffer, u32 *buf_size)
155{
156 unsigned long flags;
157 int op = operation;
158 int ret_val;
159
160 if (!compaq_int15_entry_point)
161 return -ENODEV;
162
163 spin_lock_irqsave(&int15_lock, flags);
164 __asm__ (
165 "xorl %%ebx,%%ebx\n" \
166 "xorl %%edx,%%edx\n" \
167 "pushf\n" \
168 "push %%cs\n" \
169 "cli\n" \
170 "call *%6\n"
171 : "=c" (*buf_size), "=a" (ret_val)
172 : "a" (op), "c" (*buf_size), "S" (ev_name),
173 "D" (buffer), "m" (compaq_int15_entry_point)
174 : "%ebx", "%edx");
175 spin_unlock_irqrestore(&int15_lock, flags);
176
177 return((ret_val & 0xFF00) >> 8);
178}
179
180
181/*
182 * load_HRT
183 *
184 * Read the hot plug Resource Table from NVRAM
185 */
186static int load_HRT(void __iomem *rom_start)
187{
188 u32 available;
189 u32 temp_dword;
190 u8 temp_byte = 0xFF;
191 u32 rc;
192
193 if (!check_for_compaq_ROM(rom_start))
194 return -ENODEV;
195
196 available = 1024;
197
198 /* Now load the EV */
199 temp_dword = available;
200
201 rc = access_EV(READ_EV, "CQTHPS", evbuffer, &temp_dword);
202
203 evbuffer_length = temp_dword;
204
205 /* We're maintaining the resource lists so write FF to invalidate old
206 * info
207 */
208 temp_dword = 1;
209
210 rc = access_EV(WRITE_EV, "CQTHPS", &temp_byte, &temp_dword);
211
212 return rc;
213}
214
215
216/*
217 * store_HRT
218 *
219 * Save the hot plug Resource Table in NVRAM
220 */
221static u32 store_HRT(void __iomem *rom_start)
222{
223 u32 *buffer;
224 u32 *pFill;
225 u32 usedbytes;
226 u32 available;
227 u32 temp_dword;
228 u32 rc;
229 u8 loop;
230 u8 numCtrl = 0;
231 struct controller *ctrl;
232 struct pci_resource *resNode;
233 struct ev_hrt_header *p_EV_header;
234 struct ev_hrt_ctrl *p_ev_ctrl;
235
236 available = 1024;
237
238 if (!check_for_compaq_ROM(rom_start))
239 return(1);
240
241 buffer = (u32 *) evbuffer;
242
243 if (!buffer)
244 return(1);
245
246 pFill = buffer;
247 usedbytes = 0;
248
249 p_EV_header = (struct ev_hrt_header *) pFill;
250
251 ctrl = cpqhp_ctrl_list;
252
253 /* The revision of this structure */
254 rc = add_byte(&pFill, 1 + ctrl->push_flag, &usedbytes, &available);
255 if (rc)
256 return(rc);
257
258 /* The number of controllers */
259 rc = add_byte(&pFill, 1, &usedbytes, &available);
260 if (rc)
261 return(rc);
262
263 while (ctrl) {
264 p_ev_ctrl = (struct ev_hrt_ctrl *) pFill;
265
266 numCtrl++;
267
268 /* The bus number */
269 rc = add_byte(&pFill, ctrl->bus, &usedbytes, &available);
270 if (rc)
271 return(rc);
272
273 /* The device Number */
274 rc = add_byte(&pFill, PCI_SLOT(ctrl->pci_dev->devfn), &usedbytes, &available);
275 if (rc)
276 return(rc);
277
278 /* The function Number */
279 rc = add_byte(&pFill, PCI_FUNC(ctrl->pci_dev->devfn), &usedbytes, &available);
280 if (rc)
281 return(rc);
282
283 /* Skip the number of available entries */
284 rc = add_dword(&pFill, 0, &usedbytes, &available);
285 if (rc)
286 return(rc);
287
288 /* Figure out memory Available */
289
290 resNode = ctrl->mem_head;
291
292 loop = 0;
293
294 while (resNode) {
295 loop++;
296
297 /* base */
298 rc = add_dword(&pFill, resNode->base, &usedbytes, &available);
299 if (rc)
300 return(rc);
301
302 /* length */
303 rc = add_dword(&pFill, resNode->length, &usedbytes, &available);
304 if (rc)
305 return(rc);
306
307 resNode = resNode->next;
308 }
309
310 /* Fill in the number of entries */
311 p_ev_ctrl->mem_avail = loop;
312
313 /* Figure out prefetchable memory Available */
314
315 resNode = ctrl->p_mem_head;
316
317 loop = 0;
318
319 while (resNode) {
320 loop++;
321
322 /* base */
323 rc = add_dword(&pFill, resNode->base, &usedbytes, &available);
324 if (rc)
325 return(rc);
326
327 /* length */
328 rc = add_dword(&pFill, resNode->length, &usedbytes, &available);
329 if (rc)
330 return(rc);
331
332 resNode = resNode->next;
333 }
334
335 /* Fill in the number of entries */
336 p_ev_ctrl->p_mem_avail = loop;
337
338 /* Figure out IO Available */
339
340 resNode = ctrl->io_head;
341
342 loop = 0;
343
344 while (resNode) {
345 loop++;
346
347 /* base */
348 rc = add_dword(&pFill, resNode->base, &usedbytes, &available);
349 if (rc)
350 return(rc);
351
352 /* length */
353 rc = add_dword(&pFill, resNode->length, &usedbytes, &available);
354 if (rc)
355 return(rc);
356
357 resNode = resNode->next;
358 }
359
360 /* Fill in the number of entries */
361 p_ev_ctrl->io_avail = loop;
362
363 /* Figure out bus Available */
364
365 resNode = ctrl->bus_head;
366
367 loop = 0;
368
369 while (resNode) {
370 loop++;
371
372 /* base */
373 rc = add_dword(&pFill, resNode->base, &usedbytes, &available);
374 if (rc)
375 return(rc);
376
377 /* length */
378 rc = add_dword(&pFill, resNode->length, &usedbytes, &available);
379 if (rc)
380 return(rc);
381
382 resNode = resNode->next;
383 }
384
385 /* Fill in the number of entries */
386 p_ev_ctrl->bus_avail = loop;
387
388 ctrl = ctrl->next;
389 }
390
391 p_EV_header->num_of_ctrl = numCtrl;
392
393 /* Now store the EV */
394
395 temp_dword = usedbytes;
396
397 rc = access_EV(WRITE_EV, "CQTHPS", (u8 *) buffer, &temp_dword);
398
399 dbg("usedbytes = 0x%x, length = 0x%x\n", usedbytes, temp_dword);
400
401 evbuffer_length = temp_dword;
402
403 if (rc) {
404 err(msg_unable_to_save);
405 return(1);
406 }
407
408 return(0);
409}
410
411
412void compaq_nvram_init(void __iomem *rom_start)
413{
414 if (rom_start)
415 compaq_int15_entry_point = (rom_start + ROM_INT15_PHY_ADDR - ROM_PHY_ADDR);
416
417 dbg("int15 entry = %p\n", compaq_int15_entry_point);
418}
419
420
421int compaq_nvram_load(void __iomem *rom_start, struct controller *ctrl)
422{
423 u8 bus, device, function;
424 u8 nummem, numpmem, numio, numbus;
425 u32 rc;
426 u8 *p_byte;
427 struct pci_resource *mem_node;
428 struct pci_resource *p_mem_node;
429 struct pci_resource *io_node;
430 struct pci_resource *bus_node;
431 struct ev_hrt_ctrl *p_ev_ctrl;
432 struct ev_hrt_header *p_EV_header;
433
434 if (!evbuffer_init) {
435 /* Read the resource list information in from NVRAM */
436 if (load_HRT(rom_start))
437 memset(evbuffer, 0, 1024);
438
439 evbuffer_init = 1;
440 }
441
442 /* If we saved information in NVRAM, use it now */
443 p_EV_header = (struct ev_hrt_header *) evbuffer;
444
445 /* The following code is for systems where version 1.0 of this
446 * driver has been loaded, but doesn't support the hardware.
447 * In that case, the driver would incorrectly store something
448 * in NVRAM.
449 */
450 if ((p_EV_header->Version == 2) ||
451 ((p_EV_header->Version == 1) && !ctrl->push_flag)) {
452 p_byte = &(p_EV_header->next);
453
454 p_ev_ctrl = (struct ev_hrt_ctrl *) &(p_EV_header->next);
455
456 p_byte += 3;
457
458 if (p_byte > ((u8 *)p_EV_header + evbuffer_length))
459 return 2;
460
461 bus = p_ev_ctrl->bus;
462 device = p_ev_ctrl->device;
463 function = p_ev_ctrl->function;
464
465 while ((bus != ctrl->bus) ||
466 (device != PCI_SLOT(ctrl->pci_dev->devfn)) ||
467 (function != PCI_FUNC(ctrl->pci_dev->devfn))) {
468 nummem = p_ev_ctrl->mem_avail;
469 numpmem = p_ev_ctrl->p_mem_avail;
470 numio = p_ev_ctrl->io_avail;
471 numbus = p_ev_ctrl->bus_avail;
472
473 p_byte += 4;
474
475 if (p_byte > ((u8 *)p_EV_header + evbuffer_length))
476 return 2;
477
478 /* Skip forward to the next entry */
479 p_byte += (nummem + numpmem + numio + numbus) * 8;
480
481 if (p_byte > ((u8 *)p_EV_header + evbuffer_length))
482 return 2;
483
484 p_ev_ctrl = (struct ev_hrt_ctrl *) p_byte;
485
486 p_byte += 3;
487
488 if (p_byte > ((u8 *)p_EV_header + evbuffer_length))
489 return 2;
490
491 bus = p_ev_ctrl->bus;
492 device = p_ev_ctrl->device;
493 function = p_ev_ctrl->function;
494 }
495
496 nummem = p_ev_ctrl->mem_avail;
497 numpmem = p_ev_ctrl->p_mem_avail;
498 numio = p_ev_ctrl->io_avail;
499 numbus = p_ev_ctrl->bus_avail;
500
501 p_byte += 4;
502
503 if (p_byte > ((u8 *)p_EV_header + evbuffer_length))
504 return 2;
505
506 while (nummem--) {
507 mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
508
509 if (!mem_node)
510 break;
511
512 mem_node->base = *(u32 *)p_byte;
513 dbg("mem base = %8.8x\n", mem_node->base);
514 p_byte += 4;
515
516 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
517 kfree(mem_node);
518 return 2;
519 }
520
521 mem_node->length = *(u32 *)p_byte;
522 dbg("mem length = %8.8x\n", mem_node->length);
523 p_byte += 4;
524
525 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
526 kfree(mem_node);
527 return 2;
528 }
529
530 mem_node->next = ctrl->mem_head;
531 ctrl->mem_head = mem_node;
532 }
533
534 while (numpmem--) {
535 p_mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
536
537 if (!p_mem_node)
538 break;
539
540 p_mem_node->base = *(u32 *)p_byte;
541 dbg("pre-mem base = %8.8x\n", p_mem_node->base);
542 p_byte += 4;
543
544 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
545 kfree(p_mem_node);
546 return 2;
547 }
548
549 p_mem_node->length = *(u32 *)p_byte;
550 dbg("pre-mem length = %8.8x\n", p_mem_node->length);
551 p_byte += 4;
552
553 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
554 kfree(p_mem_node);
555 return 2;
556 }
557
558 p_mem_node->next = ctrl->p_mem_head;
559 ctrl->p_mem_head = p_mem_node;
560 }
561
562 while (numio--) {
563 io_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
564
565 if (!io_node)
566 break;
567
568 io_node->base = *(u32 *)p_byte;
569 dbg("io base = %8.8x\n", io_node->base);
570 p_byte += 4;
571
572 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
573 kfree(io_node);
574 return 2;
575 }
576
577 io_node->length = *(u32 *)p_byte;
578 dbg("io length = %8.8x\n", io_node->length);
579 p_byte += 4;
580
581 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
582 kfree(io_node);
583 return 2;
584 }
585
586 io_node->next = ctrl->io_head;
587 ctrl->io_head = io_node;
588 }
589
590 while (numbus--) {
591 bus_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
592
593 if (!bus_node)
594 break;
595
596 bus_node->base = *(u32 *)p_byte;
597 p_byte += 4;
598
599 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
600 kfree(bus_node);
601 return 2;
602 }
603
604 bus_node->length = *(u32 *)p_byte;
605 p_byte += 4;
606
607 if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) {
608 kfree(bus_node);
609 return 2;
610 }
611
612 bus_node->next = ctrl->bus_head;
613 ctrl->bus_head = bus_node;
614 }
615
616 /* If all of the following fail, we don't have any resources for
617 * hot plug add
618 */
619 rc = 1;
620 rc &= cpqhp_resource_sort_and_combine(&(ctrl->mem_head));
621 rc &= cpqhp_resource_sort_and_combine(&(ctrl->p_mem_head));
622 rc &= cpqhp_resource_sort_and_combine(&(ctrl->io_head));
623 rc &= cpqhp_resource_sort_and_combine(&(ctrl->bus_head));
624
625 if (rc)
626 return(rc);
627 } else {
628 if ((evbuffer[0] != 0) && (!ctrl->push_flag))
629 return 1;
630 }
631
632 return 0;
633}
634
635
636int compaq_nvram_store(void __iomem *rom_start)
637{
638 int rc = 1;
639
640 if (rom_start == NULL)
641 return -ENODEV;
642
643 if (evbuffer_init) {
644 rc = store_HRT(rom_start);
645 if (rc)
646 err(msg_unable_to_save);
647 }
648 return rc;
649}
650