]>
git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blob - drivers/pci/hotplug/cpqphp_nvram.c
2 * Compaq Hot Plug Controller Driver
4 * Copyright (C) 1995,2001 Compaq Computer Corporation
5 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
6 * Copyright (C) 2001 IBM Corp.
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.
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
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.
25 * Send feedback to <greg@kroah.com>
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>
40 #include "cpqphp_nvram.h"
43 #define ROM_INT15_PHY_ADDR 0x0FF859
44 #define READ_EV 0xD8A4
45 #define WRITE_EV 0xD8A5
49 unsigned long lword
; /* eax */
50 unsigned short word
; /* ax */
53 unsigned char low
; /* al */
54 unsigned char high
; /* ah */
58 unsigned char opcode
; /* see below */
59 unsigned long length
; /* if the reg. is a pointer, how much data */
60 } __attribute__ ((packed
));
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
));
73 struct ev_hrt_header
{
91 static u8 evbuffer_init
;
92 static u8 evbuffer_length
;
93 static u8 evbuffer
[1024];
95 static void __iomem
*compaq_int15_entry_point
;
97 /* lock for ordering int15_bios_call() */
98 static spinlock_t int15_lock
;
101 /* This is a series of function that deals with
102 * setting & getting the hotplug resource table in some environment variable.
106 * We really shouldn't be doing this unless there is a _very_ good reason to!!!
111 static u32
add_byte( u32
**p_buffer
, u8 value
, u32
*used
, u32
*avail
)
115 if ((*used
+ 1) > *avail
)
118 *((u8
*)*p_buffer
) = value
;
119 tByte
= (u8
**)p_buffer
;
126 static u32
add_dword( u32
**p_buffer
, u32 value
, u32
*used
, u32
*avail
)
128 if ((*used
+ 4) > *avail
)
139 * check_for_compaq_ROM
141 * this routine verifies that the ROM OEM string is 'COMPAQ'
143 * returns 0 for non-Compaq ROM, 1 for Compaq ROM
145 static int check_for_compaq_ROM (void __iomem
*rom_start
)
147 u8 temp1
, temp2
, temp3
, temp4
, temp5
, temp6
;
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') &&
164 dbg ("%s - returned %d\n", __func__
, result
);
169 static u32
access_EV (u16 operation
, u8
*ev_name
, u8
*buffer
, u32
*buf_size
)
175 if (!compaq_int15_entry_point
)
178 spin_lock_irqsave(&int15_lock
, flags
);
180 "xorl %%ebx,%%ebx\n" \
181 "xorl %%edx,%%edx\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
)
190 spin_unlock_irqrestore(&int15_lock
, flags
);
192 return((ret_val
& 0xFF00) >> 8);
199 * Read the hot plug Resource Table from NVRAM
201 static int load_HRT (void __iomem
*rom_start
)
208 if (!check_for_compaq_ROM(rom_start
)) {
214 /* Now load the EV */
215 temp_dword
= available
;
217 rc
= access_EV(READ_EV
, "CQTHPS", evbuffer
, &temp_dword
);
219 evbuffer_length
= temp_dword
;
221 /* We're maintaining the resource lists so write FF to invalidate old
226 rc
= access_EV(WRITE_EV
, "CQTHPS", &temp_byte
, &temp_dword
);
235 * Save the hot plug Resource Table in NVRAM
237 static u32
store_HRT (void __iomem
*rom_start
)
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
;
254 if (!check_for_compaq_ROM(rom_start
)) {
258 buffer
= (u32
*) evbuffer
;
266 p_EV_header
= (struct ev_hrt_header
*) pFill
;
268 ctrl
= cpqhp_ctrl_list
;
270 /* The revision of this structure */
271 rc
= add_byte( &pFill
, 1 + ctrl
->push_flag
, &usedbytes
, &available
);
275 /* The number of controllers */
276 rc
= add_byte( &pFill
, 1, &usedbytes
, &available
);
281 p_ev_ctrl
= (struct ev_hrt_ctrl
*) pFill
;
286 rc
= add_byte( &pFill
, ctrl
->bus
, &usedbytes
, &available
);
290 /* The device Number */
291 rc
= add_byte( &pFill
, PCI_SLOT(ctrl
->pci_dev
->devfn
), &usedbytes
, &available
);
295 /* The function Number */
296 rc
= add_byte( &pFill
, PCI_FUNC(ctrl
->pci_dev
->devfn
), &usedbytes
, &available
);
300 /* Skip the number of available entries */
301 rc
= add_dword( &pFill
, 0, &usedbytes
, &available
);
305 /* Figure out memory Available */
307 resNode
= ctrl
->mem_head
;
315 rc
= add_dword( &pFill
, resNode
->base
, &usedbytes
, &available
);
320 rc
= add_dword( &pFill
, resNode
->length
, &usedbytes
, &available
);
324 resNode
= resNode
->next
;
327 /* Fill in the number of entries */
328 p_ev_ctrl
->mem_avail
= loop
;
330 /* Figure out prefetchable memory Available */
332 resNode
= ctrl
->p_mem_head
;
340 rc
= add_dword( &pFill
, resNode
->base
, &usedbytes
, &available
);
345 rc
= add_dword( &pFill
, resNode
->length
, &usedbytes
, &available
);
349 resNode
= resNode
->next
;
352 /* Fill in the number of entries */
353 p_ev_ctrl
->p_mem_avail
= loop
;
355 /* Figure out IO Available */
357 resNode
= ctrl
->io_head
;
365 rc
= add_dword( &pFill
, resNode
->base
, &usedbytes
, &available
);
370 rc
= add_dword( &pFill
, resNode
->length
, &usedbytes
, &available
);
374 resNode
= resNode
->next
;
377 /* Fill in the number of entries */
378 p_ev_ctrl
->io_avail
= loop
;
380 /* Figure out bus Available */
382 resNode
= ctrl
->bus_head
;
390 rc
= add_dword( &pFill
, resNode
->base
, &usedbytes
, &available
);
395 rc
= add_dword( &pFill
, resNode
->length
, &usedbytes
, &available
);
399 resNode
= resNode
->next
;
402 /* Fill in the number of entries */
403 p_ev_ctrl
->bus_avail
= loop
;
408 p_EV_header
->num_of_ctrl
= numCtrl
;
410 /* Now store the EV */
412 temp_dword
= usedbytes
;
414 rc
= access_EV(WRITE_EV
, "CQTHPS", (u8
*) buffer
, &temp_dword
);
416 dbg("usedbytes = 0x%x, length = 0x%x\n", usedbytes
, temp_dword
);
418 evbuffer_length
= temp_dword
;
421 err(msg_unable_to_save
);
429 void compaq_nvram_init (void __iomem
*rom_start
)
432 compaq_int15_entry_point
= (rom_start
+ ROM_INT15_PHY_ADDR
- ROM_PHY_ADDR
);
434 dbg("int15 entry = %p\n", compaq_int15_entry_point
);
436 /* initialize our int15 lock */
437 spin_lock_init(&int15_lock
);
441 int compaq_nvram_load (void __iomem
*rom_start
, struct controller
*ctrl
)
443 u8 bus
, device
, function
;
444 u8 nummem
, numpmem
, numio
, numbus
;
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
;
454 if (!evbuffer_init
) {
455 /* Read the resource list information in from NVRAM */
456 if (load_HRT(rom_start
))
457 memset (evbuffer
, 0, 1024);
462 /* If we saved information in NVRAM, use it now */
463 p_EV_header
= (struct ev_hrt_header
*) evbuffer
;
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
470 if ((p_EV_header
->Version
== 2) ||
471 ((p_EV_header
->Version
== 1) && !ctrl
->push_flag
)) {
472 p_byte
= &(p_EV_header
->next
);
474 p_ev_ctrl
= (struct ev_hrt_ctrl
*) &(p_EV_header
->next
);
478 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
))
481 bus
= p_ev_ctrl
->bus
;
482 device
= p_ev_ctrl
->device
;
483 function
= p_ev_ctrl
->function
;
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
;
495 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
))
498 /* Skip forward to the next entry */
499 p_byte
+= (nummem
+ numpmem
+ numio
+ numbus
) * 8;
501 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
))
504 p_ev_ctrl
= (struct ev_hrt_ctrl
*) p_byte
;
508 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
))
511 bus
= p_ev_ctrl
->bus
;
512 device
= p_ev_ctrl
->device
;
513 function
= p_ev_ctrl
->function
;
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
;
523 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
))
527 mem_node
= kmalloc(sizeof(struct pci_resource
), GFP_KERNEL
);
532 mem_node
->base
= *(u32
*)p_byte
;
533 dbg("mem base = %8.8x\n",mem_node
->base
);
536 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
541 mem_node
->length
= *(u32
*)p_byte
;
542 dbg("mem length = %8.8x\n",mem_node
->length
);
545 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
550 mem_node
->next
= ctrl
->mem_head
;
551 ctrl
->mem_head
= mem_node
;
555 p_mem_node
= kmalloc(sizeof(struct pci_resource
), GFP_KERNEL
);
560 p_mem_node
->base
= *(u32
*)p_byte
;
561 dbg("pre-mem base = %8.8x\n",p_mem_node
->base
);
564 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
569 p_mem_node
->length
= *(u32
*)p_byte
;
570 dbg("pre-mem length = %8.8x\n",p_mem_node
->length
);
573 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
578 p_mem_node
->next
= ctrl
->p_mem_head
;
579 ctrl
->p_mem_head
= p_mem_node
;
583 io_node
= kmalloc(sizeof(struct pci_resource
), GFP_KERNEL
);
588 io_node
->base
= *(u32
*)p_byte
;
589 dbg("io base = %8.8x\n",io_node
->base
);
592 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
597 io_node
->length
= *(u32
*)p_byte
;
598 dbg("io length = %8.8x\n",io_node
->length
);
601 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
606 io_node
->next
= ctrl
->io_head
;
607 ctrl
->io_head
= io_node
;
611 bus_node
= kmalloc(sizeof(struct pci_resource
), GFP_KERNEL
);
616 bus_node
->base
= *(u32
*)p_byte
;
619 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
624 bus_node
->length
= *(u32
*)p_byte
;
627 if (p_byte
> ((u8
*)p_EV_header
+ evbuffer_length
)) {
632 bus_node
->next
= ctrl
->bus_head
;
633 ctrl
->bus_head
= bus_node
;
636 /* If all of the following fail, we don't have any resources for
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
));
648 if ((evbuffer
[0] != 0) && (!ctrl
->push_flag
))
656 int compaq_nvram_store (void __iomem
*rom_start
)
660 if (rom_start
== NULL
)
664 rc
= store_HRT(rom_start
);
666 err(msg_unable_to_save
);