Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Standard 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 | * Copyright (C) 2003-2004 Intel Corporation | |
8 | * | |
9 | * All rights reserved. | |
10 | * | |
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. | |
15 | * | |
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 | |
20 | * details. | |
21 | * | |
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. | |
25 | * | |
8cf4c195 | 26 | * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com> |
1da177e4 LT |
27 | * |
28 | */ | |
29 | ||
1da177e4 LT |
30 | #include <linux/module.h> |
31 | #include <linux/kernel.h> | |
32 | #include <linux/types.h> | |
1da177e4 LT |
33 | #include <linux/pci.h> |
34 | #include "../pci.h" | |
35 | #include "shpchp.h" | |
1da177e4 | 36 | |
0ab2b57f | 37 | int __ref shpchp_configure_device(struct slot *p_slot) |
1da177e4 | 38 | { |
dbd7a788 | 39 | struct pci_dev *dev; |
f98ca311 | 40 | struct controller *ctrl = p_slot->ctrl; |
7d01f70a YL |
41 | struct pci_dev *bridge = ctrl->pci_dev; |
42 | struct pci_bus *parent = bridge->subordinate; | |
fcbed0bc | 43 | int num; |
dbd7a788 | 44 | |
e00e57ef | 45 | dev = pci_get_slot(parent, PCI_DEVFN(p_slot->device, 0)); |
dbd7a788 | 46 | if (dev) { |
be7bce25 TI |
47 | ctrl_err(ctrl, "Device %s already exists " |
48 | "at %04x:%02x:%02x, cannot hot-add\n", pci_name(dev), | |
49 | pci_domain_nr(parent), p_slot->bus, p_slot->device); | |
e00e57ef | 50 | pci_dev_put(dev); |
dbd7a788 | 51 | return -EINVAL; |
1da177e4 LT |
52 | } |
53 | ||
dbd7a788 RS |
54 | num = pci_scan_slot(parent, PCI_DEVFN(p_slot->device, 0)); |
55 | if (num == 0) { | |
f98ca311 | 56 | ctrl_err(ctrl, "No new device found\n"); |
dbd7a788 RS |
57 | return -ENODEV; |
58 | } | |
1da177e4 | 59 | |
fcbed0bc YW |
60 | list_for_each_entry(dev, &parent->devices, bus_list) { |
61 | if (PCI_SLOT(dev->devfn) != p_slot->device) | |
dbd7a788 | 62 | continue; |
dbd7a788 | 63 | if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) || |
7d01f70a YL |
64 | (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)) |
65 | pci_hp_add_bridge(dev); | |
7d01f70a YL |
66 | } |
67 | ||
68 | pci_assign_unassigned_bridge_resources(bridge); | |
69 | ||
fcbed0bc YW |
70 | list_for_each_entry(dev, &parent->devices, bus_list) { |
71 | if (PCI_SLOT(dev->devfn) != p_slot->device) | |
7d01f70a | 72 | continue; |
11876e52 | 73 | pci_configure_slot(dev); |
1da177e4 LT |
74 | } |
75 | ||
dbd7a788 | 76 | pci_bus_add_devices(parent); |
7d01f70a | 77 | |
1da177e4 LT |
78 | return 0; |
79 | } | |
80 | ||
2178bfad | 81 | int shpchp_unconfigure_device(struct slot *p_slot) |
1da177e4 LT |
82 | { |
83 | int rc = 0; | |
2178bfad | 84 | u8 bctl = 0; |
e00e57ef | 85 | struct pci_bus *parent = p_slot->ctrl->pci_dev->subordinate; |
fcbed0bc | 86 | struct pci_dev *dev, *temp; |
f98ca311 | 87 | struct controller *ctrl = p_slot->ctrl; |
e00e57ef | 88 | |
be7bce25 TI |
89 | ctrl_dbg(ctrl, "%s: domain:bus:dev = %04x:%02x:%02x\n", |
90 | __func__, pci_domain_nr(parent), p_slot->bus, p_slot->device); | |
1da177e4 | 91 | |
fcbed0bc YW |
92 | list_for_each_entry_safe(dev, temp, &parent->devices, bus_list) { |
93 | if (PCI_SLOT(dev->devfn) != p_slot->device) | |
2178bfad | 94 | continue; |
fcbed0bc YW |
95 | |
96 | pci_dev_get(dev); | |
97 | if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) { | |
98 | pci_read_config_byte(dev, PCI_BRIDGE_CONTROL, &bctl); | |
2178bfad | 99 | if (bctl & PCI_BRIDGE_CTL_VGA) { |
f98ca311 TI |
100 | ctrl_err(ctrl, |
101 | "Cannot remove display device %s\n", | |
fcbed0bc YW |
102 | pci_name(dev)); |
103 | pci_dev_put(dev); | |
0ba10bc7 PK |
104 | rc = -EINVAL; |
105 | break; | |
2178bfad | 106 | } |
1da177e4 | 107 | } |
fcbed0bc YW |
108 | pci_stop_and_remove_bus_device(dev); |
109 | pci_dev_put(dev); | |
1da177e4 LT |
110 | } |
111 | return rc; | |
112 | } | |
113 |