2 * Standard 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.
7 * Copyright (C) 2003-2004 Intel Corporation
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or (at
14 * your option) any later version.
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
19 * NON INFRINGEMENT. See the GNU General Public License for more
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
30 #include <linux/module.h>
31 #include <linux/kernel.h>
32 #include <linux/types.h>
33 #include <linux/pci.h>
37 static void program_fw_provided_values(struct pci_dev
*dev
)
39 u16 pci_cmd
, pci_bctl
;
41 struct hotplug_params hpp
;
43 /* Program hpp values for this device */
44 if (!(dev
->hdr_type
== PCI_HEADER_TYPE_NORMAL
||
45 (dev
->hdr_type
== PCI_HEADER_TYPE_BRIDGE
&&
46 (dev
->class >> 8) == PCI_CLASS_BRIDGE_PCI
)))
49 /* use default values if we can't get them from firmware */
50 if (get_hp_params_from_firmware(dev
, &hpp
) ||
51 !hpp
.t0
|| (hpp
.t0
->revision
> 1)) {
52 warn("Could not get hotplug parameters. Use defaults\n");
53 hpp
.t0
= &hpp
.type0_data
;
55 hpp
.t0
->cache_line_size
= 8;
56 hpp
.t0
->latency_timer
= 0x40;
57 hpp
.t0
->enable_serr
= 0;
58 hpp
.t0
->enable_perr
= 0;
61 pci_write_config_byte(dev
,
62 PCI_CACHE_LINE_SIZE
, hpp
.t0
->cache_line_size
);
63 pci_write_config_byte(dev
, PCI_LATENCY_TIMER
, hpp
.t0
->latency_timer
);
64 pci_read_config_word(dev
, PCI_COMMAND
, &pci_cmd
);
65 if (hpp
.t0
->enable_serr
)
66 pci_cmd
|= PCI_COMMAND_SERR
;
68 pci_cmd
&= ~PCI_COMMAND_SERR
;
69 if (hpp
.t0
->enable_perr
)
70 pci_cmd
|= PCI_COMMAND_PARITY
;
72 pci_cmd
&= ~PCI_COMMAND_PARITY
;
73 pci_write_config_word(dev
, PCI_COMMAND
, pci_cmd
);
75 /* Program bridge control value and child devices */
76 if ((dev
->class >> 8) == PCI_CLASS_BRIDGE_PCI
) {
77 pci_write_config_byte(dev
, PCI_SEC_LATENCY_TIMER
,
78 hpp
.t0
->latency_timer
);
79 pci_read_config_word(dev
, PCI_BRIDGE_CONTROL
, &pci_bctl
);
80 if (hpp
.t0
->enable_serr
)
81 pci_bctl
|= PCI_BRIDGE_CTL_SERR
;
83 pci_bctl
&= ~PCI_BRIDGE_CTL_SERR
;
84 if (hpp
.t0
->enable_perr
)
85 pci_bctl
|= PCI_BRIDGE_CTL_PARITY
;
87 pci_bctl
&= ~PCI_BRIDGE_CTL_PARITY
;
88 pci_write_config_word(dev
, PCI_BRIDGE_CONTROL
, pci_bctl
);
89 if (dev
->subordinate
) {
90 list_for_each_entry(cdev
, &dev
->subordinate
->devices
,
92 program_fw_provided_values(cdev
);
97 int __ref
shpchp_configure_device(struct slot
*p_slot
)
100 struct pci_bus
*parent
= p_slot
->ctrl
->pci_dev
->subordinate
;
102 struct controller
*ctrl
= p_slot
->ctrl
;
104 dev
= pci_get_slot(parent
, PCI_DEVFN(p_slot
->device
, 0));
106 ctrl_err(ctrl
, "Device %s already exists "
107 "at %04x:%02x:%02x, cannot hot-add\n", pci_name(dev
),
108 pci_domain_nr(parent
), p_slot
->bus
, p_slot
->device
);
113 num
= pci_scan_slot(parent
, PCI_DEVFN(p_slot
->device
, 0));
115 ctrl_err(ctrl
, "No new device found\n");
119 for (fn
= 0; fn
< 8; fn
++) {
120 dev
= pci_get_slot(parent
, PCI_DEVFN(p_slot
->device
, fn
));
123 if ((dev
->class >> 16) == PCI_BASE_CLASS_DISPLAY
) {
124 ctrl_err(ctrl
, "Cannot hot-add display device %s\n",
129 if ((dev
->hdr_type
== PCI_HEADER_TYPE_BRIDGE
) ||
130 (dev
->hdr_type
== PCI_HEADER_TYPE_CARDBUS
)) {
131 /* Find an unused bus number for the new bridge */
132 struct pci_bus
*child
;
133 unsigned char busnr
, start
= parent
->secondary
;
134 unsigned char end
= parent
->subordinate
;
135 for (busnr
= start
; busnr
<= end
; busnr
++) {
136 if (!pci_find_bus(pci_domain_nr(parent
),
142 "No free bus for hot-added bridge\n");
146 child
= pci_add_new_bus(parent
, dev
, busnr
);
148 ctrl_err(ctrl
, "Cannot add new bus for %s\n",
153 child
->subordinate
= pci_do_scan_bus(child
);
154 pci_bus_size_bridges(child
);
156 program_fw_provided_values(dev
);
160 pci_bus_assign_resources(parent
);
161 pci_bus_add_devices(parent
);
162 pci_enable_bridges(parent
);
166 int shpchp_unconfigure_device(struct slot
*p_slot
)
171 struct pci_bus
*parent
= p_slot
->ctrl
->pci_dev
->subordinate
;
172 struct controller
*ctrl
= p_slot
->ctrl
;
174 ctrl_dbg(ctrl
, "%s: domain:bus:dev = %04x:%02x:%02x\n",
175 __func__
, pci_domain_nr(parent
), p_slot
->bus
, p_slot
->device
);
177 for (j
=0; j
<8 ; j
++) {
178 struct pci_dev
* temp
= pci_get_slot(parent
,
179 (p_slot
->device
<< 3) | j
);
182 if ((temp
->class >> 16) == PCI_BASE_CLASS_DISPLAY
) {
183 ctrl_err(ctrl
, "Cannot remove display device %s\n",
188 if (temp
->hdr_type
== PCI_HEADER_TYPE_BRIDGE
) {
189 pci_read_config_byte(temp
, PCI_BRIDGE_CONTROL
, &bctl
);
190 if (bctl
& PCI_BRIDGE_CTL_VGA
) {
192 "Cannot remove display device %s\n",
198 pci_remove_bus_device(temp
);
This page took 0.033885 seconds and 5 git commands to generate.